add
This commit is contained in:
seoamugae committed
1 parent
5543c078a4
commit
0ce025f948
128 files changed
+153659
-1
No files matched your search
@@ -0,0 +1,206 @@
|
||||
#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);
|
||||
}
|
||||
Reference in new issue
Block a user