Rev 483 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 483 | Rev 522 | ||
---|---|---|---|
1 | #include "bluetooth_handler.h" |
1 | #include "bluetooth_handler.h" |
2 | 2 | ||
3 | int bt_device_count=0; |
3 | int bt_device_count=0; |
4 | 4 | ||
5 | char names[MAX_BT_DEVICES][248]; |
5 | char names[MAX_BT_DEVICES][248]; |
6 | char addrs[MAX_BT_DEVICES][19]; |
6 | char addrs[MAX_BT_DEVICES][19]; |
7 | 7 | ||
8 | char BtHostRxBuffer[150]; |
8 | char BtHostRxBuffer[150]; |
- | 9 | char BtHostRxBufferDecoded[150]; |
|
9 | 10 | ||
10 | 11 | int BtRxCount; |
|
11 | int scan_bt() |
12 | int scan_bt() |
12 | { |
13 | { |
13 | inquiry_info *ii = NULL; |
14 | inquiry_info *ii = NULL; |
14 | 15 | ||
15 | int dev_id, sock, len, flags; |
16 | int dev_id, sock, len, flags; |
16 | int i; |
17 | int i; |
17 | char addr[19] = { 0 }; |
18 | char addr[19] = { 0 }; |
18 | char name[248] = { 0 }; |
19 | char name[248] = { 0 }; |
19 | 20 | ||
20 | dev_id = hci_get_route(NULL); |
21 | dev_id = hci_get_route(NULL); |
21 | sock = hci_open_dev( dev_id ); |
22 | sock = hci_open_dev( dev_id ); |
22 | if (dev_id < 0 || sock < 0) { |
23 | if (dev_id < 0 || sock < 0) { |
23 | perror("opening socket"); |
24 | perror("opening socket"); |
24 | return 0; |
25 | return 0; |
25 | } |
26 | } |
26 | 27 | ||
27 | len = 8; |
28 | len = 8; |
28 | 29 | ||
29 | flags = IREQ_CACHE_FLUSH; |
30 | flags = IREQ_CACHE_FLUSH; |
30 | ii = (inquiry_info*)malloc(MAX_BT_DEVICES * sizeof(inquiry_info)); |
31 | ii = (inquiry_info*)malloc(MAX_BT_DEVICES * sizeof(inquiry_info)); |
31 | 32 | ||
32 | bt_device_count = hci_inquiry(dev_id, len, MAX_BT_DEVICES, NULL, &ii, flags); |
33 | bt_device_count = hci_inquiry(dev_id, len, MAX_BT_DEVICES, NULL, &ii, flags); |
33 | if( bt_device_count < 0 ) perror("hci_inquiry"); |
34 | if( bt_device_count < 0 ) perror("hci_inquiry"); |
34 | 35 | ||
35 | for (i = 0; i < bt_device_count; i++) { |
36 | for (i = 0; i < bt_device_count; i++) { |
36 | ba2str(&(ii+i)->bdaddr, addr); |
37 | ba2str(&(ii+i)->bdaddr, addr); |
37 | sprintf(addrs[i],"%s",addr); |
38 | sprintf(addrs[i],"%s",addr); |
38 | 39 | ||
39 | memset(name, 0, sizeof(name)); |
40 | memset(name, 0, sizeof(name)); |
40 | 41 | ||
41 | if (hci_read_remote_name(sock, &(ii+i)->bdaddr, sizeof(name), |
42 | if (hci_read_remote_name(sock, &(ii+i)->bdaddr, sizeof(name), |
42 | name, 0) < 0) |
43 | name, 0) < 0) |
43 | sprintf(names[i],"[unknown]"); |
44 | sprintf(names[i],"[unknown]"); |
44 | else |
45 | else |
45 | sprintf(names[i],"%s",name); |
46 | sprintf(names[i],"%s",name); |
46 | 47 | ||
47 | } |
48 | } |
48 | 49 | ||
49 | 50 | ||
50 | free( ii ); |
51 | free( ii ); |
51 | close( sock ); |
52 | close( sock ); |
52 | return 1; |
53 | return 1; |
53 | } |
54 | } |
54 | 55 | ||
55 | //struct timeval timeout; |
56 | //struct timeval timeout; |
56 | fd_set readfds, writefds; |
57 | fd_set readfds, writefds; |
57 | int s; |
58 | int s; |
58 | struct sockaddr_rc loc_addr = { 0 }, rem_addr = { 0 }; |
59 | struct sockaddr_rc loc_addr = { 0 }, rem_addr = { 0 }; |
59 | char buf[1024] = { 0 }; |
60 | char buf[1024] = { 0 }; |
60 | int client, bytes_read, status; |
61 | int client, bytes_read, status; |
61 | unsigned int opt = sizeof(rem_addr); |
62 | unsigned int opt = sizeof(rem_addr); |
62 | 63 | ||
63 | int maxfd, sock_flags; |
64 | int maxfd, sock_flags; |
64 | 65 | ||
- | 66 | ||
- | 67 | unsigned char BT_TxBuffer[MAX_BUFF_LEN]; |
|
- | 68 | ||
- | 69 | extern struct str_DebugOut DebugOut; |
|
65 | 70 | struct str_VersionInfo VersionInfo; |
|
66 | 71 | ||
67 | int bt_host_init() |
72 | int bt_host_init() |
68 | { |
73 | { |
69 | 74 | ||
70 | // allocate socket |
75 | // allocate socket |
71 | s = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM); |
76 | s = socket(AF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM); |
72 | 77 | ||
73 | // bind socket to port 1 of the first available bluetooth adapter |
78 | // bind socket to port 1 of the first available bluetooth adapter |
74 | loc_addr.rc_family = AF_BLUETOOTH; |
79 | loc_addr.rc_family = AF_BLUETOOTH; |
75 | loc_addr.rc_bdaddr = *BDADDR_ANY; |
80 | loc_addr.rc_bdaddr = *BDADDR_ANY; |
76 | loc_addr.rc_channel = 1; |
81 | loc_addr.rc_channel = 1; |
77 | bind(s, (struct sockaddr *)&loc_addr, sizeof(loc_addr)); |
82 | bind(s, (struct sockaddr *)&loc_addr, sizeof(loc_addr)); |
78 | 83 | ||
79 | // put server socket into listening mode |
84 | // put server socket into listening mode |
80 | listen(s, 1); |
85 | listen(s, 1); |
81 | 86 | ||
82 | // put server socket into nonblocking mode |
87 | // put server socket into nonblocking mode |
83 | sock_flags = fcntl( s, F_GETFL, 0 ); |
88 | sock_flags = fcntl( s, F_GETFL, 0 ); |
84 | fcntl( s, F_SETFL, sock_flags | O_NONBLOCK ); |
89 | fcntl( s, F_SETFL, sock_flags | O_NONBLOCK ); |
85 | 90 | ||
86 | return 1; |
91 | return 1; |
87 | } |
92 | } |
88 | 93 | ||
89 | 94 | ||
90 | int bt_host_connected=0; |
95 | int bt_host_connected=0; |
91 | 96 | ||
92 | int bt_host_send(char RxBuffer[150],int len) |
97 | int bt_host_send(char RxBuffer[150],int len) |
93 | { |
98 | { |
94 | if (bt_host_connected) |
99 | if (bt_host_connected) |
95 | { |
100 | { |
96 | send(client,"\r",1,0); |
101 | send(client,"\r",1,0); |
97 | send(client,RxBuffer,len,0); |
102 | send(client,RxBuffer,len,0); |
98 | send(client,"\r",1,0); |
103 | send(client,"\r",1,0); |
99 | } |
104 | } |
100 | return 1; |
105 | return 1; |
101 | } |
106 | } |
- | 107 | ||
- | 108 | ||
- | 109 | struct { |
|
- | 110 | unsigned char MenuePunkt; |
|
- | 111 | unsigned char MaxMenue; |
|
- | 112 | char DisplayBuff[80]; |
|
- | 113 | } menu; |
|
- | 114 | ||
- | 115 | ||
- | 116 | void copy_lcd_str(int x,int y,char str[]) |
|
- | 117 | { |
|
- | 118 | int pos=0; |
|
- | 119 | while (str[pos]!=0) |
|
- | 120 | { |
|
- | 121 | ||
- | 122 | menu.DisplayBuff[y*20+x+pos]=str[pos]; |
|
- | 123 | pos++; |
|
- | 124 | } |
|
- | 125 | ||
- | 126 | } |
|
- | 127 | ||
- | 128 | ||
- | 129 | ||
- | 130 | void Menu(void) |
|
- | 131 | { |
|
- | 132 | ||
- | 133 | // menu.MenuePunkt=0; |
|
- | 134 | menu.MaxMenue=3; |
|
- | 135 | int x; |
|
- | 136 | int y; |
|
- | 137 | ||
- | 138 | char tmp_str[20]; |
|
- | 139 | ||
- | 140 | for (x=0;x<20;x++) |
|
- | 141 | for (y=0;y<4;y++) |
|
- | 142 | menu.DisplayBuff[y*20+x]=' '; |
|
- | 143 | ||
- | 144 | switch(menu.MenuePunkt) |
|
- | 145 | { |
|
- | 146 | case 0: |
|
- | 147 | // LCD_printfxy(0,0,"+ Riddim +"); |
|
- | 148 | /* LCD_printfxy(0,1,"Version: %d %d",0,8); |
|
- | 149 | LCD_printfxy(0,2,""); |
|
- | 150 | LCD_printfxy(0,3,"(cc) 2009 ligi"); |
|
- | 151 | */ |
|
- | 152 | // clear_lcd |
|
- | 153 | ||
- | 154 | ||
- | 155 | ||
- | 156 | sprintf(tmp_str,"+ Riddim +"); |
|
- | 157 | copy_lcd_str(0,0,tmp_str); |
|
- | 158 | ||
- | 159 | sprintf(tmp_str,"Version: V%d.%d/%d",RIDDIM_VERSION_MAJOR,RIDDIM_VERSION_MINOR,RIDDIM_VERSION_PATCH); |
|
- | 160 | copy_lcd_str(0,1,tmp_str); |
|
- | 161 | ||
- | 162 | ||
- | 163 | sprintf(tmp_str,"(cc) 2009 LiGi"); |
|
- | 164 | copy_lcd_str(0,3,tmp_str); |
|
- | 165 | ||
- | 166 | // sprintf(&menu.DisplayBuff,"+ Riddim ++"); |
|
- | 167 | ||
- | 168 | // sprintf(&menu.DisplayBuff+20,"Version: %d %d",0,8); |
|
- | 169 | ||
- | 170 | break; |
|
- | 171 | ||
- | 172 | case 1: |
|
- | 173 | sprintf(tmp_str,"Loop:"); |
|
- | 174 | copy_lcd_str(0,0,tmp_str); |
|
- | 175 | sprintf(tmp_str," Count %ld",trip_count); |
|
- | 176 | copy_lcd_str(0,1,tmp_str); |
|
- | 177 | sprintf(tmp_str," Time %ld",last_trip_time); |
|
- | 178 | copy_lcd_str(0,2,tmp_str); |
|
- | 179 | break; |
|
- | 180 | ||
- | 181 | ||
- | 182 | case 2: |
|
- | 183 | sprintf(tmp_str,"Inputs:"); |
|
- | 184 | copy_lcd_str(0,0,tmp_str); |
|
- | 185 | sprintf(tmp_str," Complete %d",evdevs_count); |
|
- | 186 | copy_lcd_str(0,1,tmp_str); |
|
- | 187 | sprintf(tmp_str," Connected %d",input_count); |
|
- | 188 | copy_lcd_str(0,2,tmp_str); |
|
- | 189 | sprintf(tmp_str," Configured %d",configured_input_count); |
|
- | 190 | copy_lcd_str(0,3,tmp_str); |
|
- | 191 | break; |
|
- | 192 | ||
- | 193 | case 3: |
|
- | 194 | sprintf(tmp_str,"Nick: %d",act_nick); |
|
- | 195 | copy_lcd_str(0,0,tmp_str); |
|
- | 196 | sprintf(tmp_str,"Roll %d",act_roll); |
|
- | 197 | copy_lcd_str(0,1,tmp_str); |
|
- | 198 | sprintf(tmp_str,"Gier %d",act_gier); |
|
- | 199 | copy_lcd_str(0,2,tmp_str); |
|
- | 200 | sprintf(tmp_str,"Gas %d",act_gas); |
|
- | 201 | copy_lcd_str(0,3,tmp_str); |
|
- | 202 | break; |
|
- | 203 | ||
- | 204 | default: |
|
- | 205 | sprintf(tmp_str,"illegal page %d",menu.MenuePunkt); |
|
- | 206 | copy_lcd_str(0,0,tmp_str); |
|
- | 207 | break; |
|
- | 208 | } |
|
- | 209 | } |
|
- | 210 | ||
- | 211 | ||
- | 212 | ||
- | 213 | void BT_Decode64(void) // die daten werden im rx buffer dekodiert, das geht nur, weil aus 4 byte immer 3 gemacht werden. |
|
- | 214 | { |
|
- | 215 | unsigned char a,b,c,d; |
|
- | 216 | unsigned char x,y,z; |
|
- | 217 | unsigned char ptrIn = 3; // start at begin of data block |
|
- | 218 | unsigned char ptrOut = 0; |
|
- | 219 | unsigned char len = BtRxCount - 5; // von der Gesamtbytezahl eines Frames gehen 3 Bytes des Headers ('#',Addr, Cmd) und 3 Bytes des Footers (CRC1, CRC2, '\r') ab. |
|
- | 220 | ||
- | 221 | while(len) |
|
- | 222 | { |
|
- | 223 | a = BtHostRxBuffer[ptrIn++] - '='; |
|
- | 224 | b = BtHostRxBuffer[ptrIn++] - '='; |
|
- | 225 | c = BtHostRxBuffer[ptrIn++] - '='; |
|
- | 226 | d = BtHostRxBuffer[ptrIn++] - '='; |
|
- | 227 | ||
- | 228 | x = (a << 2) | (b >> 4); |
|
- | 229 | y = ((b & 0x0f) << 4) | (c >> 2); |
|
- | 230 | z = ((c & 0x03) << 6) | d; |
|
- | 231 | printf("\naaaaa %d / %d\naaaaa s %s => x %d ; y %d ; z %d \n",ptrOut, BtRxCount ,BtHostRxBuffer,x,y,z); |
|
- | 232 | ||
- | 233 | ||
- | 234 | if(len--) BtHostRxBufferDecoded[ptrOut++] = x; else break; |
|
- | 235 | if(len--) BtHostRxBufferDecoded[ptrOut++] = y; else break; |
|
- | 236 | if(len--) BtHostRxBufferDecoded[ptrOut++] = z; else break; |
|
- | 237 | } |
|
- | 238 | //RxDataLen = ptrOut ; // wie viele Bytes wurden dekodiert? |
|
- | 239 | ||
- | 240 | } |
|
- | 241 | ||
- | 242 | void BT_AddCRC(unsigned int wieviele) |
|
- | 243 | { |
|
- | 244 | unsigned int tmpCRC = 0,i; |
|
- | 245 | for(i = 0; i < wieviele;i++) |
|
- | 246 | { |
|
- | 247 | tmpCRC += BT_TxBuffer[i]; |
|
- | 248 | } |
|
- | 249 | tmpCRC %= 4096; |
|
- | 250 | BT_TxBuffer[i++] = '=' + tmpCRC / 64; |
|
- | 251 | BT_TxBuffer[i++] = '=' + tmpCRC % 64; |
|
- | 252 | BT_TxBuffer[i++] = '\r'; |
|
- | 253 | } |
|
- | 254 | ||
- | 255 | void BT_SendOutData(unsigned char cmd,unsigned char modul, unsigned char *snd, unsigned char len) |
|
- | 256 | { |
|
- | 257 | // return; |
|
- | 258 | int status =0; |
|
- | 259 | unsigned int pt = 0; |
|
- | 260 | unsigned char a,b,c; |
|
- | 261 | unsigned char ptr = 0; |
|
- | 262 | ||
- | 263 | printf("packing base len %d -cmd %c\n",len,cmd); |
|
- | 264 | ||
- | 265 | BT_TxBuffer[pt++] = '#'; // Startzeichen |
|
- | 266 | BT_TxBuffer[pt++] = modul; // Adresse (a=0; b=1,...) |
|
- | 267 | BT_TxBuffer[pt++] = cmd; // Commando |
|
- | 268 | ||
- | 269 | while(len) |
|
- | 270 | { |
|
- | 271 | if(len) { a = snd[ptr++]; len--;} else a = 0; |
|
- | 272 | if(len) { b = snd[ptr++]; len--;} else b = 0; |
|
- | 273 | if(len) { c = snd[ptr++]; len--;} else c = 0; |
|
- | 274 | BT_TxBuffer[pt++] = '=' + (a >> 2); |
|
- | 275 | BT_TxBuffer[pt++] = '=' + (((a & 0x03) << 4) | ((b & 0xf0) >> 4)); |
|
- | 276 | BT_TxBuffer[pt++] = '=' + (((b & 0x0f) << 2) | ((c & 0xc0) >> 6)); |
|
- | 277 | BT_TxBuffer[pt++] = '=' + ( c & 0x3f); |
|
- | 278 | } |
|
- | 279 | ||
- | 280 | ||
- | 281 | ||
- | 282 | BT_AddCRC(pt); |
|
- | 283 | printf("Sending to BT_Client %d \n" , pt); |
|
- | 284 | ||
- | 285 | status = send(client,"\r" , 1, 0); |
|
- | 286 | ||
- | 287 | ||
- | 288 | // for (c=0;c<pt+2;c++) |
|
- | 289 | // { |
|
- | 290 | status = write(client,&BT_TxBuffer , pt+3); |
|
- | 291 | ||
- | 292 | ||
- | 293 | status = send(client,"\r" , 1, 0); |
|
- | 294 | printf("\n"); |
|
- | 295 | } |
|
- | 296 | ||
- | 297 | ||
- | 298 | void bt_process_buffer() |
|
- | 299 | { |
|
- | 300 | printf("processing buffer\n"); |
|
- | 301 | switch(BtHostRxBuffer[2]) |
|
- | 302 | { |
|
- | 303 | ||
- | 304 | case 'v': |
|
- | 305 | printf("got version request\n"); |
|
- | 306 | VersionInfo.SWMinor=RIDDIM_VERSION_MINOR; |
|
- | 307 | VersionInfo.SWMajor=RIDDIM_VERSION_MAJOR; |
|
- | 308 | VersionInfo.SWPatch=RIDDIM_VERSION_PATCH; |
|
- | 309 | ||
- | 310 | BT_SendOutData('V', RIDDIM_ADDRESS, (unsigned char *) &VersionInfo, sizeof(VersionInfo)); |
|
- | 311 | ||
- | 312 | break; |
|
- | 313 | ||
- | 314 | case 'l': |
|
- | 315 | printf("got display request\n"); |
|
- | 316 | Menu(); |
|
- | 317 | menu.MenuePunkt=BtHostRxBufferDecoded[0]; |
|
- | 318 | printf("sending %s \n",menu.DisplayBuff); |
|
- | 319 | BT_SendOutData('L', RIDDIM_ADDRESS, (unsigned char *) &menu, sizeof(menu)); |
|
- | 320 | break; |
|
- | 321 | ||
- | 322 | } |
|
- | 323 | ||
- | 324 | } |
|
- | 325 | ||
- | 326 | ||
- | 327 | ||
- | 328 | ||
- | 329 | ||
- | 330 | ||
- | 331 | ||
- | 332 | ||
- | 333 | int r=0; |
|
- | 334 | ||
- | 335 | struct timeval last_debug_time; |
|
- | 336 | struct timeval act_time; |
|
102 | 337 | ||
103 | int bt_host_tick(int mk_fd) |
338 | int bt_host_tick(int mk_fd) |
104 | { |
339 | { |
105 | 340 | ||
106 | // try to accept connection if none yet |
341 | // try to accept connection if none yet |
107 | if (!bt_host_connected) |
342 | if (!bt_host_connected) |
108 | { |
343 | { |
109 | // timeout.tv_sec = 0; |
344 | // timeout.tv_sec = 0; |
110 | // timeout.tv_usec = 100; |
345 | // timeout.tv_usec = 100; |
111 | FD_ZERO(&readfds); |
346 | FD_ZERO(&readfds); |
112 | FD_ZERO(&writefds); |
347 | FD_ZERO(&writefds); |
113 | FD_SET(s, &readfds); |
348 | FD_SET(s, &readfds); |
114 | maxfd = s; |
349 | maxfd = s; |
115 | 350 | ||
116 | printf("waiting for connection\n"); |
351 | printf("waiting for bt connection\n"); |
117 | // status = select(maxfd + 1, &readfds, &writefds, 0, &timeout); |
352 | // status = select(maxfd + 1, &readfds, &writefds, 0, &timeout); |
118 | status = select(maxfd + 1, &readfds, &writefds, 0,& (struct timeval) { 0, 100 }); |
353 | status = select(maxfd + 1, &readfds, &writefds, 0,& (struct timeval) { 0, 100 }); |
119 | if( status > 0 && FD_ISSET( s, &readfds ) ) { |
354 | if( status > 0 && FD_ISSET( s, &readfds ) ) { |
120 | // incoming connection |
355 | // incoming connection |
121 | client = accept( s, (struct sockaddr*)&rem_addr, &opt ); |
356 | client = accept( s, (struct sockaddr*)&rem_addr, &opt ); |
122 | if( client >= 0 ) |
357 | if( client >= 0 ) |
123 | { |
358 | { |
124 | bt_host_connected=1; |
359 | bt_host_connected=1; |
125 | 360 | ||
126 | // close the server socket, leaving only the client socket open |
361 | // close the server socket, leaving only the client socket open |
127 | // close(s); |
362 | // close(s); |
128 | 363 | ||
129 | 364 | ||
130 | ba2str( &rem_addr.rc_bdaddr, buf ); |
365 | ba2str( &rem_addr.rc_bdaddr, buf ); |
131 | fprintf(stderr, "accepted connection from %s!!!!!!!\n", buf); |
366 | fprintf(stderr, "accepted connection from %s!!!!!!!\n", buf); |
132 | memset(buf, 0, sizeof(buf)); |
367 | memset(buf, 0, sizeof(buf)); |
133 | 368 | ||
134 | // put client socket into nonblocking mode |
369 | // put client socket into nonblocking mode |
135 | sock_flags = fcntl( client, F_GETFL, 0 ); |
370 | sock_flags = fcntl( client, F_GETFL, 0 ); |
136 | fcntl( client, F_SETFL, sock_flags | O_NONBLOCK ); |
371 | fcntl( client, F_SETFL, sock_flags | O_NONBLOCK ); |
137 | } |
372 | } |
138 | 373 | ||
139 | } |
374 | } |
140 | 375 | ||
141 | } |
376 | } |
142 | else |
377 | else |
143 | { |
378 | { |
- | 379 | gettimeofday(&act_time,NULL); |
|
- | 380 | if (act_time.tv_sec>last_debug_time.tv_sec) |
|
- | 381 | { |
|
- | 382 | ||
- | 383 | DebugOut.Analog[9]=23; // voltage |
|
- | 384 | DebugOut.Analog[5]=23; // alt |
|
- | 385 | ||
- | 386 | BT_SendOutData('D', RIDDIM_ADDRESS, (unsigned char *) &DebugOut, sizeof(DebugOut)); |
|
- | 387 | ||
- | 388 | ||
- | 389 | gettimeofday(&last_debug_time,NULL); |
|
- | 390 | } |
|
144 | printf("reading from bt_host"); |
391 | printf("reading from bt_host"); |
145 | char in_char='#'; |
392 | char in_char='#'; |
146 | int count=0; |
393 | int count=0; |
147 | int r=0; |
- | |
- | 394 | ||
148 | 395 | struct timeval timeout; |
|
149 | // timeout.tv_sec = 0; |
396 | timeout.tv_sec = 0; |
- | 397 | timeout.tv_usec = 100; |
|
150 | //timeout.tv_usec = 100; |
398 | |
151 | FD_ZERO(&readfds); |
399 | FD_ZERO(&readfds); |
152 | FD_ZERO(&writefds); |
400 | FD_ZERO(&writefds); |
153 | FD_SET(client, &readfds); |
401 | FD_SET(client, &readfds); |
154 | maxfd = client; |
402 | maxfd = client; |
155 | 403 | ||
156 | printf("waiting for connection\n"); |
404 | printf("waiting for connection\n"); |
157 | //status = select(maxfd + 1, &readfds, 0, 0, &timeout); |
405 | status = select(maxfd + 1, &readfds, 0, 0, &timeout); |
158 | if( status >0 ) |
406 | if( status >0 ) |
159 | { |
407 | { |
- | 408 | count=read(client,&in_char,1); |
|
160 | send(mk_fd,"\r",1,0); |
409 | //send(mk_fd,"\r",1,0); |
161 | while(in_char!='\r') |
410 | if (count==-1) |
162 | { |
411 | { |
163 | - | ||
164 | count=read(client,&in_char,1); |
412 | bt_host_connected=0; |
165 | if (count==-1) |
413 | //return 0; |
166 | { |
414 | } |
- | 415 | else |
|
167 | bt_host_connected=0; |
416 | if(in_char!='\r') |
168 | return 0; |
417 | { |
169 | } |
418 | |
170 | printf("count: %d in %d chr %c\n",count,in_char,in_char); |
419 | printf("count: %d in %d chr %c r:%d\n",count,in_char,in_char,r); |
171 | send(mk_fd,&in_char,1,0); |
420 | //send(mk_fd,&in_char,1,0); |
172 | BtHostRxBuffer[r]=in_char; |
421 | BtHostRxBuffer[r++]=in_char; |
- | 422 | ||
- | 423 | } |
|
- | 424 | else |
|
- | 425 | { |
|
- | 426 | BtRxCount=r; |
|
- | 427 | r=0; |
|
- | 428 | ||
- | 429 | BT_Decode64(); |
|
- | 430 | bt_process_buffer(); |
|
173 | } |
431 | } |
174 | send(mk_fd,"\r",1,0); |
432 | // send(mk_fd,"\r",1,0); |
175 | } |
433 | } |
176 | else |
434 | else |
177 | return 0; |
435 | return 0; |
178 | } |
436 | } |
179 | 437 | ||
180 | return 1; |
438 | return 1; |
181 | } |
439 | } |
182 | 440 |