Solarsense/code/suntrack_plugcontrol_server_client/ble_client.c

#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <string.h>
#include <arpa/inet.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <pthread.h>
#include <signal.h>
#include <bluetooth/bluetooth.h>
#include <bluetooth/rfcomm.h>

#define BUF_SIZE 512
#define NAME_SIZE 512
#define ARR_CNT 5

void *send_msg(void *arg);
void *recv_msg(void *arg);
void error_handling(char *msg);

char name[NAME_SIZE] = "[Default]";

typedef struct
{
	int sockfd;
	int btfd;
	char sendid[NAME_SIZE];
} DEV_FD;

int main(int argc, char *argv[])
{
	DEV_FD dev_fd;
	struct sockaddr_in serv_addr;
	pthread_t snd_thread, rcv_thread;
	void *thread_return;
	int ret;
	struct sockaddr_rc addr = {0};
	char dest[18] = "98:D3:37:90:A7:8B"; // iot00
	char msg[BUF_SIZE];

	if (argc != 4)
	{
		printf("Usage : %s <IP> <port> <name>\n", argv[0]);
		exit(1);
	}

	sprintf(name, "%s", argv[3]);

	dev_fd.sockfd = socket(PF_INET, SOCK_STREAM, 0);
	if (dev_fd.sockfd == -1)
		error_handling("socket() error");

	memset(&serv_addr, 0, sizeof(serv_addr));
	serv_addr.sin_family = AF_INET;
	serv_addr.sin_addr.s_addr = inet_addr(argv[1]);
	serv_addr.sin_port = htons(atoi(argv[2]));

	if (connect(dev_fd.sockfd, (struct sockaddr *)&serv_addr, sizeof(serv_addr)) == -1)
		error_handling("connect() error");

	sprintf(msg, "[%s:PASSWD]", name);
	write(dev_fd.sockfd, msg, strlen(msg));

	dev_fd.btfd = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
	if (dev_fd.btfd == -1)
	{
		perror("socket()");
		exit(1);
	}

	// set the connection parameters (who to connect to)
	addr.rc_family = AF_BLUETOOTH;
	addr.rc_channel = (uint8_t)1;
	str2ba(dest, &addr.rc_bdaddr);

	ret = connect(dev_fd.btfd, (struct sockaddr *)&addr, sizeof(addr));
	if (ret == -1)
	{
		perror("connect()");
		exit(1);
	}

	pthread_create(&rcv_thread, NULL, recv_msg, (void *)&dev_fd);
	pthread_create(&snd_thread, NULL, send_msg, (void *)&dev_fd);

	pthread_join(snd_thread, &thread_return);
	//	pthread_join(rcv_thread, &thread_return);

	close(dev_fd.sockfd);
	return 0;
}

void *send_msg(void *arg) // bluetooth --> server
{
	DEV_FD *dev_fd = (DEV_FD *)arg;
	int str_len;
	int ret;
	fd_set initset, newset;
	struct timeval tv;
	char name_msg[NAME_SIZE + BUF_SIZE + 2];
	char msg[BUF_SIZE];
	int total = 0;

	FD_ZERO(&initset);
	FD_SET(dev_fd->sockfd, &initset);
	FD_SET(dev_fd->btfd, &initset);

	//	fputs("Input a message! [ID]msg (Default ID:ALLMSG)\n",stdout);
	while (1)
	{
		//		memset(msg,0,sizeof(msg));
		//		name_msg[0] = '\0';
		tv.tv_sec = 1;
		tv.tv_usec = 0;
		newset = initset;
		ret = select(dev_fd->btfd + 1, &newset, NULL, NULL, &tv);
		//        if(FD_ISSET(STDIN_FILENO, &newset))
		if (FD_ISSET(dev_fd->btfd, &newset))
		{
			ret = read(dev_fd->btfd, msg + total, BUF_SIZE - total);
			if (ret > 0)
			{
				total += ret;
			}
			else if (ret == 0)
			{
				dev_fd->sockfd = -1;
				return NULL;
			}

			if (msg[total - 1] == '\n')
			{
				msg[total] = 0;
				total = 0;
			}
			else
				continue;

			//			sprintf(name_msg,"[%s]%s",dev_fd->sendid,msg);
			fputs("ARD:", stdout);
			fputs(msg, stdout);
			if (write(dev_fd->sockfd, msg, strlen(msg)) <= 0)
			{
				dev_fd->sockfd = -1;
				return NULL;
			}
		}
		if (ret == 0)
		{
			if (dev_fd->sockfd == -1)
				return NULL;
		}
	}
}

void *recv_msg(void *arg) // server --> bluetooth
{
	DEV_FD *dev_fd = (DEV_FD *)arg;
	int i;
	char *pToken;
	char *pArray[ARR_CNT] = {0};

	char name_msg[NAME_SIZE + BUF_SIZE + 1];
	int str_len;
	while (1)
	{
		memset(name_msg, 0x0, sizeof(name_msg));
		str_len = read(dev_fd->sockfd, name_msg, NAME_SIZE + BUF_SIZE);
		if (str_len <= 0)
		{
			dev_fd->sockfd = -1;
			return NULL;
		}
		name_msg[str_len] = 0;
		fputs("SRV:", stdout);
		fputs(name_msg, stdout);
		/*
				pToken = strtok(name_msg,"[:]");
				i = 0;
				while(pToken != NULL)
				{
					pArray[i] =  pToken;
					if(i++ >= ARR_CNT)
						break;
					pToken = strtok(NULL,"[:]");
				}
				if(!strncmp(pArray[1]," New conn",4) || !strncmp(pArray[1]," Already",4) || !strncmp(pArray[1]," Authent",4))
					continue;

				strcpy(dev_fd->sendid,pArray[0]);
				write(dev_fd->btfd,pArray[1],strlen(pArray[1]));
		*/
		write(dev_fd->btfd, name_msg, strlen(name_msg));
		/*
		//		printf("id:%s, msg:%s,%s,%s,%s\n",pArray[0],pArray[1],pArray[2],pArray[3],pArray[4]);
		printf("id:%s, msg:%s\n",pArray[0],pArray[1]);
		*/
	}
}

void error_handling(char *msg)
{
	fputs(msg, stderr);
	fputc('\n', stderr);
	exit(1);
}