1baeef614SMaksim Yevmenkin /* 2baeef614SMaksim Yevmenkin * hci.c 3baeef614SMaksim Yevmenkin */ 4baeef614SMaksim Yevmenkin 5baeef614SMaksim Yevmenkin /*- 64d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause 75e53a4f9SPedro F. Giffuni * 8baeef614SMaksim Yevmenkin * Copyright (c) 2009 Maksim Yevmenkin <m_evmenkin@yahoo.com> 9baeef614SMaksim Yevmenkin * All rights reserved. 10baeef614SMaksim Yevmenkin * 11baeef614SMaksim Yevmenkin * Redistribution and use in source and binary forms, with or without 12baeef614SMaksim Yevmenkin * modification, are permitted provided that the following conditions 13baeef614SMaksim Yevmenkin * are met: 14baeef614SMaksim Yevmenkin * 1. Redistributions of source code must retain the above copyright 15baeef614SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer. 16baeef614SMaksim Yevmenkin * 2. Redistributions in binary form must reproduce the above copyright 17baeef614SMaksim Yevmenkin * notice, this list of conditions and the following disclaimer in the 18baeef614SMaksim Yevmenkin * documentation and/or other materials provided with the distribution. 19baeef614SMaksim Yevmenkin * 20baeef614SMaksim Yevmenkin * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 21baeef614SMaksim Yevmenkin * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 22baeef614SMaksim Yevmenkin * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 23baeef614SMaksim Yevmenkin * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 24baeef614SMaksim Yevmenkin * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 25baeef614SMaksim Yevmenkin * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 26baeef614SMaksim Yevmenkin * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 27baeef614SMaksim Yevmenkin * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 28baeef614SMaksim Yevmenkin * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 29baeef614SMaksim Yevmenkin * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 30baeef614SMaksim Yevmenkin * SUCH DAMAGE. 31baeef614SMaksim Yevmenkin * 32baeef614SMaksim Yevmenkin * $FreeBSD$ 33baeef614SMaksim Yevmenkin */ 34baeef614SMaksim Yevmenkin 353ee5c554SVladimir Kondratyev #include <sys/types.h> 363ee5c554SVladimir Kondratyev #include <sys/sysctl.h> 373ee5c554SVladimir Kondratyev 3878b96635SMaksim Yevmenkin #include <assert.h> 398d6f425dSTakanori Watanabe #define L2CAP_SOCKET_CHECKED 40baeef614SMaksim Yevmenkin #include <bluetooth.h> 4178b96635SMaksim Yevmenkin #include <inttypes.h> 42baeef614SMaksim Yevmenkin #include <stdio.h> 43baeef614SMaksim Yevmenkin #include <stdlib.h> 44baeef614SMaksim Yevmenkin #include <string.h> 453ee5c554SVladimir Kondratyev #include <time.h> 46baeef614SMaksim Yevmenkin #include <unistd.h> 47baeef614SMaksim Yevmenkin 4878b96635SMaksim Yevmenkin #undef MIN 4978b96635SMaksim Yevmenkin #define MIN(a, b) (((a) < (b))? (a) : (b)) 5078b96635SMaksim Yevmenkin 5178b96635SMaksim Yevmenkin static int bt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname); 52baeef614SMaksim Yevmenkin static char * bt_dev2node (char const *devname, char *nodename, int nnlen); 533ee5c554SVladimir Kondratyev static time_t bt_get_default_hci_command_timeout(void); 54baeef614SMaksim Yevmenkin 55baeef614SMaksim Yevmenkin int 5678b96635SMaksim Yevmenkin bt_devopen(char const *devname) 5778b96635SMaksim Yevmenkin { 5878b96635SMaksim Yevmenkin struct sockaddr_hci ha; 5978b96635SMaksim Yevmenkin bdaddr_t ba; 6078b96635SMaksim Yevmenkin int s; 6178b96635SMaksim Yevmenkin 6278b96635SMaksim Yevmenkin if (devname == NULL) { 6378b96635SMaksim Yevmenkin errno = EINVAL; 6478b96635SMaksim Yevmenkin return (-1); 6578b96635SMaksim Yevmenkin } 6678b96635SMaksim Yevmenkin 6778b96635SMaksim Yevmenkin memset(&ha, 0, sizeof(ha)); 6878b96635SMaksim Yevmenkin ha.hci_len = sizeof(ha); 6978b96635SMaksim Yevmenkin ha.hci_family = AF_BLUETOOTH; 7078b96635SMaksim Yevmenkin 7178b96635SMaksim Yevmenkin if (bt_aton(devname, &ba)) { 7278b96635SMaksim Yevmenkin if (!bt_devname(ha.hci_node, &ba)) 7378b96635SMaksim Yevmenkin return (-1); 7478b96635SMaksim Yevmenkin } else if (bt_dev2node(devname, ha.hci_node, 7578b96635SMaksim Yevmenkin sizeof(ha.hci_node)) == NULL) { 7678b96635SMaksim Yevmenkin errno = ENXIO; 7778b96635SMaksim Yevmenkin return (-1); 7878b96635SMaksim Yevmenkin } 7978b96635SMaksim Yevmenkin 8078b96635SMaksim Yevmenkin s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI); 8178b96635SMaksim Yevmenkin if (s < 0) 8278b96635SMaksim Yevmenkin return (-1); 8378b96635SMaksim Yevmenkin 8478b96635SMaksim Yevmenkin if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 8578b96635SMaksim Yevmenkin connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0) { 8678b96635SMaksim Yevmenkin close(s); 8778b96635SMaksim Yevmenkin return (-1); 8878b96635SMaksim Yevmenkin } 8978b96635SMaksim Yevmenkin 9078b96635SMaksim Yevmenkin return (s); 9178b96635SMaksim Yevmenkin } 9278b96635SMaksim Yevmenkin 9378b96635SMaksim Yevmenkin int 9478b96635SMaksim Yevmenkin bt_devclose(int s) 9578b96635SMaksim Yevmenkin { 9678b96635SMaksim Yevmenkin return (close(s)); 9778b96635SMaksim Yevmenkin } 9878b96635SMaksim Yevmenkin 9978b96635SMaksim Yevmenkin int 10078b96635SMaksim Yevmenkin bt_devsend(int s, uint16_t opcode, void *param, size_t plen) 10178b96635SMaksim Yevmenkin { 10278b96635SMaksim Yevmenkin ng_hci_cmd_pkt_t h; 10378b96635SMaksim Yevmenkin struct iovec iv[2]; 10478b96635SMaksim Yevmenkin int ivn; 10578b96635SMaksim Yevmenkin 10678b96635SMaksim Yevmenkin if ((plen == 0 && param != NULL) || 10778b96635SMaksim Yevmenkin (plen > 0 && param == NULL) || 10878b96635SMaksim Yevmenkin plen > UINT8_MAX) { 10978b96635SMaksim Yevmenkin errno = EINVAL; 11078b96635SMaksim Yevmenkin return (-1); 11178b96635SMaksim Yevmenkin } 11278b96635SMaksim Yevmenkin 11378b96635SMaksim Yevmenkin iv[0].iov_base = &h; 11478b96635SMaksim Yevmenkin iv[0].iov_len = sizeof(h); 11578b96635SMaksim Yevmenkin ivn = 1; 11678b96635SMaksim Yevmenkin 11778b96635SMaksim Yevmenkin h.type = NG_HCI_CMD_PKT; 11878b96635SMaksim Yevmenkin h.opcode = htole16(opcode); 11978b96635SMaksim Yevmenkin if (plen > 0) { 12078b96635SMaksim Yevmenkin h.length = plen; 12178b96635SMaksim Yevmenkin 12278b96635SMaksim Yevmenkin iv[1].iov_base = param; 12378b96635SMaksim Yevmenkin iv[1].iov_len = plen; 12478b96635SMaksim Yevmenkin ivn = 2; 12578b96635SMaksim Yevmenkin } else 12678b96635SMaksim Yevmenkin h.length = 0; 12778b96635SMaksim Yevmenkin 12878b96635SMaksim Yevmenkin while (writev(s, iv, ivn) < 0) { 12978b96635SMaksim Yevmenkin if (errno == EAGAIN || errno == EINTR) 13078b96635SMaksim Yevmenkin continue; 13178b96635SMaksim Yevmenkin 13278b96635SMaksim Yevmenkin return (-1); 13378b96635SMaksim Yevmenkin } 13478b96635SMaksim Yevmenkin 13578b96635SMaksim Yevmenkin return (0); 13678b96635SMaksim Yevmenkin } 13778b96635SMaksim Yevmenkin 13878b96635SMaksim Yevmenkin ssize_t 13978b96635SMaksim Yevmenkin bt_devrecv(int s, void *buf, size_t size, time_t to) 14078b96635SMaksim Yevmenkin { 14178b96635SMaksim Yevmenkin ssize_t n; 14278b96635SMaksim Yevmenkin 14378b96635SMaksim Yevmenkin if (buf == NULL || size == 0) { 14478b96635SMaksim Yevmenkin errno = EINVAL; 14578b96635SMaksim Yevmenkin return (-1); 14678b96635SMaksim Yevmenkin } 14778b96635SMaksim Yevmenkin 14878b96635SMaksim Yevmenkin if (to >= 0) { 14978b96635SMaksim Yevmenkin fd_set rfd; 15078b96635SMaksim Yevmenkin struct timeval tv; 15178b96635SMaksim Yevmenkin 15278b96635SMaksim Yevmenkin FD_ZERO(&rfd); 15378b96635SMaksim Yevmenkin FD_SET(s, &rfd); 15478b96635SMaksim Yevmenkin 15578b96635SMaksim Yevmenkin tv.tv_sec = to; 15678b96635SMaksim Yevmenkin tv.tv_usec = 0; 15778b96635SMaksim Yevmenkin 15878b96635SMaksim Yevmenkin while ((n = select(s + 1, &rfd, NULL, NULL, &tv)) < 0) { 15978b96635SMaksim Yevmenkin if (errno == EAGAIN || errno == EINTR) 16078b96635SMaksim Yevmenkin continue; 16178b96635SMaksim Yevmenkin 16278b96635SMaksim Yevmenkin return (-1); 16378b96635SMaksim Yevmenkin } 16478b96635SMaksim Yevmenkin 16578b96635SMaksim Yevmenkin if (n == 0) { 16678b96635SMaksim Yevmenkin errno = ETIMEDOUT; 16778b96635SMaksim Yevmenkin return (-1); 16878b96635SMaksim Yevmenkin } 16978b96635SMaksim Yevmenkin 17078b96635SMaksim Yevmenkin assert(FD_ISSET(s, &rfd)); 17178b96635SMaksim Yevmenkin } 17278b96635SMaksim Yevmenkin 17378b96635SMaksim Yevmenkin while ((n = read(s, buf, size)) < 0) { 17478b96635SMaksim Yevmenkin if (errno == EAGAIN || errno == EINTR) 17578b96635SMaksim Yevmenkin continue; 17678b96635SMaksim Yevmenkin 17778b96635SMaksim Yevmenkin return (-1); 17878b96635SMaksim Yevmenkin } 17978b96635SMaksim Yevmenkin 18078b96635SMaksim Yevmenkin switch (*((uint8_t *) buf)) { 18178b96635SMaksim Yevmenkin case NG_HCI_CMD_PKT: { 18278b96635SMaksim Yevmenkin ng_hci_cmd_pkt_t *h = (ng_hci_cmd_pkt_t *) buf; 18378b96635SMaksim Yevmenkin 18478b96635SMaksim Yevmenkin if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 18578b96635SMaksim Yevmenkin return (n); 18678b96635SMaksim Yevmenkin } break; 18778b96635SMaksim Yevmenkin 18878b96635SMaksim Yevmenkin case NG_HCI_ACL_DATA_PKT: { 18978b96635SMaksim Yevmenkin ng_hci_acldata_pkt_t *h = (ng_hci_acldata_pkt_t *) buf; 19078b96635SMaksim Yevmenkin 19178b96635SMaksim Yevmenkin if (n >= sizeof(*h) && n == (sizeof(*h) + le16toh(h->length))) 19278b96635SMaksim Yevmenkin return (n); 19378b96635SMaksim Yevmenkin } break; 19478b96635SMaksim Yevmenkin 19578b96635SMaksim Yevmenkin case NG_HCI_SCO_DATA_PKT: { 19678b96635SMaksim Yevmenkin ng_hci_scodata_pkt_t *h = (ng_hci_scodata_pkt_t *) buf; 19778b96635SMaksim Yevmenkin 19878b96635SMaksim Yevmenkin if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 19978b96635SMaksim Yevmenkin return (n); 20078b96635SMaksim Yevmenkin } break; 20178b96635SMaksim Yevmenkin 20278b96635SMaksim Yevmenkin case NG_HCI_EVENT_PKT: { 20378b96635SMaksim Yevmenkin ng_hci_event_pkt_t *h = (ng_hci_event_pkt_t *) buf; 20478b96635SMaksim Yevmenkin 20578b96635SMaksim Yevmenkin if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 20678b96635SMaksim Yevmenkin return (n); 20778b96635SMaksim Yevmenkin } break; 20878b96635SMaksim Yevmenkin } 20978b96635SMaksim Yevmenkin 21078b96635SMaksim Yevmenkin errno = EIO; 21178b96635SMaksim Yevmenkin return (-1); 21278b96635SMaksim Yevmenkin } 21378b96635SMaksim Yevmenkin 21478b96635SMaksim Yevmenkin int 21578b96635SMaksim Yevmenkin bt_devreq(int s, struct bt_devreq *r, time_t to) 21678b96635SMaksim Yevmenkin { 21778b96635SMaksim Yevmenkin uint8_t buf[320]; /* more than enough */ 21878b96635SMaksim Yevmenkin ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) buf; 21978b96635SMaksim Yevmenkin ng_hci_command_compl_ep *cc = (ng_hci_command_compl_ep *)(e+1); 22078b96635SMaksim Yevmenkin ng_hci_command_status_ep *cs = (ng_hci_command_status_ep*)(e+1); 22178b96635SMaksim Yevmenkin struct bt_devfilter old, new; 22278b96635SMaksim Yevmenkin time_t t_end; 22378b96635SMaksim Yevmenkin uint16_t opcode; 22478b96635SMaksim Yevmenkin ssize_t n; 22578b96635SMaksim Yevmenkin int error; 22678b96635SMaksim Yevmenkin 22778b96635SMaksim Yevmenkin if (s < 0 || r == NULL || to < 0) { 22878b96635SMaksim Yevmenkin errno = EINVAL; 22978b96635SMaksim Yevmenkin return (-1); 23078b96635SMaksim Yevmenkin } 23178b96635SMaksim Yevmenkin 23278b96635SMaksim Yevmenkin if ((r->rlen == 0 && r->rparam != NULL) || 23378b96635SMaksim Yevmenkin (r->rlen > 0 && r->rparam == NULL)) { 23478b96635SMaksim Yevmenkin errno = EINVAL; 23578b96635SMaksim Yevmenkin return (-1); 23678b96635SMaksim Yevmenkin } 23778b96635SMaksim Yevmenkin 23878b96635SMaksim Yevmenkin memset(&new, 0, sizeof(new)); 23978b96635SMaksim Yevmenkin bt_devfilter_pkt_set(&new, NG_HCI_EVENT_PKT); 24078b96635SMaksim Yevmenkin bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_COMPL); 24178b96635SMaksim Yevmenkin bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_STATUS); 24278b96635SMaksim Yevmenkin if (r->event != 0) 24378b96635SMaksim Yevmenkin bt_devfilter_evt_set(&new, r->event); 24478b96635SMaksim Yevmenkin 24578b96635SMaksim Yevmenkin if (bt_devfilter(s, &new, &old) < 0) 24678b96635SMaksim Yevmenkin return (-1); 24778b96635SMaksim Yevmenkin 24878b96635SMaksim Yevmenkin error = 0; 24978b96635SMaksim Yevmenkin 25078b96635SMaksim Yevmenkin n = bt_devsend(s, r->opcode, r->cparam, r->clen); 25178b96635SMaksim Yevmenkin if (n < 0) { 25278b96635SMaksim Yevmenkin error = errno; 25378b96635SMaksim Yevmenkin goto out; 25478b96635SMaksim Yevmenkin } 25578b96635SMaksim Yevmenkin 25678b96635SMaksim Yevmenkin opcode = htole16(r->opcode); 25778b96635SMaksim Yevmenkin t_end = time(NULL) + to; 25878b96635SMaksim Yevmenkin 25978b96635SMaksim Yevmenkin do { 26078b96635SMaksim Yevmenkin to = t_end - time(NULL); 26178b96635SMaksim Yevmenkin if (to < 0) 26278b96635SMaksim Yevmenkin to = 0; 26378b96635SMaksim Yevmenkin 26478b96635SMaksim Yevmenkin n = bt_devrecv(s, buf, sizeof(buf), to); 26578b96635SMaksim Yevmenkin if (n < 0) { 26678b96635SMaksim Yevmenkin error = errno; 26778b96635SMaksim Yevmenkin goto out; 26878b96635SMaksim Yevmenkin } 26978b96635SMaksim Yevmenkin 27078b96635SMaksim Yevmenkin if (e->type != NG_HCI_EVENT_PKT) { 27178b96635SMaksim Yevmenkin error = EIO; 27278b96635SMaksim Yevmenkin goto out; 27378b96635SMaksim Yevmenkin } 27478b96635SMaksim Yevmenkin 27578b96635SMaksim Yevmenkin n -= sizeof(*e); 27678b96635SMaksim Yevmenkin 27778b96635SMaksim Yevmenkin switch (e->event) { 27878b96635SMaksim Yevmenkin case NG_HCI_EVENT_COMMAND_COMPL: 27978b96635SMaksim Yevmenkin if (cc->opcode == opcode) { 28078b96635SMaksim Yevmenkin n -= sizeof(*cc); 28178b96635SMaksim Yevmenkin 28278b96635SMaksim Yevmenkin if (r->rlen >= n) { 28378b96635SMaksim Yevmenkin r->rlen = n; 28478b96635SMaksim Yevmenkin memcpy(r->rparam, cc + 1, r->rlen); 28578b96635SMaksim Yevmenkin } 28678b96635SMaksim Yevmenkin 28778b96635SMaksim Yevmenkin goto out; 28878b96635SMaksim Yevmenkin } 28978b96635SMaksim Yevmenkin break; 29078b96635SMaksim Yevmenkin 29178b96635SMaksim Yevmenkin case NG_HCI_EVENT_COMMAND_STATUS: 29278b96635SMaksim Yevmenkin if (cs->opcode == opcode) { 29378b96635SMaksim Yevmenkin if (r->event != NG_HCI_EVENT_COMMAND_STATUS) { 29478b96635SMaksim Yevmenkin if (cs->status != 0) { 29578b96635SMaksim Yevmenkin error = EIO; 29678b96635SMaksim Yevmenkin goto out; 29778b96635SMaksim Yevmenkin } 29878b96635SMaksim Yevmenkin } else { 29978b96635SMaksim Yevmenkin if (r->rlen >= n) { 30078b96635SMaksim Yevmenkin r->rlen = n; 30178b96635SMaksim Yevmenkin memcpy(r->rparam, cs, r->rlen); 30278b96635SMaksim Yevmenkin } 30378b96635SMaksim Yevmenkin 30478b96635SMaksim Yevmenkin goto out; 30578b96635SMaksim Yevmenkin } 30678b96635SMaksim Yevmenkin } 30778b96635SMaksim Yevmenkin break; 30878b96635SMaksim Yevmenkin 30978b96635SMaksim Yevmenkin default: 31078b96635SMaksim Yevmenkin if (e->event == r->event) { 31178b96635SMaksim Yevmenkin if (r->rlen >= n) { 31278b96635SMaksim Yevmenkin r->rlen = n; 31378b96635SMaksim Yevmenkin memcpy(r->rparam, e + 1, r->rlen); 31478b96635SMaksim Yevmenkin } 31578b96635SMaksim Yevmenkin 31678b96635SMaksim Yevmenkin goto out; 31778b96635SMaksim Yevmenkin } 31878b96635SMaksim Yevmenkin break; 31978b96635SMaksim Yevmenkin } 32078b96635SMaksim Yevmenkin } while (to > 0); 32178b96635SMaksim Yevmenkin 32278b96635SMaksim Yevmenkin error = ETIMEDOUT; 32378b96635SMaksim Yevmenkin out: 32478b96635SMaksim Yevmenkin bt_devfilter(s, &old, NULL); 32578b96635SMaksim Yevmenkin 32678b96635SMaksim Yevmenkin if (error != 0) { 32778b96635SMaksim Yevmenkin errno = error; 32878b96635SMaksim Yevmenkin return (-1); 32978b96635SMaksim Yevmenkin } 33078b96635SMaksim Yevmenkin 33178b96635SMaksim Yevmenkin return (0); 33278b96635SMaksim Yevmenkin } 33378b96635SMaksim Yevmenkin 33478b96635SMaksim Yevmenkin int 33578b96635SMaksim Yevmenkin bt_devfilter(int s, struct bt_devfilter const *new, struct bt_devfilter *old) 33678b96635SMaksim Yevmenkin { 33778b96635SMaksim Yevmenkin struct ng_btsocket_hci_raw_filter f; 33878b96635SMaksim Yevmenkin socklen_t len; 33978b96635SMaksim Yevmenkin 34078b96635SMaksim Yevmenkin if (new == NULL && old == NULL) { 34178b96635SMaksim Yevmenkin errno = EINVAL; 34278b96635SMaksim Yevmenkin return (-1); 34378b96635SMaksim Yevmenkin } 34478b96635SMaksim Yevmenkin 34578b96635SMaksim Yevmenkin if (old != NULL) { 34678b96635SMaksim Yevmenkin len = sizeof(f); 34778b96635SMaksim Yevmenkin if (getsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, &len) < 0) 34878b96635SMaksim Yevmenkin return (-1); 34978b96635SMaksim Yevmenkin 35078b96635SMaksim Yevmenkin memset(old, 0, sizeof(*old)); 35178b96635SMaksim Yevmenkin memcpy(old->packet_mask, &f.packet_mask, 35278b96635SMaksim Yevmenkin MIN(sizeof(old->packet_mask), sizeof(f.packet_mask))); 35378b96635SMaksim Yevmenkin memcpy(old->event_mask, &f.event_mask, 35478b96635SMaksim Yevmenkin MIN(sizeof(old->event_mask), sizeof(f.packet_mask))); 35578b96635SMaksim Yevmenkin } 35678b96635SMaksim Yevmenkin 35778b96635SMaksim Yevmenkin if (new != NULL) { 35878b96635SMaksim Yevmenkin memset(&f, 0, sizeof(f)); 35978b96635SMaksim Yevmenkin memcpy(&f.packet_mask, new->packet_mask, 36078b96635SMaksim Yevmenkin MIN(sizeof(f.packet_mask), sizeof(new->event_mask))); 36178b96635SMaksim Yevmenkin memcpy(&f.event_mask, new->event_mask, 36278b96635SMaksim Yevmenkin MIN(sizeof(f.event_mask), sizeof(new->event_mask))); 36378b96635SMaksim Yevmenkin 36478b96635SMaksim Yevmenkin len = sizeof(f); 36578b96635SMaksim Yevmenkin if (setsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, len) < 0) 36678b96635SMaksim Yevmenkin return (-1); 36778b96635SMaksim Yevmenkin } 36878b96635SMaksim Yevmenkin 36978b96635SMaksim Yevmenkin return (0); 37078b96635SMaksim Yevmenkin } 37178b96635SMaksim Yevmenkin 37278b96635SMaksim Yevmenkin void 37378b96635SMaksim Yevmenkin bt_devfilter_pkt_set(struct bt_devfilter *filter, uint8_t type) 37478b96635SMaksim Yevmenkin { 37578b96635SMaksim Yevmenkin bit_set(filter->packet_mask, type - 1); 37678b96635SMaksim Yevmenkin } 37778b96635SMaksim Yevmenkin 37878b96635SMaksim Yevmenkin void 37978b96635SMaksim Yevmenkin bt_devfilter_pkt_clr(struct bt_devfilter *filter, uint8_t type) 38078b96635SMaksim Yevmenkin { 38178b96635SMaksim Yevmenkin bit_clear(filter->packet_mask, type - 1); 38278b96635SMaksim Yevmenkin } 38378b96635SMaksim Yevmenkin 38478b96635SMaksim Yevmenkin int 38578b96635SMaksim Yevmenkin bt_devfilter_pkt_tst(struct bt_devfilter const *filter, uint8_t type) 38678b96635SMaksim Yevmenkin { 38778b96635SMaksim Yevmenkin return (bit_test(filter->packet_mask, type - 1)); 38878b96635SMaksim Yevmenkin } 38978b96635SMaksim Yevmenkin 39078b96635SMaksim Yevmenkin void 39178b96635SMaksim Yevmenkin bt_devfilter_evt_set(struct bt_devfilter *filter, uint8_t event) 39278b96635SMaksim Yevmenkin { 39378b96635SMaksim Yevmenkin bit_set(filter->event_mask, event - 1); 39478b96635SMaksim Yevmenkin } 39578b96635SMaksim Yevmenkin 39678b96635SMaksim Yevmenkin void 39778b96635SMaksim Yevmenkin bt_devfilter_evt_clr(struct bt_devfilter *filter, uint8_t event) 39878b96635SMaksim Yevmenkin { 39978b96635SMaksim Yevmenkin bit_clear(filter->event_mask, event - 1); 40078b96635SMaksim Yevmenkin } 40178b96635SMaksim Yevmenkin 40278b96635SMaksim Yevmenkin int 40378b96635SMaksim Yevmenkin bt_devfilter_evt_tst(struct bt_devfilter const *filter, uint8_t event) 40478b96635SMaksim Yevmenkin { 40578b96635SMaksim Yevmenkin return (bit_test(filter->event_mask, event - 1)); 40678b96635SMaksim Yevmenkin } 40778b96635SMaksim Yevmenkin 40878b96635SMaksim Yevmenkin int 40978b96635SMaksim Yevmenkin bt_devinquiry(char const *devname, time_t length, int num_rsp, 41078b96635SMaksim Yevmenkin struct bt_devinquiry **ii) 41178b96635SMaksim Yevmenkin { 41278b96635SMaksim Yevmenkin uint8_t buf[320]; 41378b96635SMaksim Yevmenkin char _devname[HCI_DEVNAME_SIZE]; 41478b96635SMaksim Yevmenkin struct bt_devfilter f; 41578b96635SMaksim Yevmenkin ng_hci_inquiry_cp *cp = (ng_hci_inquiry_cp *) buf; 41678b96635SMaksim Yevmenkin ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) buf; 41778b96635SMaksim Yevmenkin ng_hci_inquiry_result_ep *ep = (ng_hci_inquiry_result_ep *)(e+1); 41878b96635SMaksim Yevmenkin ng_hci_inquiry_response *ir; 41978b96635SMaksim Yevmenkin struct bt_devinquiry *i; 42078b96635SMaksim Yevmenkin int s, n; 42178b96635SMaksim Yevmenkin 42278b96635SMaksim Yevmenkin if (ii == NULL) { 42378b96635SMaksim Yevmenkin errno = EINVAL; 42478b96635SMaksim Yevmenkin return (-1); 42578b96635SMaksim Yevmenkin } 42678b96635SMaksim Yevmenkin 42778b96635SMaksim Yevmenkin if (devname == NULL) { 42878b96635SMaksim Yevmenkin memset(_devname, 0, sizeof(_devname)); 42978b96635SMaksim Yevmenkin devname = _devname; 43078b96635SMaksim Yevmenkin 43178b96635SMaksim Yevmenkin n = bt_devenum(bt_devany_cb, _devname); 43278b96635SMaksim Yevmenkin if (n <= 0) { 43378b96635SMaksim Yevmenkin if (n == 0) 43478b96635SMaksim Yevmenkin *ii = NULL; 43578b96635SMaksim Yevmenkin 43678b96635SMaksim Yevmenkin return (n); 43778b96635SMaksim Yevmenkin } 43878b96635SMaksim Yevmenkin } 43978b96635SMaksim Yevmenkin 44078b96635SMaksim Yevmenkin s = bt_devopen(devname); 44178b96635SMaksim Yevmenkin if (s < 0) 44278b96635SMaksim Yevmenkin return (-1); 44378b96635SMaksim Yevmenkin 44478b96635SMaksim Yevmenkin if (bt_devfilter(s, NULL, &f) < 0) { 44578b96635SMaksim Yevmenkin bt_devclose(s); 44678b96635SMaksim Yevmenkin return (-1); 44778b96635SMaksim Yevmenkin } 44878b96635SMaksim Yevmenkin 44978b96635SMaksim Yevmenkin bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_COMPL); 45078b96635SMaksim Yevmenkin bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_RESULT); 45178b96635SMaksim Yevmenkin 45278b96635SMaksim Yevmenkin if (bt_devfilter(s, &f, NULL) < 0) { 45378b96635SMaksim Yevmenkin bt_devclose(s); 45478b96635SMaksim Yevmenkin return (-1); 45578b96635SMaksim Yevmenkin } 45678b96635SMaksim Yevmenkin 45778b96635SMaksim Yevmenkin /* Always use GIAC LAP */ 45878b96635SMaksim Yevmenkin cp->lap[0] = 0x33; 45978b96635SMaksim Yevmenkin cp->lap[1] = 0x8b; 46078b96635SMaksim Yevmenkin cp->lap[2] = 0x9e; 46178b96635SMaksim Yevmenkin 462b7ced94cSMaksim Yevmenkin /* 463b7ced94cSMaksim Yevmenkin * Calculate inquire length in 1.28 second units 464b7ced94cSMaksim Yevmenkin * v2.x specification says that 1.28 -> 61.44 seconds 465b7ced94cSMaksim Yevmenkin * range is acceptable 466b7ced94cSMaksim Yevmenkin */ 46778b96635SMaksim Yevmenkin 468b7ced94cSMaksim Yevmenkin if (length <= 0) 469b7ced94cSMaksim Yevmenkin length = 5; 470b7ced94cSMaksim Yevmenkin else if (length == 1) 471b7ced94cSMaksim Yevmenkin length = 2; 472b7ced94cSMaksim Yevmenkin else if (length > 62) 473b7ced94cSMaksim Yevmenkin length = 62; 474b7ced94cSMaksim Yevmenkin 475b7ced94cSMaksim Yevmenkin cp->inquiry_length = (uint8_t)((length * 100) / 128); 47678b96635SMaksim Yevmenkin 47778b96635SMaksim Yevmenkin if (num_rsp <= 0 || num_rsp > 255) 47878b96635SMaksim Yevmenkin num_rsp = 8; 47978b96635SMaksim Yevmenkin cp->num_responses = (uint8_t) num_rsp; 48078b96635SMaksim Yevmenkin 48178b96635SMaksim Yevmenkin i = *ii = calloc(num_rsp, sizeof(struct bt_devinquiry)); 48278b96635SMaksim Yevmenkin if (i == NULL) { 48378b96635SMaksim Yevmenkin bt_devclose(s); 48478b96635SMaksim Yevmenkin errno = ENOMEM; 48578b96635SMaksim Yevmenkin return (-1); 48678b96635SMaksim Yevmenkin } 48778b96635SMaksim Yevmenkin 48878b96635SMaksim Yevmenkin if (bt_devsend(s, 48978b96635SMaksim Yevmenkin NG_HCI_OPCODE(NG_HCI_OGF_LINK_CONTROL, NG_HCI_OCF_INQUIRY), 49078b96635SMaksim Yevmenkin cp, sizeof(*cp)) < 0) { 49178b96635SMaksim Yevmenkin free(i); 49278b96635SMaksim Yevmenkin bt_devclose(s); 49378b96635SMaksim Yevmenkin return (-1); 49478b96635SMaksim Yevmenkin } 49578b96635SMaksim Yevmenkin 49678b96635SMaksim Yevmenkin wait_for_more: 49778b96635SMaksim Yevmenkin 498b7ced94cSMaksim Yevmenkin n = bt_devrecv(s, buf, sizeof(buf), length); 49978b96635SMaksim Yevmenkin if (n < 0) { 50078b96635SMaksim Yevmenkin free(i); 50178b96635SMaksim Yevmenkin bt_devclose(s); 50278b96635SMaksim Yevmenkin return (-1); 50378b96635SMaksim Yevmenkin } 50478b96635SMaksim Yevmenkin 50578b96635SMaksim Yevmenkin if (n < sizeof(ng_hci_event_pkt_t)) { 50678b96635SMaksim Yevmenkin free(i); 50778b96635SMaksim Yevmenkin bt_devclose(s); 50878b96635SMaksim Yevmenkin errno = EIO; 50978b96635SMaksim Yevmenkin return (-1); 51078b96635SMaksim Yevmenkin } 51178b96635SMaksim Yevmenkin 51278b96635SMaksim Yevmenkin switch (e->event) { 51378b96635SMaksim Yevmenkin case NG_HCI_EVENT_INQUIRY_COMPL: 51478b96635SMaksim Yevmenkin break; 51578b96635SMaksim Yevmenkin 51678b96635SMaksim Yevmenkin case NG_HCI_EVENT_INQUIRY_RESULT: 51778b96635SMaksim Yevmenkin ir = (ng_hci_inquiry_response *)(ep + 1); 51878b96635SMaksim Yevmenkin 51978b96635SMaksim Yevmenkin for (n = 0; n < MIN(ep->num_responses, num_rsp); n ++) { 52078b96635SMaksim Yevmenkin bdaddr_copy(&i->bdaddr, &ir->bdaddr); 52178b96635SMaksim Yevmenkin i->pscan_rep_mode = ir->page_scan_rep_mode; 52278b96635SMaksim Yevmenkin i->pscan_period_mode = ir->page_scan_period_mode; 52378b96635SMaksim Yevmenkin memcpy(i->dev_class, ir->uclass, sizeof(i->dev_class)); 52478b96635SMaksim Yevmenkin i->clock_offset = le16toh(ir->clock_offset); 52578b96635SMaksim Yevmenkin 52678b96635SMaksim Yevmenkin ir ++; 52778b96635SMaksim Yevmenkin i ++; 52878b96635SMaksim Yevmenkin num_rsp --; 52978b96635SMaksim Yevmenkin } 53078b96635SMaksim Yevmenkin /* FALLTHROUGH */ 53178b96635SMaksim Yevmenkin 53278b96635SMaksim Yevmenkin default: 53378b96635SMaksim Yevmenkin goto wait_for_more; 53478b96635SMaksim Yevmenkin /* NOT REACHED */ 53578b96635SMaksim Yevmenkin } 53678b96635SMaksim Yevmenkin 53778b96635SMaksim Yevmenkin bt_devclose(s); 53878b96635SMaksim Yevmenkin 53978b96635SMaksim Yevmenkin return (i - *ii); 54078b96635SMaksim Yevmenkin } 54178b96635SMaksim Yevmenkin 5423ee5c554SVladimir Kondratyev char * 5433ee5c554SVladimir Kondratyev bt_devremote_name(char const *devname, const bdaddr_t *remote, time_t to, 5443ee5c554SVladimir Kondratyev uint16_t clk_off, uint8_t ps_rep_mode, uint8_t ps_mode) 5453ee5c554SVladimir Kondratyev { 5463ee5c554SVladimir Kondratyev char _devname[HCI_DEVNAME_SIZE]; 5473ee5c554SVladimir Kondratyev struct bt_devreq r; 5483ee5c554SVladimir Kondratyev ng_hci_remote_name_req_cp cp; 5493ee5c554SVladimir Kondratyev ng_hci_remote_name_req_compl_ep ep; 5503ee5c554SVladimir Kondratyev int s; 5513ee5c554SVladimir Kondratyev char *remote_name = NULL; 5523ee5c554SVladimir Kondratyev 5533ee5c554SVladimir Kondratyev if (remote == NULL || to < 0) { 5543ee5c554SVladimir Kondratyev errno = EINVAL; 5553ee5c554SVladimir Kondratyev goto out; 5563ee5c554SVladimir Kondratyev } 5573ee5c554SVladimir Kondratyev 5583ee5c554SVladimir Kondratyev if (to == 0) { 5593ee5c554SVladimir Kondratyev to = bt_get_default_hci_command_timeout(); 5603ee5c554SVladimir Kondratyev if (to < 0) 5613ee5c554SVladimir Kondratyev goto out; 5623ee5c554SVladimir Kondratyev } 5633ee5c554SVladimir Kondratyev to++; 5643ee5c554SVladimir Kondratyev 5653ee5c554SVladimir Kondratyev if (devname == NULL) { 5663ee5c554SVladimir Kondratyev memset(_devname, 0, sizeof(_devname)); 5673ee5c554SVladimir Kondratyev devname = _devname; 5683ee5c554SVladimir Kondratyev if (bt_devenum(bt_devany_cb, _devname) <= 0) 5693ee5c554SVladimir Kondratyev goto out; 5703ee5c554SVladimir Kondratyev } 5713ee5c554SVladimir Kondratyev 5723ee5c554SVladimir Kondratyev memset(&r, 0, sizeof(r)); 5733ee5c554SVladimir Kondratyev memset(&cp, 0, sizeof(cp)); 5743ee5c554SVladimir Kondratyev memset(&ep, 0, sizeof(ep)); 5753ee5c554SVladimir Kondratyev cp.clock_offset = htole16(clk_off); 5763ee5c554SVladimir Kondratyev cp.page_scan_rep_mode = ps_rep_mode; 5773ee5c554SVladimir Kondratyev cp.page_scan_mode = ps_mode; 5783ee5c554SVladimir Kondratyev bdaddr_copy(&cp.bdaddr, remote); 5793ee5c554SVladimir Kondratyev r.opcode = NG_HCI_OPCODE(NG_HCI_OGF_LINK_CONTROL, 5803ee5c554SVladimir Kondratyev NG_HCI_OCF_REMOTE_NAME_REQ); 5813ee5c554SVladimir Kondratyev r.event = NG_HCI_EVENT_REMOTE_NAME_REQ_COMPL; 5823ee5c554SVladimir Kondratyev r.cparam = &cp; 5833ee5c554SVladimir Kondratyev r.clen = sizeof(cp); 5843ee5c554SVladimir Kondratyev r.rparam = &ep; 5853ee5c554SVladimir Kondratyev r.rlen = sizeof(ep); 5863ee5c554SVladimir Kondratyev 5873ee5c554SVladimir Kondratyev s = bt_devopen(devname); 5883ee5c554SVladimir Kondratyev if (s < 0) 5893ee5c554SVladimir Kondratyev goto out; 5903ee5c554SVladimir Kondratyev 5913ee5c554SVladimir Kondratyev if (bt_devreq(s, &r, to) == 0 || ep.status == 0x00) 5923ee5c554SVladimir Kondratyev remote_name = strndup((const char *)&ep.name, sizeof(ep.name)); 5933ee5c554SVladimir Kondratyev 5943ee5c554SVladimir Kondratyev bt_devclose(s); 5953ee5c554SVladimir Kondratyev out: 5963ee5c554SVladimir Kondratyev return (remote_name); 5973ee5c554SVladimir Kondratyev } 5983ee5c554SVladimir Kondratyev 59978b96635SMaksim Yevmenkin int 600baeef614SMaksim Yevmenkin bt_devinfo(struct bt_devinfo *di) 601baeef614SMaksim Yevmenkin { 602baeef614SMaksim Yevmenkin union { 603baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_state r0; 604baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_bdaddr r1; 605baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_features r2; 606baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_buffer r3; 607baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_stat r4; 608baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_link_policy_mask r5; 609baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_packet_mask r6; 610baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_role_switch r7; 611baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_debug r8; 612baeef614SMaksim Yevmenkin } rp; 613baeef614SMaksim Yevmenkin struct sockaddr_hci ha; 61478b96635SMaksim Yevmenkin socklen_t halen; 615baeef614SMaksim Yevmenkin int s, rval; 616baeef614SMaksim Yevmenkin 617baeef614SMaksim Yevmenkin if (di == NULL) { 618baeef614SMaksim Yevmenkin errno = EINVAL; 619baeef614SMaksim Yevmenkin return (-1); 620baeef614SMaksim Yevmenkin } 621baeef614SMaksim Yevmenkin 62278b96635SMaksim Yevmenkin s = bt_devopen(di->devname); 623baeef614SMaksim Yevmenkin if (s < 0) 624baeef614SMaksim Yevmenkin return (-1); 625baeef614SMaksim Yevmenkin 626baeef614SMaksim Yevmenkin rval = -1; 627baeef614SMaksim Yevmenkin 62878b96635SMaksim Yevmenkin halen = sizeof(ha); 62978b96635SMaksim Yevmenkin if (getsockname(s, (struct sockaddr *) &ha, &halen) < 0) 630baeef614SMaksim Yevmenkin goto bad; 631baeef614SMaksim Yevmenkin strlcpy(di->devname, ha.hci_node, sizeof(di->devname)); 632baeef614SMaksim Yevmenkin 633baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STATE, &rp.r0, sizeof(rp.r0)) < 0) 634baeef614SMaksim Yevmenkin goto bad; 635baeef614SMaksim Yevmenkin di->state = rp.r0.state; 636baeef614SMaksim Yevmenkin 637baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BDADDR, &rp.r1, sizeof(rp.r1)) < 0) 638baeef614SMaksim Yevmenkin goto bad; 639baeef614SMaksim Yevmenkin bdaddr_copy(&di->bdaddr, &rp.r1.bdaddr); 640baeef614SMaksim Yevmenkin 641baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_FEATURES, &rp.r2, sizeof(rp.r2)) < 0) 642baeef614SMaksim Yevmenkin goto bad; 643baeef614SMaksim Yevmenkin memcpy(di->features, rp.r2.features, sizeof(di->features)); 644baeef614SMaksim Yevmenkin 645baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BUFFER, &rp.r3, sizeof(rp.r3)) < 0) 646baeef614SMaksim Yevmenkin goto bad; 647baeef614SMaksim Yevmenkin di->cmd_free = rp.r3.buffer.cmd_free; 648baeef614SMaksim Yevmenkin di->sco_size = rp.r3.buffer.sco_size; 649baeef614SMaksim Yevmenkin di->sco_pkts = rp.r3.buffer.sco_pkts; 650baeef614SMaksim Yevmenkin di->sco_free = rp.r3.buffer.sco_free; 651baeef614SMaksim Yevmenkin di->acl_size = rp.r3.buffer.acl_size; 652baeef614SMaksim Yevmenkin di->acl_pkts = rp.r3.buffer.acl_pkts; 653baeef614SMaksim Yevmenkin di->acl_free = rp.r3.buffer.acl_free; 654baeef614SMaksim Yevmenkin 655baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STAT, &rp.r4, sizeof(rp.r4)) < 0) 656baeef614SMaksim Yevmenkin goto bad; 657baeef614SMaksim Yevmenkin di->cmd_sent = rp.r4.stat.cmd_sent; 658baeef614SMaksim Yevmenkin di->evnt_recv = rp.r4.stat.evnt_recv; 659baeef614SMaksim Yevmenkin di->acl_recv = rp.r4.stat.acl_recv; 660baeef614SMaksim Yevmenkin di->acl_sent = rp.r4.stat.acl_sent; 661baeef614SMaksim Yevmenkin di->sco_recv = rp.r4.stat.sco_recv; 662baeef614SMaksim Yevmenkin di->sco_sent = rp.r4.stat.sco_sent; 663baeef614SMaksim Yevmenkin di->bytes_recv = rp.r4.stat.bytes_recv; 664baeef614SMaksim Yevmenkin di->bytes_sent = rp.r4.stat.bytes_sent; 665baeef614SMaksim Yevmenkin 666baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_LINK_POLICY_MASK, 667baeef614SMaksim Yevmenkin &rp.r5, sizeof(rp.r5)) < 0) 668baeef614SMaksim Yevmenkin goto bad; 669baeef614SMaksim Yevmenkin di->link_policy_info = rp.r5.policy_mask; 670baeef614SMaksim Yevmenkin 671baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_PACKET_MASK, 672baeef614SMaksim Yevmenkin &rp.r6, sizeof(rp.r6)) < 0) 673baeef614SMaksim Yevmenkin goto bad; 674baeef614SMaksim Yevmenkin di->packet_type_info = rp.r6.packet_mask; 675baeef614SMaksim Yevmenkin 676baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_ROLE_SWITCH, 677baeef614SMaksim Yevmenkin &rp.r7, sizeof(rp.r7)) < 0) 678baeef614SMaksim Yevmenkin goto bad; 679baeef614SMaksim Yevmenkin di->role_switch_info = rp.r7.role_switch; 680baeef614SMaksim Yevmenkin 681baeef614SMaksim Yevmenkin if (ioctl(s, SIOC_HCI_RAW_NODE_GET_DEBUG, &rp.r8, sizeof(rp.r8)) < 0) 682baeef614SMaksim Yevmenkin goto bad; 683baeef614SMaksim Yevmenkin di->debug = rp.r8.debug; 684baeef614SMaksim Yevmenkin 685baeef614SMaksim Yevmenkin rval = 0; 686baeef614SMaksim Yevmenkin bad: 68778b96635SMaksim Yevmenkin bt_devclose(s); 688baeef614SMaksim Yevmenkin 689baeef614SMaksim Yevmenkin return (rval); 690baeef614SMaksim Yevmenkin } 691baeef614SMaksim Yevmenkin 692baeef614SMaksim Yevmenkin int 693baeef614SMaksim Yevmenkin bt_devenum(bt_devenum_cb_t cb, void *arg) 694baeef614SMaksim Yevmenkin { 695baeef614SMaksim Yevmenkin struct ng_btsocket_hci_raw_node_list_names rp; 696baeef614SMaksim Yevmenkin struct bt_devinfo di; 697baeef614SMaksim Yevmenkin struct sockaddr_hci ha; 698baeef614SMaksim Yevmenkin int s, i, count; 699baeef614SMaksim Yevmenkin 700baeef614SMaksim Yevmenkin rp.num_names = HCI_DEVMAX; 701baeef614SMaksim Yevmenkin rp.names = (struct nodeinfo *) calloc(rp.num_names, 702baeef614SMaksim Yevmenkin sizeof(struct nodeinfo)); 703baeef614SMaksim Yevmenkin if (rp.names == NULL) { 704baeef614SMaksim Yevmenkin errno = ENOMEM; 705baeef614SMaksim Yevmenkin return (-1); 706baeef614SMaksim Yevmenkin } 707baeef614SMaksim Yevmenkin 708baeef614SMaksim Yevmenkin memset(&ha, 0, sizeof(ha)); 709baeef614SMaksim Yevmenkin ha.hci_len = sizeof(ha); 710baeef614SMaksim Yevmenkin ha.hci_family = AF_BLUETOOTH; 711baeef614SMaksim Yevmenkin ha.hci_node[0] = 'x'; 712baeef614SMaksim Yevmenkin 713baeef614SMaksim Yevmenkin s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI); 714baeef614SMaksim Yevmenkin if (s < 0) { 715baeef614SMaksim Yevmenkin free(rp.names); 716baeef614SMaksim Yevmenkin 717baeef614SMaksim Yevmenkin return (-1); 718baeef614SMaksim Yevmenkin } 719baeef614SMaksim Yevmenkin 720baeef614SMaksim Yevmenkin if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 721baeef614SMaksim Yevmenkin connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 722baeef614SMaksim Yevmenkin ioctl(s, SIOC_HCI_RAW_NODE_LIST_NAMES, &rp, sizeof(rp)) < 0) { 723baeef614SMaksim Yevmenkin close(s); 724baeef614SMaksim Yevmenkin free(rp.names); 725baeef614SMaksim Yevmenkin 726baeef614SMaksim Yevmenkin return (-1); 727baeef614SMaksim Yevmenkin } 728baeef614SMaksim Yevmenkin 729baeef614SMaksim Yevmenkin for (count = 0, i = 0; i < rp.num_names; i ++) { 730baeef614SMaksim Yevmenkin strlcpy(di.devname, rp.names[i].name, sizeof(di.devname)); 731baeef614SMaksim Yevmenkin if (bt_devinfo(&di) < 0) 732baeef614SMaksim Yevmenkin continue; 733baeef614SMaksim Yevmenkin 734baeef614SMaksim Yevmenkin count ++; 735baeef614SMaksim Yevmenkin 736baeef614SMaksim Yevmenkin if (cb == NULL) 737baeef614SMaksim Yevmenkin continue; 738baeef614SMaksim Yevmenkin 739baeef614SMaksim Yevmenkin strlcpy(ha.hci_node, rp.names[i].name, sizeof(ha.hci_node)); 740baeef614SMaksim Yevmenkin if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 741baeef614SMaksim Yevmenkin connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0) 742baeef614SMaksim Yevmenkin continue; 743baeef614SMaksim Yevmenkin 744baeef614SMaksim Yevmenkin if ((*cb)(s, &di, arg) > 0) 745baeef614SMaksim Yevmenkin break; 746baeef614SMaksim Yevmenkin } 747baeef614SMaksim Yevmenkin 748baeef614SMaksim Yevmenkin close (s); 749baeef614SMaksim Yevmenkin free(rp.names); 750baeef614SMaksim Yevmenkin 751baeef614SMaksim Yevmenkin return (count); 752baeef614SMaksim Yevmenkin } 753baeef614SMaksim Yevmenkin 75478b96635SMaksim Yevmenkin static int 75578b96635SMaksim Yevmenkin bt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname) 75678b96635SMaksim Yevmenkin { 75778b96635SMaksim Yevmenkin strlcpy((char *) xdevname, di->devname, HCI_DEVNAME_SIZE); 75878b96635SMaksim Yevmenkin return (1); 75978b96635SMaksim Yevmenkin } 76078b96635SMaksim Yevmenkin 761baeef614SMaksim Yevmenkin static char * 762baeef614SMaksim Yevmenkin bt_dev2node(char const *devname, char *nodename, int nnlen) 763baeef614SMaksim Yevmenkin { 764baeef614SMaksim Yevmenkin static char const * bt_dev_prefix[] = { 765baeef614SMaksim Yevmenkin "ubt", /* Bluetooth USB devices */ 766baeef614SMaksim Yevmenkin NULL /* should be last */ 767baeef614SMaksim Yevmenkin }; 768baeef614SMaksim Yevmenkin 769baeef614SMaksim Yevmenkin static char _nodename[HCI_DEVNAME_SIZE]; 770baeef614SMaksim Yevmenkin char const **p; 771baeef614SMaksim Yevmenkin char *ep; 772baeef614SMaksim Yevmenkin int plen, unit; 773baeef614SMaksim Yevmenkin 774baeef614SMaksim Yevmenkin if (nodename == NULL) { 775baeef614SMaksim Yevmenkin nodename = _nodename; 776baeef614SMaksim Yevmenkin nnlen = HCI_DEVNAME_SIZE; 777baeef614SMaksim Yevmenkin } 778baeef614SMaksim Yevmenkin 779baeef614SMaksim Yevmenkin for (p = bt_dev_prefix; *p != NULL; p ++) { 780baeef614SMaksim Yevmenkin plen = strlen(*p); 781baeef614SMaksim Yevmenkin if (strncmp(devname, *p, plen) != 0) 782baeef614SMaksim Yevmenkin continue; 783baeef614SMaksim Yevmenkin 784baeef614SMaksim Yevmenkin unit = strtoul(devname + plen, &ep, 10); 785baeef614SMaksim Yevmenkin if (*ep != '\0' && 786baeef614SMaksim Yevmenkin strcmp(ep, "hci") != 0 && 787baeef614SMaksim Yevmenkin strcmp(ep, "l2cap") != 0) 788baeef614SMaksim Yevmenkin return (NULL); /* can't make sense of device name */ 789baeef614SMaksim Yevmenkin 790baeef614SMaksim Yevmenkin snprintf(nodename, nnlen, "%s%uhci", *p, unit); 791baeef614SMaksim Yevmenkin 792baeef614SMaksim Yevmenkin return (nodename); 793baeef614SMaksim Yevmenkin } 794baeef614SMaksim Yevmenkin 795baeef614SMaksim Yevmenkin return (NULL); 796baeef614SMaksim Yevmenkin } 797baeef614SMaksim Yevmenkin 7983ee5c554SVladimir Kondratyev static time_t 7993ee5c554SVladimir Kondratyev bt_get_default_hci_command_timeout(void) 8003ee5c554SVladimir Kondratyev { 8013ee5c554SVladimir Kondratyev int to; 8023ee5c554SVladimir Kondratyev size_t to_size = sizeof(to); 8033ee5c554SVladimir Kondratyev 8043ee5c554SVladimir Kondratyev if (sysctlbyname("net.bluetooth.hci.command_timeout", 8053ee5c554SVladimir Kondratyev &to, &to_size, NULL, 0) < 0) 8063ee5c554SVladimir Kondratyev return (-1); 8073ee5c554SVladimir Kondratyev 8083ee5c554SVladimir Kondratyev /* Should not happen */ 8093ee5c554SVladimir Kondratyev if (to <= 0) { 8103ee5c554SVladimir Kondratyev errno = ERANGE; 8113ee5c554SVladimir Kondratyev return (-1); 8123ee5c554SVladimir Kondratyev } 8133ee5c554SVladimir Kondratyev 8143ee5c554SVladimir Kondratyev return ((time_t)to); 8153ee5c554SVladimir Kondratyev } 816