hci_socket.c revision 1.42 1 /* $NetBSD: hci_socket.c,v 1.42 2015/04/24 22:32:37 rtr Exp $ */
2
3 /*-
4 * Copyright (c) 2005 Iain Hibbert.
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 #include <sys/cdefs.h>
34 __KERNEL_RCSID(0, "$NetBSD: hci_socket.c,v 1.42 2015/04/24 22:32:37 rtr Exp $");
35
36 /* load symbolic names */
37 #ifdef BLUETOOTH_DEBUG
38 #define PRUREQUESTS
39 #define PRCOREQUESTS
40 #endif
41
42 #include <sys/param.h>
43 #include <sys/domain.h>
44 #include <sys/kauth.h>
45 #include <sys/kernel.h>
46 #include <sys/kmem.h>
47 #include <sys/mbuf.h>
48 #include <sys/proc.h>
49 #include <sys/protosw.h>
50 #include <sys/socket.h>
51 #include <sys/socketvar.h>
52 #include <sys/systm.h>
53
54 #include <netbt/bluetooth.h>
55 #include <netbt/hci.h>
56
57 /*******************************************************************************
58 *
59 * HCI SOCK_RAW Sockets - for control of Bluetooth Devices
60 *
61 */
62
63 /*
64 * the raw HCI protocol control block
65 */
66 struct hci_pcb {
67 struct socket *hp_socket; /* socket */
68 kauth_cred_t hp_cred; /* owner credential */
69 unsigned int hp_flags; /* flags */
70 bdaddr_t hp_laddr; /* local address */
71 bdaddr_t hp_raddr; /* remote address */
72 struct hci_filter hp_efilter; /* user event filter */
73 struct hci_filter hp_pfilter; /* user packet filter */
74 LIST_ENTRY(hci_pcb) hp_next; /* next HCI pcb */
75 };
76
77 /* hp_flags */
78 #define HCI_DIRECTION (1<<1) /* direction control messages */
79 #define HCI_PROMISCUOUS (1<<2) /* listen to all units */
80
81 LIST_HEAD(hci_pcb_list, hci_pcb) hci_pcb = LIST_HEAD_INITIALIZER(hci_pcb);
82
83 /* sysctl defaults */
84 int hci_sendspace = HCI_CMD_PKT_SIZE;
85 int hci_recvspace = 4096;
86
87 /* unprivileged commands opcode table */
88 static const struct {
89 uint16_t opcode;
90 uint8_t offs; /* 0 - 63 */
91 uint8_t mask; /* bit 0 - 7 */
92 uint8_t length; /* approved length */
93 } hci_cmds[] = {
94 { HCI_CMD_INQUIRY,
95 0, 0x01, sizeof(hci_inquiry_cp) },
96 { HCI_CMD_REMOTE_NAME_REQ,
97 2, 0x08, sizeof(hci_remote_name_req_cp) },
98 { HCI_CMD_READ_REMOTE_FEATURES,
99 2, 0x20, sizeof(hci_read_remote_features_cp) },
100 { HCI_CMD_READ_REMOTE_EXTENDED_FEATURES,
101 2, 0x40, sizeof(hci_read_remote_extended_features_cp) },
102 { HCI_CMD_READ_REMOTE_VER_INFO,
103 2, 0x80, sizeof(hci_read_remote_ver_info_cp) },
104 { HCI_CMD_READ_CLOCK_OFFSET,
105 3, 0x01, sizeof(hci_read_clock_offset_cp) },
106 { HCI_CMD_READ_LMP_HANDLE,
107 3, 0x02, sizeof(hci_read_lmp_handle_cp) },
108 { HCI_CMD_ROLE_DISCOVERY,
109 4, 0x80, sizeof(hci_role_discovery_cp) },
110 { HCI_CMD_READ_LINK_POLICY_SETTINGS,
111 5, 0x02, sizeof(hci_read_link_policy_settings_cp) },
112 { HCI_CMD_READ_DEFAULT_LINK_POLICY_SETTINGS,
113 5, 0x08, 0 },
114 { HCI_CMD_READ_PIN_TYPE,
115 6, 0x04, 0 },
116 { HCI_CMD_READ_LOCAL_NAME,
117 7, 0x02, 0 },
118 { HCI_CMD_READ_CON_ACCEPT_TIMEOUT,
119 7, 0x04, 0 },
120 { HCI_CMD_READ_PAGE_TIMEOUT,
121 7, 0x10, 0 },
122 { HCI_CMD_READ_SCAN_ENABLE,
123 7, 0x40, 0 },
124 { HCI_CMD_READ_PAGE_SCAN_ACTIVITY,
125 8, 0x01, 0 },
126 { HCI_CMD_READ_INQUIRY_SCAN_ACTIVITY,
127 8, 0x04, 0 },
128 { HCI_CMD_READ_AUTH_ENABLE,
129 8, 0x10, 0 },
130 { HCI_CMD_READ_ENCRYPTION_MODE,
131 8, 0x40, 0 },
132 { HCI_CMD_READ_UNIT_CLASS,
133 9, 0x01, 0 },
134 { HCI_CMD_READ_VOICE_SETTING,
135 9, 0x04, 0 },
136 { HCI_CMD_READ_AUTO_FLUSH_TIMEOUT,
137 9, 0x10, sizeof(hci_read_auto_flush_timeout_cp) },
138 { HCI_CMD_READ_NUM_BROADCAST_RETRANS,
139 9, 0x40, 0 },
140 { HCI_CMD_READ_HOLD_MODE_ACTIVITY,
141 10, 0x01, 0 },
142 { HCI_CMD_READ_XMIT_LEVEL,
143 10, 0x04, sizeof(hci_read_xmit_level_cp) },
144 { HCI_CMD_READ_SCO_FLOW_CONTROL,
145 10, 0x08, 0 },
146 { HCI_CMD_READ_LINK_SUPERVISION_TIMEOUT,
147 11, 0x01, sizeof(hci_read_link_supervision_timeout_cp) },
148 { HCI_CMD_READ_NUM_SUPPORTED_IAC,
149 11, 0x04, 0 },
150 { HCI_CMD_READ_IAC_LAP,
151 11, 0x08, 0 },
152 { HCI_CMD_READ_PAGE_SCAN_PERIOD,
153 11, 0x20, 0 },
154 { HCI_CMD_READ_PAGE_SCAN,
155 11, 0x80, 0 },
156 { HCI_CMD_READ_INQUIRY_SCAN_TYPE,
157 12, 0x10, 0 },
158 { HCI_CMD_READ_INQUIRY_MODE,
159 12, 0x40, 0 },
160 { HCI_CMD_READ_PAGE_SCAN_TYPE,
161 13, 0x01, 0 },
162 { HCI_CMD_READ_AFH_ASSESSMENT,
163 13, 0x04, 0 },
164 { HCI_CMD_READ_LOCAL_VER,
165 14, 0x08, 0 },
166 { HCI_CMD_READ_LOCAL_COMMANDS,
167 14, 0x10, 0 },
168 { HCI_CMD_READ_LOCAL_FEATURES,
169 14, 0x20, 0 },
170 { HCI_CMD_READ_LOCAL_EXTENDED_FEATURES,
171 14, 0x40, sizeof(hci_read_local_extended_features_cp) },
172 { HCI_CMD_READ_BUFFER_SIZE,
173 14, 0x80, 0 },
174 { HCI_CMD_READ_COUNTRY_CODE,
175 15, 0x01, 0 },
176 { HCI_CMD_READ_BDADDR,
177 15, 0x02, 0 },
178 { HCI_CMD_READ_FAILED_CONTACT_CNTR,
179 15, 0x04, sizeof(hci_read_failed_contact_cntr_cp) },
180 { HCI_CMD_READ_LINK_QUALITY,
181 15, 0x10, sizeof(hci_read_link_quality_cp) },
182 { HCI_CMD_READ_RSSI,
183 15, 0x20, sizeof(hci_read_rssi_cp) },
184 { HCI_CMD_READ_AFH_CHANNEL_MAP,
185 15, 0x40, sizeof(hci_read_afh_channel_map_cp) },
186 { HCI_CMD_READ_CLOCK,
187 15, 0x80, sizeof(hci_read_clock_cp) },
188 { HCI_CMD_READ_LOOPBACK_MODE,
189 16, 0x01, 0 },
190 { HCI_CMD_READ_EXTENDED_INQUIRY_RSP,
191 17, 0x01, 0 },
192 { HCI_CMD_READ_SIMPLE_PAIRING_MODE,
193 17, 0x20, 0 },
194 { HCI_CMD_READ_INQUIRY_RSP_XMIT_POWER,
195 18, 0x01, 0 },
196 { HCI_CMD_READ_DEFAULT_ERRDATA_REPORTING,
197 18, 0x04, 0 },
198 };
199
200 /*
201 * supply a basic device send/recv policy
202 */
203 static int
204 hci_device_cb(kauth_cred_t cred, kauth_action_t action, void *cookie,
205 void *arg0, void *arg1, void *arg2, void *arg3)
206 {
207 int i, result;
208
209 result = KAUTH_RESULT_DEFER;
210
211 switch (action) {
212 case KAUTH_DEVICE_BLUETOOTH_SEND: {
213 struct hci_unit *unit = (struct hci_unit *)arg0;
214 hci_cmd_hdr_t *hdr = (hci_cmd_hdr_t *)arg1;
215
216 /*
217 * Allow sending unprivileged commands if the packet size
218 * is correct and the unit claims to support it
219 */
220
221 if (hdr->type != HCI_CMD_PKT)
222 break;
223
224 for (i = 0; i < __arraycount(hci_cmds); i++) {
225 if (hdr->opcode == hci_cmds[i].opcode
226 && hdr->length == hci_cmds[i].length
227 && (unit->hci_cmds[hci_cmds[i].offs] & hci_cmds[i].mask)) {
228 result = KAUTH_RESULT_ALLOW;
229 break;
230 }
231 }
232
233 break;
234 }
235
236 case KAUTH_DEVICE_BLUETOOTH_RECV:
237 switch((uint8_t)(uintptr_t)arg0) {
238 case HCI_CMD_PKT: {
239 uint16_t opcode = (uint16_t)(uintptr_t)arg1;
240
241 /*
242 * Allow to see any unprivileged command packet
243 */
244
245 for (i = 0; i < __arraycount(hci_cmds); i++) {
246 if (opcode == hci_cmds[i].opcode) {
247 result = KAUTH_RESULT_ALLOW;
248 break;
249 }
250 }
251
252 break;
253 }
254
255 case HCI_EVENT_PKT: {
256 uint8_t event = (uint8_t)(uintptr_t)arg1;
257
258 /*
259 * Allow to receive most events
260 */
261
262 switch (event) {
263 case HCI_EVENT_RETURN_LINK_KEYS:
264 case HCI_EVENT_LINK_KEY_NOTIFICATION:
265 case HCI_EVENT_USER_CONFIRM_REQ:
266 case HCI_EVENT_USER_PASSKEY_NOTIFICATION:
267 case HCI_EVENT_VENDOR:
268 break;
269
270 default:
271 result = KAUTH_RESULT_ALLOW;
272 break;
273 }
274
275 break;
276 }
277
278 case HCI_ACL_DATA_PKT:
279 case HCI_SCO_DATA_PKT: {
280 /* uint16_t handle = (uint16_t)(uintptr_t)arg1; */
281 /*
282 * don't normally allow receiving data packets
283 */
284 break;
285 }
286
287 default:
288 break;
289 }
290
291 break;
292
293 default:
294 break;
295 }
296
297 return result;
298 }
299
300 /*
301 * HCI protocol init routine,
302 * - set up a kauth listener to provide basic packet access policy
303 */
304 void
305 hci_init(void)
306 {
307
308 if (kauth_listen_scope(KAUTH_SCOPE_DEVICE, hci_device_cb, NULL) == NULL)
309 panic("Bluetooth HCI: cannot listen on device scope");
310 }
311
312 /*
313 * When command packet reaches the device, we can drop
314 * it from the socket buffer (called from hci_output_acl)
315 */
316 void
317 hci_drop(void *arg)
318 {
319 struct socket *so = arg;
320
321 sbdroprecord(&so->so_snd);
322 sowwakeup(so);
323 }
324
325 /*
326 * HCI socket is going away and has some pending packets. We let them
327 * go by design, but remove the context pointer as it will be invalid
328 * and we no longer need to be notified.
329 */
330 static void
331 hci_cmdwait_flush(struct socket *so)
332 {
333 struct hci_unit *unit;
334 struct socket *ctx;
335 struct mbuf *m;
336
337 DPRINTF("flushing %p\n", so);
338
339 SIMPLEQ_FOREACH(unit, &hci_unit_list, hci_next) {
340 m = MBUFQ_FIRST(&unit->hci_cmdwait);
341 while (m != NULL) {
342 ctx = M_GETCTX(m, struct socket *);
343 if (ctx == so)
344 M_SETCTX(m, NULL);
345
346 m = MBUFQ_NEXT(m);
347 }
348 }
349 }
350
351 /*
352 * HCI send packet
353 * This came from userland, so check it out.
354 */
355 static int
356 hci_send_pcb(struct hci_pcb *pcb, struct mbuf *m, bdaddr_t *addr)
357 {
358 struct hci_unit *unit;
359 struct mbuf *m0;
360 hci_cmd_hdr_t hdr;
361 int err;
362
363 KASSERT(m != NULL);
364 KASSERT(addr != NULL);
365
366 /* wants at least a header to start with */
367 if (m->m_pkthdr.len < sizeof(hdr)) {
368 err = EMSGSIZE;
369 goto bad;
370 }
371 m_copydata(m, 0, sizeof(hdr), &hdr);
372 hdr.opcode = le16toh(hdr.opcode);
373
374 /* only allows CMD packets to be sent */
375 if (hdr.type != HCI_CMD_PKT) {
376 err = EINVAL;
377 goto bad;
378 }
379
380 /* validates packet length */
381 if (m->m_pkthdr.len != sizeof(hdr) + hdr.length) {
382 err = EMSGSIZE;
383 goto bad;
384 }
385
386 /* finds destination */
387 unit = hci_unit_lookup(addr);
388 if (unit == NULL) {
389 err = ENETDOWN;
390 goto bad;
391 }
392
393 /* security checks for unprivileged users */
394 if (pcb->hp_cred != NULL
395 && kauth_authorize_device(pcb->hp_cred,
396 KAUTH_DEVICE_BLUETOOTH_SEND,
397 unit, &hdr, NULL, NULL) != 0) {
398 err = EPERM;
399 goto bad;
400 }
401
402 /* makess a copy for precious to keep */
403 m0 = m_copypacket(m, M_DONTWAIT);
404 if (m0 == NULL) {
405 err = ENOMEM;
406 goto bad;
407 }
408 sbappendrecord(&pcb->hp_socket->so_snd, m0);
409 M_SETCTX(m, pcb->hp_socket); /* enable drop callback */
410
411 DPRINTFN(2, "(%s) opcode (%03x|%04x)\n", device_xname(unit->hci_dev),
412 HCI_OGF(hdr.opcode), HCI_OCF(hdr.opcode));
413
414 /* Sendss it */
415 if (unit->hci_num_cmd_pkts == 0)
416 MBUFQ_ENQUEUE(&unit->hci_cmdwait, m);
417 else
418 hci_output_cmd(unit, m);
419
420 return 0;
421
422 bad:
423 DPRINTF("packet (%d bytes) not sent (error %d)\n",
424 m->m_pkthdr.len, err);
425 if (m) m_freem(m);
426 return err;
427 }
428
429 static int
430 hci_attach(struct socket *so, int proto)
431 {
432 struct hci_pcb *pcb;
433 int error;
434
435 KASSERT(so->so_pcb == NULL);
436
437 if (so->so_lock == NULL) {
438 mutex_obj_hold(bt_lock);
439 so->so_lock = bt_lock;
440 solock(so);
441 }
442 KASSERT(solocked(so));
443
444 error = soreserve(so, hci_sendspace, hci_recvspace);
445 if (error) {
446 return error;
447 }
448
449 pcb = kmem_zalloc(sizeof(struct hci_pcb), KM_SLEEP);
450 pcb->hp_cred = kauth_cred_dup(curlwp->l_cred);
451 pcb->hp_socket = so;
452
453 /*
454 * Set default user filter. By default, socket only passes
455 * Command_Complete and Command_Status Events.
456 */
457 hci_filter_set(HCI_EVENT_COMMAND_COMPL, &pcb->hp_efilter);
458 hci_filter_set(HCI_EVENT_COMMAND_STATUS, &pcb->hp_efilter);
459 hci_filter_set(HCI_EVENT_PKT, &pcb->hp_pfilter);
460
461 LIST_INSERT_HEAD(&hci_pcb, pcb, hp_next);
462 so->so_pcb = pcb;
463
464 return 0;
465 }
466
467 static void
468 hci_detach(struct socket *so)
469 {
470 struct hci_pcb *pcb;
471
472 pcb = (struct hci_pcb *)so->so_pcb;
473 KASSERT(pcb != NULL);
474
475 if (so->so_snd.sb_mb != NULL)
476 hci_cmdwait_flush(so);
477
478 if (pcb->hp_cred != NULL)
479 kauth_cred_free(pcb->hp_cred);
480
481 so->so_pcb = NULL;
482 LIST_REMOVE(pcb, hp_next);
483 kmem_free(pcb, sizeof(*pcb));
484 }
485
486 static int
487 hci_accept(struct socket *so, struct sockaddr *nam)
488 {
489 KASSERT(solocked(so));
490
491 return EOPNOTSUPP;
492 }
493
494 static int
495 hci_bind(struct socket *so, struct sockaddr *nam, struct lwp *l)
496 {
497 struct hci_pcb *pcb = so->so_pcb;
498 struct sockaddr_bt *sa = (struct sockaddr_bt *)nam;
499
500 KASSERT(solocked(so));
501 KASSERT(pcb != NULL);
502 KASSERT(nam != NULL);
503
504 if (sa->bt_len != sizeof(struct sockaddr_bt))
505 return EINVAL;
506
507 if (sa->bt_family != AF_BLUETOOTH)
508 return EAFNOSUPPORT;
509
510 bdaddr_copy(&pcb->hp_laddr, &sa->bt_bdaddr);
511
512 if (bdaddr_any(&sa->bt_bdaddr))
513 pcb->hp_flags |= HCI_PROMISCUOUS;
514 else
515 pcb->hp_flags &= ~HCI_PROMISCUOUS;
516
517 return 0;
518 }
519
520 static int
521 hci_listen(struct socket *so, struct lwp *l)
522 {
523 KASSERT(solocked(so));
524
525 return EOPNOTSUPP;
526 }
527
528 static int
529 hci_connect(struct socket *so, struct mbuf *nam, struct lwp *l)
530 {
531 struct hci_pcb *pcb = so->so_pcb;
532 struct sockaddr_bt *sa;
533
534 KASSERT(solocked(so));
535 KASSERT(pcb != NULL);
536 KASSERT(nam != NULL);
537
538 sa = mtod(nam, struct sockaddr_bt *);
539 if (sa->bt_len != sizeof(struct sockaddr_bt))
540 return EINVAL;
541
542 if (sa->bt_family != AF_BLUETOOTH)
543 return EAFNOSUPPORT;
544
545 if (hci_unit_lookup(&sa->bt_bdaddr) == NULL)
546 return EADDRNOTAVAIL;
547
548 bdaddr_copy(&pcb->hp_raddr, &sa->bt_bdaddr);
549 soisconnected(so);
550 return 0;
551 }
552
553 static int
554 hci_connect2(struct socket *so, struct socket *so2)
555 {
556 KASSERT(solocked(so));
557
558 return EOPNOTSUPP;
559 }
560
561 static int
562 hci_disconnect(struct socket *so)
563 {
564 struct hci_pcb *pcb = so->so_pcb;
565
566 KASSERT(solocked(so));
567 KASSERT(pcb != NULL);
568
569 bdaddr_copy(&pcb->hp_raddr, BDADDR_ANY);
570
571 /* XXX we cannot call soisdisconnected() here, as it sets
572 * SS_CANTRCVMORE and SS_CANTSENDMORE. The problem being,
573 * that soisconnected() does not clear these and if you
574 * try to reconnect this socket (which is permitted) you
575 * get a broken pipe when you try to write any data.
576 */
577 so->so_state &= ~SS_ISCONNECTED;
578 return 0;
579 }
580
581 static int
582 hci_shutdown(struct socket *so)
583 {
584 KASSERT(solocked(so));
585
586 socantsendmore(so);
587 return 0;
588 }
589
590 static int
591 hci_abort(struct socket *so)
592 {
593 KASSERT(solocked(so));
594
595 soisdisconnected(so);
596 hci_detach(so);
597 return 0;
598 }
599
600 static int
601 hci_ioctl(struct socket *so, u_long cmd, void *nam, struct ifnet *ifp)
602 {
603 int err;
604 mutex_enter(bt_lock);
605 err = hci_ioctl_pcb(cmd, nam);
606 mutex_exit(bt_lock);
607 return err;
608 }
609
610 static int
611 hci_stat(struct socket *so, struct stat *ub)
612 {
613 KASSERT(solocked(so));
614
615 return 0;
616 }
617
618 static int
619 hci_peeraddr(struct socket *so, struct sockaddr *nam)
620 {
621 struct hci_pcb *pcb = (struct hci_pcb *)so->so_pcb;
622 struct sockaddr_bt *sa = (struct sockaddr_bt *)nam;
623
624 KASSERT(solocked(so));
625 KASSERT(pcb != NULL);
626 KASSERT(nam != NULL);
627
628 memset(sa, 0, sizeof(struct sockaddr_bt));
629 sa->bt_len = sizeof(struct sockaddr_bt);
630 sa->bt_family = AF_BLUETOOTH;
631 bdaddr_copy(&sa->bt_bdaddr, &pcb->hp_raddr);
632 return 0;
633 }
634
635 static int
636 hci_sockaddr(struct socket *so, struct sockaddr *nam)
637 {
638 struct hci_pcb *pcb = (struct hci_pcb *)so->so_pcb;
639 struct sockaddr_bt *sa = (struct sockaddr_bt *)nam;
640
641 KASSERT(solocked(so));
642 KASSERT(pcb != NULL);
643 KASSERT(nam != NULL);
644
645 memset(sa, 0, sizeof(struct sockaddr_bt));
646 sa->bt_len = sizeof(struct sockaddr_bt);
647 sa->bt_family = AF_BLUETOOTH;
648 bdaddr_copy(&sa->bt_bdaddr, &pcb->hp_laddr);
649 return 0;
650 }
651
652 static int
653 hci_rcvd(struct socket *so, int flags, struct lwp *l)
654 {
655 KASSERT(solocked(so));
656
657 return EOPNOTSUPP;
658 }
659
660 static int
661 hci_recvoob(struct socket *so, struct mbuf *m, int flags)
662 {
663 KASSERT(solocked(so));
664
665 return EOPNOTSUPP;
666 }
667
668 static int
669 hci_send(struct socket *so, struct mbuf *m, struct mbuf *nam,
670 struct mbuf *control, struct lwp *l)
671 {
672 struct hci_pcb *pcb = so->so_pcb;
673 struct sockaddr_bt * sa = NULL;
674 int err = 0;
675
676 KASSERT(solocked(so));
677 KASSERT(pcb != NULL);
678
679 if (control) /* have no use for this */
680 m_freem(control);
681
682 if (nam) {
683 sa = mtod(nam, struct sockaddr_bt *);
684
685 if (sa->bt_len != sizeof(struct sockaddr_bt)) {
686 err = EINVAL;
687 goto release;
688 }
689
690 if (sa->bt_family != AF_BLUETOOTH) {
691 err = EAFNOSUPPORT;
692 goto release;
693 }
694 }
695
696 return hci_send_pcb(pcb, m, (sa ? &sa->bt_bdaddr : &pcb->hp_raddr));
697
698 release:
699 if (m)
700 m_freem(m);
701
702 return err;
703 }
704
705 static int
706 hci_sendoob(struct socket *so, struct mbuf *m, struct mbuf *control)
707 {
708 KASSERT(solocked(so));
709
710 if (m)
711 m_freem(m);
712 if (control)
713 m_freem(control);
714
715 return EOPNOTSUPP;
716 }
717
718 static int
719 hci_purgeif(struct socket *so, struct ifnet *ifp)
720 {
721
722 return EOPNOTSUPP;
723 }
724
725 /*
726 * User Request.
727 * up is socket
728 * m is optional mbuf chain containing message
729 * nam is optional mbuf chain containing an address
730 * ctl is optional mbuf chain containing socket options
731 * l is pointer to process requesting action (if any)
732 *
733 * we are responsible for disposing of m and ctl
734 */
735 static int
736 hci_usrreq(struct socket *up, int req, struct mbuf *m,
737 struct mbuf *nam, struct mbuf *ctl, struct lwp *l)
738 {
739 struct hci_pcb *pcb = up->so_pcb;
740 int err = 0;
741
742 DPRINTFN(2, "%s\n", prurequests[req]);
743 KASSERT(req != PRU_ATTACH);
744 KASSERT(req != PRU_DETACH);
745 KASSERT(req != PRU_ACCEPT);
746 KASSERT(req != PRU_BIND);
747 KASSERT(req != PRU_LISTEN);
748 KASSERT(req != PRU_CONNECT);
749 KASSERT(req != PRU_CONNECT2);
750 KASSERT(req != PRU_DISCONNECT);
751 KASSERT(req != PRU_SHUTDOWN);
752 KASSERT(req != PRU_ABORT);
753 KASSERT(req != PRU_CONTROL);
754 KASSERT(req != PRU_SENSE);
755 KASSERT(req != PRU_PEERADDR);
756 KASSERT(req != PRU_SOCKADDR);
757 KASSERT(req != PRU_RCVD);
758 KASSERT(req != PRU_RCVOOB);
759 KASSERT(req != PRU_SEND);
760 KASSERT(req != PRU_SENDOOB);
761 KASSERT(req != PRU_PURGEIF);
762
763 /* anything after here *requires* a pcb */
764 if (pcb == NULL) {
765 err = EINVAL;
766 goto release;
767 }
768
769 switch(req) {
770 case PRU_FASTTIMO:
771 case PRU_SLOWTIMO:
772 case PRU_PROTORCV:
773 case PRU_PROTOSEND:
774 err = EOPNOTSUPP;
775 break;
776
777 default:
778 UNKNOWN(req);
779 err = EOPNOTSUPP;
780 break;
781 }
782
783 release:
784 if (m)
785 m_freem(m);
786 if (ctl)
787 m_freem(ctl);
788 return err;
789 }
790
791 /*
792 * get/set socket options
793 */
794 int
795 hci_ctloutput(int req, struct socket *so, struct sockopt *sopt)
796 {
797 struct hci_pcb *pcb = (struct hci_pcb *)so->so_pcb;
798 int optval, err = 0;
799
800 DPRINTFN(2, "req %s\n", prcorequests[req]);
801
802 if (pcb == NULL)
803 return EINVAL;
804
805 if (sopt->sopt_level != BTPROTO_HCI)
806 return ENOPROTOOPT;
807
808 switch(req) {
809 case PRCO_GETOPT:
810 switch (sopt->sopt_name) {
811 case SO_HCI_EVT_FILTER:
812 err = sockopt_set(sopt, &pcb->hp_efilter,
813 sizeof(struct hci_filter));
814
815 break;
816
817 case SO_HCI_PKT_FILTER:
818 err = sockopt_set(sopt, &pcb->hp_pfilter,
819 sizeof(struct hci_filter));
820
821 break;
822
823 case SO_HCI_DIRECTION:
824 err = sockopt_setint(sopt,
825 (pcb->hp_flags & HCI_DIRECTION ? 1 : 0));
826
827 break;
828
829 default:
830 err = ENOPROTOOPT;
831 break;
832 }
833 break;
834
835 case PRCO_SETOPT:
836 switch (sopt->sopt_name) {
837 case SO_HCI_EVT_FILTER: /* set event filter */
838 err = sockopt_get(sopt, &pcb->hp_efilter,
839 sizeof(pcb->hp_efilter));
840
841 break;
842
843 case SO_HCI_PKT_FILTER: /* set packet filter */
844 err = sockopt_get(sopt, &pcb->hp_pfilter,
845 sizeof(pcb->hp_pfilter));
846
847 break;
848
849 case SO_HCI_DIRECTION: /* request direction ctl messages */
850 err = sockopt_getint(sopt, &optval);
851 if (err)
852 break;
853
854 if (optval)
855 pcb->hp_flags |= HCI_DIRECTION;
856 else
857 pcb->hp_flags &= ~HCI_DIRECTION;
858 break;
859
860 default:
861 err = ENOPROTOOPT;
862 break;
863 }
864 break;
865
866 default:
867 err = ENOPROTOOPT;
868 break;
869 }
870
871 return err;
872 }
873
874 /*
875 * HCI mbuf tap routine
876 *
877 * copy packets to any raw HCI sockets that wish (and are
878 * permitted) to see them
879 */
880 void
881 hci_mtap(struct mbuf *m, struct hci_unit *unit)
882 {
883 struct hci_pcb *pcb;
884 struct mbuf *m0, *ctlmsg, **ctl;
885 struct sockaddr_bt sa;
886 uint8_t type;
887 uint8_t event;
888 uint16_t arg1;
889
890 KASSERT(m->m_len >= sizeof(type));
891
892 type = *mtod(m, uint8_t *);
893
894 memset(&sa, 0, sizeof(sa));
895 sa.bt_len = sizeof(struct sockaddr_bt);
896 sa.bt_family = AF_BLUETOOTH;
897 bdaddr_copy(&sa.bt_bdaddr, &unit->hci_bdaddr);
898
899 LIST_FOREACH(pcb, &hci_pcb, hp_next) {
900 /*
901 * filter according to source address
902 */
903 if ((pcb->hp_flags & HCI_PROMISCUOUS) == 0
904 && bdaddr_same(&pcb->hp_laddr, &sa.bt_bdaddr) == 0)
905 continue;
906
907 /*
908 * filter according to packet type filter
909 */
910 if (hci_filter_test(type, &pcb->hp_pfilter) == 0)
911 continue;
912
913 /*
914 * filter according to event/security filters
915 */
916 switch(type) {
917 case HCI_EVENT_PKT:
918 KASSERT(m->m_len >= sizeof(hci_event_hdr_t));
919
920 event = mtod(m, hci_event_hdr_t *)->event;
921
922 if (hci_filter_test(event, &pcb->hp_efilter) == 0)
923 continue;
924
925 arg1 = event;
926 break;
927
928 case HCI_CMD_PKT:
929 KASSERT(m->m_len >= sizeof(hci_cmd_hdr_t));
930 arg1 = le16toh(mtod(m, hci_cmd_hdr_t *)->opcode);
931 break;
932
933 case HCI_ACL_DATA_PKT:
934 KASSERT(m->m_len >= sizeof(hci_acldata_hdr_t));
935 arg1 = le16toh(mtod(m, hci_acldata_hdr_t *)->con_handle);
936 arg1 = HCI_CON_HANDLE(arg1);
937 break;
938
939 case HCI_SCO_DATA_PKT:
940 KASSERT(m->m_len >= sizeof(hci_scodata_hdr_t));
941 arg1 = le16toh(mtod(m, hci_scodata_hdr_t *)->con_handle);
942 arg1 = HCI_CON_HANDLE(arg1);
943 break;
944
945 default:
946 arg1 = 0;
947 break;
948 }
949
950 if (pcb->hp_cred != NULL
951 && kauth_authorize_device(pcb->hp_cred,
952 KAUTH_DEVICE_BLUETOOTH_RECV,
953 KAUTH_ARG(type), KAUTH_ARG(arg1), NULL, NULL) != 0)
954 continue;
955
956 /*
957 * create control messages
958 */
959 ctlmsg = NULL;
960 ctl = &ctlmsg;
961 if (pcb->hp_flags & HCI_DIRECTION) {
962 int dir = m->m_flags & M_LINK0 ? 1 : 0;
963
964 *ctl = sbcreatecontrol(&dir, sizeof(dir),
965 SCM_HCI_DIRECTION, BTPROTO_HCI);
966
967 if (*ctl != NULL)
968 ctl = &((*ctl)->m_next);
969 }
970 if (pcb->hp_socket->so_options & SO_TIMESTAMP) {
971 struct timeval tv;
972
973 microtime(&tv);
974 *ctl = sbcreatecontrol(&tv, sizeof(tv),
975 SCM_TIMESTAMP, SOL_SOCKET);
976
977 if (*ctl != NULL)
978 ctl = &((*ctl)->m_next);
979 }
980
981 /*
982 * copy to socket
983 */
984 m0 = m_copypacket(m, M_DONTWAIT);
985 if (m0 && sbappendaddr(&pcb->hp_socket->so_rcv,
986 (struct sockaddr *)&sa, m0, ctlmsg)) {
987 sorwakeup(pcb->hp_socket);
988 } else {
989 m_freem(ctlmsg);
990 m_freem(m0);
991 }
992 }
993 }
994
995 PR_WRAP_USRREQS(hci)
996
997 #define hci_attach hci_attach_wrapper
998 #define hci_detach hci_detach_wrapper
999 #define hci_accept hci_accept_wrapper
1000 #define hci_bind hci_bind_wrapper
1001 #define hci_listen hci_listen_wrapper
1002 #define hci_connect hci_connect_wrapper
1003 #define hci_connect2 hci_connect2_wrapper
1004 #define hci_disconnect hci_disconnect_wrapper
1005 #define hci_shutdown hci_shutdown_wrapper
1006 #define hci_abort hci_abort_wrapper
1007 #define hci_ioctl hci_ioctl_wrapper
1008 #define hci_stat hci_stat_wrapper
1009 #define hci_peeraddr hci_peeraddr_wrapper
1010 #define hci_sockaddr hci_sockaddr_wrapper
1011 #define hci_rcvd hci_rcvd_wrapper
1012 #define hci_recvoob hci_recvoob_wrapper
1013 #define hci_send hci_send_wrapper
1014 #define hci_sendoob hci_sendoob_wrapper
1015 #define hci_purgeif hci_purgeif_wrapper
1016 #define hci_usrreq hci_usrreq_wrapper
1017
1018 const struct pr_usrreqs hci_usrreqs = {
1019 .pr_attach = hci_attach,
1020 .pr_detach = hci_detach,
1021 .pr_accept = hci_accept,
1022 .pr_bind = hci_bind,
1023 .pr_listen = hci_listen,
1024 .pr_connect = hci_connect,
1025 .pr_connect2 = hci_connect2,
1026 .pr_disconnect = hci_disconnect,
1027 .pr_shutdown = hci_shutdown,
1028 .pr_abort = hci_abort,
1029 .pr_ioctl = hci_ioctl,
1030 .pr_stat = hci_stat,
1031 .pr_peeraddr = hci_peeraddr,
1032 .pr_sockaddr = hci_sockaddr,
1033 .pr_rcvd = hci_rcvd,
1034 .pr_recvoob = hci_recvoob,
1035 .pr_send = hci_send,
1036 .pr_sendoob = hci_sendoob,
1037 .pr_purgeif = hci_purgeif,
1038 .pr_generic = hci_usrreq,
1039 };
1040