1 /* $NetBSD: hci.c,v 1.2 2007/01/25 20:33:41 plunky Exp $ */
2 /* $DragonFly: src/usr.sbin/bthcid/hci.c,v 1.2 2008/02/02 09:21:24 swildner Exp $ */
3
4 /*-
5 * Copyright (c) 2006 Itronix Inc.
6 * All rights reserved.
7 *
8 * Redistribution and use in source and binary forms, with or without
9 * modification, are permitted provided that the following conditions
10 * are met:
11 * 1. Redistributions of source code must retain the above copyright
12 * notice, this list of conditions and the following disclaimer.
13 * 2. Redistributions in binary form must reproduce the above copyright
14 * notice, this list of conditions and the following disclaimer in the
15 * documentation and/or other materials provided with the distribution.
16 * 3. The name of Itronix Inc. may not be used to endorse
17 * or promote products derived from this software without specific
18 * prior written permission.
19 *
20 * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
21 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
24 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
25 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
26 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
27 * ON ANY THEORY OF LIABILITY, WHETHER IN
28 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 * POSSIBILITY OF SUCH DAMAGE.
31 */
32 /*
33 * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com>
34 * All rights reserved.
35 *
36 * Redistribution and use in source and binary forms, with or without
37 * modification, are permitted provided that the following conditions
38 * are met:
39 * 1. Redistributions of source code must retain the above copyright
40 * notice, this list of conditions and the following disclaimer.
41 * 2. Redistributions in binary form must reproduce the above copyright
42 * notice, this list of conditions and the following disclaimer in the
43 * documentation and/or other materials provided with the distribution.
44 *
45 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
46 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
47 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
48 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
49 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
50 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
51 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
52 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
53 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
54 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
55 * SUCH DAMAGE.
56 */
57
58 #include <sys/ioctl.h>
59 #include <sys/time.h>
60 #include <sys/event.h>
61 #include <sys/types.h>
62 #include <bluetooth.h>
63 #include <errno.h>
64 #include <string.h>
65 #include <syslog.h>
66 #include <unistd.h>
67
68 #include "bthcid.h"
69
70 static int process_pin_code_request_event
71 (int, struct sockaddr_bt *, bdaddr_t *);
72 static int process_link_key_request_event
73 (int, struct sockaddr_bt *, bdaddr_t *);
74 static int process_link_key_notification_event
75 (int, struct sockaddr_bt *, hci_link_key_notification_ep *);
76
77 static int send_link_key_reply
78 (int, struct sockaddr_bt *, bdaddr_t *, uint8_t *);
79 static int send_hci_cmd
80 (int, struct sockaddr_bt *, uint16_t, size_t, void *);
81
82 static char dev_name[HCI_DEVNAME_SIZE];
83
84 /* Initialise HCI Events */
85 int
init_hci(bdaddr_t * bdaddr)86 init_hci(bdaddr_t *bdaddr)
87 {
88 struct sockaddr_bt sa;
89 struct hci_filter filter;
90 struct kevent change;
91 struct timespec timeout = { 0, 0 };
92 int hci;
93
94 hci = socket(PF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI);
95 if (hci < 0)
96 return -1;
97
98 memset(&sa, 0, sizeof(sa));
99 sa.bt_len = sizeof(sa);
100 sa.bt_family = AF_BLUETOOTH;
101 bdaddr_copy(&sa.bt_bdaddr, bdaddr);
102 if (bind(hci, (struct sockaddr *)&sa, sizeof(sa)) < 0) {
103 close(hci);
104 return -1;
105 }
106
107 memset(&filter, 0, sizeof(filter));
108 hci_filter_set(HCI_EVENT_PIN_CODE_REQ, &filter);
109 hci_filter_set(HCI_EVENT_LINK_KEY_REQ, &filter);
110 hci_filter_set(HCI_EVENT_LINK_KEY_NOTIFICATION, &filter);
111
112 if (setsockopt(hci, BTPROTO_HCI, SO_HCI_EVT_FILTER,
113 (const void *)&filter, sizeof(filter)) < 0) {
114 close(hci);
115 return -1;
116 }
117
118 EV_SET(&change, hci, EVFILT_READ, EV_ADD, 0, 0, NULL);
119 if (kevent(hci_kq, &change, 1, NULL, 0, &timeout) == -1) {
120 close(hci);
121 return -1;
122 }
123
124 return hci;
125 }
126
127 /* Process an HCI event */
128 void
process_hci(int sock)129 process_hci(int sock)
130 {
131 char buffer[HCI_EVENT_PKT_SIZE];
132 hci_event_hdr_t *event = (hci_event_hdr_t *)buffer;
133 struct sockaddr_bt addr;
134 int n;
135 socklen_t size;
136
137 size = sizeof(addr);
138 n = recvfrom(sock, buffer, sizeof(buffer), 0,
139 (struct sockaddr *) &addr, &size);
140 if (n < 0) {
141 syslog(LOG_ERR, "Could not receive from HCI socket: %m");
142 return;
143 }
144
145 if (event->type != HCI_EVENT_PKT) {
146 syslog(LOG_ERR, "Received unexpected HCI packet, "
147 "type=%#x", event->type);
148
149 return;
150 }
151
152 if (!bt_devname(dev_name, &addr.bt_bdaddr))
153 strlcpy(dev_name, "unknown", sizeof(dev_name));
154
155 switch (event->event) {
156 case HCI_EVENT_PIN_CODE_REQ:
157 process_pin_code_request_event(sock, &addr,
158 (bdaddr_t *)(event + 1));
159 break;
160
161 case HCI_EVENT_LINK_KEY_REQ:
162 process_link_key_request_event(sock, &addr,
163 (bdaddr_t *)(event + 1));
164 break;
165
166 case HCI_EVENT_LINK_KEY_NOTIFICATION:
167 process_link_key_notification_event(sock, &addr,
168 (hci_link_key_notification_ep *)(event + 1));
169 break;
170
171 default:
172 syslog(LOG_ERR, "Received unexpected HCI event, "
173 "event=%#x", event->event);
174 break;
175 }
176
177 return;
178 }
179
180 /* Process PIN_Code_Request event */
181 static int
process_pin_code_request_event(int sock,struct sockaddr_bt * addr,bdaddr_t * bdaddr)182 process_pin_code_request_event(int sock, struct sockaddr_bt *addr,
183 bdaddr_t *bdaddr)
184 {
185 /* TODO: Add search pin in config file */
186
187 uint8_t *pin;
188 uint8_t *pin2;
189
190 syslog(LOG_DEBUG, "Got PIN_Code_Request event from %s, "
191 "remote bdaddr %s",
192 dev_name,
193 bt_ntoa(bdaddr, NULL));
194
195 pin = lookup_pin(&addr->bt_bdaddr, bdaddr);
196 if (pin != NULL)
197 return send_pin_code_reply(sock, addr, bdaddr, pin);
198
199 pin2 = lookup_pin_conf(&addr->bt_bdaddr, bdaddr);
200 if (pin2 != NULL) {
201 return send_pin_code_reply(sock, addr, bdaddr, pin2);
202 }
203
204 if (send_client_request(&addr->bt_bdaddr, bdaddr, sock) == 0)
205 return send_pin_code_reply(sock, addr, bdaddr, NULL);
206
207 return 0;
208 }
209
210 /* Process Link_Key_Request event */
211 static int
process_link_key_request_event(int sock,struct sockaddr_bt * addr,bdaddr_t * bdaddr)212 process_link_key_request_event(int sock, struct sockaddr_bt *addr,
213 bdaddr_t *bdaddr)
214 {
215 uint8_t *key;
216
217 syslog(LOG_DEBUG,
218 "Got Link_Key_Request event from %s, remote bdaddr %s",
219 dev_name, bt_ntoa(bdaddr, NULL));
220
221 key = lookup_key(&addr->bt_bdaddr, bdaddr);
222
223 if (key != NULL) {
224 syslog(LOG_DEBUG, "Found Key, remote bdaddr %s",
225 bt_ntoa(bdaddr, NULL));
226
227 return send_link_key_reply(sock, addr, bdaddr, key);
228 }
229
230 syslog(LOG_DEBUG, "Could not find link key for remote bdaddr %s",
231 bt_ntoa(bdaddr, NULL));
232
233 return send_link_key_reply(sock, addr, bdaddr, NULL);
234 }
235
236 /* Send PIN_Code_[Negative]_Reply */
237 int
send_pin_code_reply(int sock,struct sockaddr_bt * addr,bdaddr_t * bdaddr,uint8_t * pin)238 send_pin_code_reply(int sock, struct sockaddr_bt *addr,
239 bdaddr_t *bdaddr, uint8_t *pin)
240 {
241 int n;
242
243 if (pin != NULL) {
244 hci_pin_code_rep_cp cp;
245
246 syslog(LOG_DEBUG, "Sending PIN_Code_Reply to %s "
247 "for remote bdaddr %s",
248 dev_name,
249 bt_ntoa(bdaddr, NULL));
250
251 bdaddr_copy(&cp.bdaddr, bdaddr);
252 memcpy(cp.pin, pin, HCI_PIN_SIZE);
253
254 n = HCI_PIN_SIZE;
255 while (n > 0 && pin[n - 1] == 0)
256 n--;
257 cp.pin_size = n;
258
259 n = send_hci_cmd(sock, addr,
260 HCI_CMD_PIN_CODE_REP, sizeof(cp), &cp);
261
262 } else {
263 syslog(LOG_DEBUG, "Sending PIN_Code_Negative_Reply to %s "
264 "for remote bdaddr %s",
265 dev_name,
266 bt_ntoa(bdaddr, NULL));
267
268 n = send_hci_cmd(sock, addr, HCI_CMD_PIN_CODE_NEG_REP,
269 sizeof(bdaddr_t), bdaddr);
270 }
271
272 if (n < 0) {
273 syslog(LOG_ERR, "Could not send PIN code reply to %s "
274 "for remote bdaddr %s: %m",
275 dev_name,
276 bt_ntoa(bdaddr, NULL));
277
278 return -1;
279 }
280
281 return 0;
282 }
283
284 /* Send Link_Key_[Negative]_Reply */
285 static int
send_link_key_reply(int sock,struct sockaddr_bt * addr,bdaddr_t * bdaddr,uint8_t * key)286 send_link_key_reply(int sock, struct sockaddr_bt *addr,
287 bdaddr_t *bdaddr, uint8_t *key)
288 {
289 int n;
290
291 if (key != NULL) {
292 hci_link_key_rep_cp cp;
293
294 bdaddr_copy(&cp.bdaddr, bdaddr);
295 memcpy(&cp.key, key, sizeof(cp.key));
296
297 syslog(LOG_DEBUG, "Sending Link_Key_Reply to %s "
298 "for remote bdaddr %s",
299 dev_name, bt_ntoa(bdaddr, NULL));
300
301 n = send_hci_cmd(sock, addr, HCI_CMD_LINK_KEY_REP, sizeof(cp), &cp);
302 } else {
303 hci_link_key_neg_rep_cp cp;
304
305 bdaddr_copy(&cp.bdaddr, bdaddr);
306
307 syslog(LOG_DEBUG, "Sending Link_Key_Negative_Reply to %s "
308 "for remote bdaddr %s",
309 dev_name, bt_ntoa(bdaddr, NULL));
310
311 n = send_hci_cmd(sock, addr, HCI_CMD_LINK_KEY_NEG_REP, sizeof(cp), &cp);
312 }
313
314 if (n < 0) {
315 syslog(LOG_ERR, "Could not send link key reply to %s "
316 "for remote bdaddr %s: %m",
317 dev_name, bt_ntoa(bdaddr, NULL));
318 return -1;
319 }
320
321 return 0;
322 }
323
324 /* Process Link_Key_Notification event */
325 static int
process_link_key_notification_event(int sock __unused,struct sockaddr_bt * addr,hci_link_key_notification_ep * ep)326 process_link_key_notification_event(int sock __unused, struct sockaddr_bt *addr,
327 hci_link_key_notification_ep *ep)
328 {
329
330 syslog(LOG_DEBUG, "Got Link_Key_Notification event from %s, "
331 "remote bdaddr %s",
332 dev_name,
333 bt_ntoa(&ep->bdaddr, NULL));
334
335 save_key(&addr->bt_bdaddr, &ep->bdaddr, ep->key);
336 return 0;
337 }
338
339 /* Send HCI Command Packet to socket */
340 static int
send_hci_cmd(int sock,struct sockaddr_bt * sa,uint16_t opcode,size_t len,void * buf)341 send_hci_cmd(int sock, struct sockaddr_bt *sa, uint16_t opcode, size_t len, void *buf)
342 {
343 char msg[HCI_CMD_PKT_SIZE];
344 hci_cmd_hdr_t *h = (hci_cmd_hdr_t *)msg;
345
346 h->type = HCI_CMD_PKT;
347 h->opcode = htole16(opcode);
348 h->length = len;
349
350 if (len > 0)
351 memcpy(msg + sizeof(hci_cmd_hdr_t), buf, len);
352
353 return sendto(sock, msg, sizeof(hci_cmd_hdr_t) + len, 0,
354 (struct sockaddr *)sa, sizeof(*sa));
355 }
356