1 /******************************************************************************
2 *
3 * Copyright (C) 2009-2012 Broadcom Corporation
4 *
5 * Licensed under the Apache License, Version 2.0 (the "License");
6 * you may not use this file except in compliance with the License.
7 * You may obtain a copy of the License at:
8 *
9 * http://www.apache.org/licenses/LICENSE-2.0
10 *
11 * Unless required by applicable law or agreed to in writing, software
12 * distributed under the License is distributed on an "AS IS" BASIS,
13 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14 * See the License for the specific language governing permissions and
15 * limitations under the License.
16 *
17 ******************************************************************************/
18
19
20 /************************************************************************************
21 *
22 * Filename: btif_hf.c
23 *
24 * Description: Handsfree Profile Bluetooth Interface
25 *
26 *
27 ***********************************************************************************/
28 #include <hardware/bluetooth.h>
29 #include <hardware/bt_sock.h>
30 #include <errno.h>
31 #include <sys/ioctl.h>
32 #include <stdio.h>
33 #include <string.h>
34 #include <sys/types.h>
35 #include <sys/socket.h>
36 #include <sys/un.h>
37 #include <arpa/inet.h>
38 #include <netinet/in.h>
39 #include <stdlib.h>
40 #include <errno.h>
41 #include <unistd.h>
42 #include <sys/ioctl.h>
43
44 #include <cutils/sockets.h>
45 #include <netinet/tcp.h>
46
47
48 #define LOG_TAG "BTIF_SOCK"
49 #include "btif_common.h"
50 #include "btif_util.h"
51
52 #include "bd.h"
53
54 #include "bta_api.h"
55 #include "btif_sock_thread.h"
56 #include "btif_sock_sdp.h"
57
58 #include "bt_target.h"
59 #include "gki.h"
60 #include "hcimsgs.h"
61 #include "sdp_api.h"
62 #include "btu.h"
63 #include "btm_api.h"
64 #include "btm_int.h"
65 #include "bta_jv_api.h"
66 #include "bta_jv_co.h"
67 #include "port_api.h"
68
69 #define asrt(s) if(!(s)) BTIF_TRACE_ERROR3("## %s assert %s failed at line:%d ##",__FUNCTION__, #s, __LINE__)
70
71
sock_send_all(int sock_fd,const uint8_t * buf,int len)72 int sock_send_all(int sock_fd, const uint8_t* buf, int len)
73 {
74 int s = len;
75 int ret;
76 while(s)
77 {
78 do ret = send(sock_fd, buf, s, 0);
79 while(ret < 0 && errno == EINTR);
80 if(ret <= 0)
81 {
82 BTIF_TRACE_ERROR3("sock fd:%d send errno:%d, ret:%d", sock_fd, errno, ret);
83 return -1;
84 }
85 buf += ret;
86 s -= ret;
87 }
88 return len;
89 }
sock_recv_all(int sock_fd,uint8_t * buf,int len)90 int sock_recv_all(int sock_fd, uint8_t* buf, int len)
91 {
92 int r = len;
93 int ret = -1;
94 while(r)
95 {
96 do ret = recv(sock_fd, buf, r, MSG_WAITALL);
97 while(ret < 0 && errno == EINTR);
98 if(ret <= 0)
99 {
100 BTIF_TRACE_ERROR3("sock fd:%d recv errno:%d, ret:%d", sock_fd, errno, ret);
101 return -1;
102 }
103 buf += ret;
104 r -= ret;
105 }
106 return len;
107 }
108
sock_send_fd(int sock_fd,const uint8_t * buf,int len,int send_fd)109 int sock_send_fd(int sock_fd, const uint8_t* buf, int len, int send_fd)
110 {
111 ssize_t ret;
112 struct msghdr msg;
113 unsigned char *buffer = (unsigned char *)buf;
114 memset(&msg, 0, sizeof(msg));
115
116 struct cmsghdr *cmsg;
117 char msgbuf[CMSG_SPACE(1)];
118 asrt(send_fd != -1);
119 if(sock_fd == -1 || send_fd == -1)
120 return -1;
121 // Add any pending outbound file descriptors to the message
122 // See "man cmsg" really
123 msg.msg_control = msgbuf;
124 msg.msg_controllen = sizeof msgbuf;
125 cmsg = CMSG_FIRSTHDR(&msg);
126 cmsg->cmsg_level = SOL_SOCKET;
127 cmsg->cmsg_type = SCM_RIGHTS;
128 cmsg->cmsg_len = CMSG_LEN(sizeof send_fd);
129 memcpy(CMSG_DATA(cmsg), &send_fd, sizeof send_fd);
130
131 // We only write our msg_control during the first write
132 int ret_len = len;
133 while (len > 0) {
134 struct iovec iv;
135 memset(&iv, 0, sizeof(iv));
136
137 iv.iov_base = buffer;
138 iv.iov_len = len;
139
140 msg.msg_iov = &iv;
141 msg.msg_iovlen = 1;
142
143 do {
144 ret = sendmsg(sock_fd, &msg, MSG_NOSIGNAL);
145 } while (ret < 0 && errno == EINTR);
146
147 if (ret < 0) {
148 BTIF_TRACE_ERROR5("fd:%d, send_fd:%d, sendmsg ret:%d, errno:%d, %s",
149 sock_fd, send_fd, (int)ret, errno, strerror(errno));
150 ret_len = -1;
151 break;
152 }
153
154 buffer += ret;
155 len -= ret;
156
157 // Wipes out any msg_control too
158 memset(&msg, 0, sizeof(msg));
159 }
160 BTIF_TRACE_DEBUG1("close fd:%d after sent", send_fd);
161 close(send_fd);
162 return ret_len;
163 }
164
165
166 #define PRINT(s) __android_log_write(ANDROID_LOG_DEBUG, NULL, s)
167 static const char* hex_table = "0123456789abcdef";
byte2hex(const char * data,char ** str)168 static inline void byte2hex(const char* data, char** str)
169 {
170 **str = hex_table[(*data >> 4) & 0xf];
171 ++*str;
172 **str = hex_table[*data & 0xf];
173 ++*str;
174 }
byte2char(const char * data,char ** str)175 static inline void byte2char(const char* data, char** str)
176 {
177 **str = *data < ' ' ? '.' : *data > '~' ? '.' : *data;
178 ++(*str);
179 }
word2hex(const char * data,char ** hex)180 static inline void word2hex(const char* data, char** hex)
181 {
182 byte2hex(&data[1], hex);
183 byte2hex(&data[0], hex);
184 }
dump_bin(const char * title,const char * data,int size)185 void dump_bin(const char* title, const char* data, int size)
186 {
187 char line_buff[256];
188 char *line;
189 int i, j, addr;
190 const int width = 16;
191 ALOGD("%s, size:%d, dump started {", title, size);
192 if(size <= 0)
193 return;
194 //write offset
195 line = line_buff;
196 *line++ = ' ';
197 *line++ = ' ';
198 *line++ = ' ';
199 *line++ = ' ';
200 *line++ = ' ';
201 *line++ = ' ';
202 for(j = 0; j < width; j++)
203 {
204 byte2hex((const char*)&j, &line);
205 *line++ = ' ';
206 }
207 *line = 0;
208 PRINT(line_buff);
209
210 for(i = 0; i < size / width; i++)
211 {
212 line = line_buff;
213 //write address:
214 addr = i*width;
215 word2hex((const char*)&addr, &line);
216 *line++ = ':'; *line++ = ' ';
217 //write hex of data
218 for(j = 0; j < width; j++)
219 {
220 byte2hex(&data[j], &line);
221 *line++ = ' ';
222 }
223 //write char of data
224 for(j = 0; j < width; j++)
225 byte2char(data++, &line);
226 //wirte the end of line
227 *line = 0;
228 //output the line
229 PRINT(line_buff);
230 }
231 //last line of left over if any
232 int leftover = size % width;
233 if(leftover > 0)
234 {
235 line = line_buff;
236 //write address:
237 addr = i*width;
238 word2hex((const char*)&addr, &line);
239 *line++ = ':'; *line++ = ' ';
240 //write hex of data
241 for(j = 0; j < leftover; j++) {
242 byte2hex(&data[j], &line);
243 *line++ = ' ';
244 }
245 //write hex padding
246 for(; j < width; j++) {
247 *line++ = ' ';
248 *line++ = ' ';
249 *line++ = ' ';
250 }
251 //write char of data
252 for(j = 0; j < leftover; j++)
253 byte2char(data++, &line);
254 //write the end of line
255 *line = 0;
256 //output the line
257 PRINT(line_buff);
258 }
259 ALOGD("%s, size:%d, dump ended }", title, size);
260 }
261
262