1189462Semax/* 2189462Semax * hci.c 3189462Semax */ 4189462Semax 5189462Semax/*- 6189462Semax * Copyright (c) 2009 Maksim Yevmenkin <m_evmenkin@yahoo.com> 7189462Semax * All rights reserved. 8189462Semax * 9189462Semax * Redistribution and use in source and binary forms, with or without 10189462Semax * modification, are permitted provided that the following conditions 11189462Semax * are met: 12189462Semax * 1. Redistributions of source code must retain the above copyright 13189462Semax * notice, this list of conditions and the following disclaimer. 14189462Semax * 2. Redistributions in binary form must reproduce the above copyright 15189462Semax * notice, this list of conditions and the following disclaimer in the 16189462Semax * documentation and/or other materials provided with the distribution. 17189462Semax * 18189462Semax * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19189462Semax * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20189462Semax * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21189462Semax * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22189462Semax * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23189462Semax * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24189462Semax * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25189462Semax * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26189462Semax * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27189462Semax * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28189462Semax * SUCH DAMAGE. 29189462Semax * 30189462Semax * $FreeBSD: releng/11.0/lib/libbluetooth/hci.c 281210 2015-04-07 16:48:23Z takawata $ 31189462Semax */ 32189462Semax 33191388Semax#include <assert.h> 34281210Stakawata#define L2CAP_SOCKET_CHECKED 35189462Semax#include <bluetooth.h> 36191388Semax#include <inttypes.h> 37189462Semax#include <stdio.h> 38189462Semax#include <stdlib.h> 39189462Semax#include <string.h> 40189462Semax#include <unistd.h> 41189462Semax 42191388Semax#undef MIN 43191388Semax#define MIN(a, b) (((a) < (b))? (a) : (b)) 44191388Semax 45191388Semaxstatic int bt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname); 46189462Semaxstatic char * bt_dev2node (char const *devname, char *nodename, int nnlen); 47189462Semax 48189462Semaxint 49191388Semaxbt_devopen(char const *devname) 50191388Semax{ 51191388Semax struct sockaddr_hci ha; 52191388Semax bdaddr_t ba; 53191388Semax int s; 54191388Semax 55191388Semax if (devname == NULL) { 56191388Semax errno = EINVAL; 57191388Semax return (-1); 58191388Semax } 59191388Semax 60191388Semax memset(&ha, 0, sizeof(ha)); 61191388Semax ha.hci_len = sizeof(ha); 62191388Semax ha.hci_family = AF_BLUETOOTH; 63191388Semax 64191388Semax if (bt_aton(devname, &ba)) { 65191388Semax if (!bt_devname(ha.hci_node, &ba)) 66191388Semax return (-1); 67191388Semax } else if (bt_dev2node(devname, ha.hci_node, 68191388Semax sizeof(ha.hci_node)) == NULL) { 69191388Semax errno = ENXIO; 70191388Semax return (-1); 71191388Semax } 72191388Semax 73191388Semax s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI); 74191388Semax if (s < 0) 75191388Semax return (-1); 76191388Semax 77191388Semax if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 78191388Semax connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0) { 79191388Semax close(s); 80191388Semax return (-1); 81191388Semax } 82191388Semax 83191388Semax return (s); 84191388Semax} 85191388Semax 86191388Semaxint 87191388Semaxbt_devclose(int s) 88191388Semax{ 89191388Semax return (close(s)); 90191388Semax} 91191388Semax 92191388Semaxint 93191388Semaxbt_devsend(int s, uint16_t opcode, void *param, size_t plen) 94191388Semax{ 95191388Semax ng_hci_cmd_pkt_t h; 96191388Semax struct iovec iv[2]; 97191388Semax int ivn; 98191388Semax 99191388Semax if ((plen == 0 && param != NULL) || 100191388Semax (plen > 0 && param == NULL) || 101191388Semax plen > UINT8_MAX) { 102191388Semax errno = EINVAL; 103191388Semax return (-1); 104191388Semax } 105191388Semax 106191388Semax iv[0].iov_base = &h; 107191388Semax iv[0].iov_len = sizeof(h); 108191388Semax ivn = 1; 109191388Semax 110191388Semax h.type = NG_HCI_CMD_PKT; 111191388Semax h.opcode = htole16(opcode); 112191388Semax if (plen > 0) { 113191388Semax h.length = plen; 114191388Semax 115191388Semax iv[1].iov_base = param; 116191388Semax iv[1].iov_len = plen; 117191388Semax ivn = 2; 118191388Semax } else 119191388Semax h.length = 0; 120191388Semax 121191388Semax while (writev(s, iv, ivn) < 0) { 122191388Semax if (errno == EAGAIN || errno == EINTR) 123191388Semax continue; 124191388Semax 125191388Semax return (-1); 126191388Semax } 127191388Semax 128191388Semax return (0); 129191388Semax} 130191388Semax 131191388Semaxssize_t 132191388Semaxbt_devrecv(int s, void *buf, size_t size, time_t to) 133191388Semax{ 134191388Semax ssize_t n; 135191388Semax 136191388Semax if (buf == NULL || size == 0) { 137191388Semax errno = EINVAL; 138191388Semax return (-1); 139191388Semax } 140191388Semax 141191388Semax if (to >= 0) { 142191388Semax fd_set rfd; 143191388Semax struct timeval tv; 144191388Semax 145191388Semax FD_ZERO(&rfd); 146191388Semax FD_SET(s, &rfd); 147191388Semax 148191388Semax tv.tv_sec = to; 149191388Semax tv.tv_usec = 0; 150191388Semax 151191388Semax while ((n = select(s + 1, &rfd, NULL, NULL, &tv)) < 0) { 152191388Semax if (errno == EAGAIN || errno == EINTR) 153191388Semax continue; 154191388Semax 155191388Semax return (-1); 156191388Semax } 157191388Semax 158191388Semax if (n == 0) { 159191388Semax errno = ETIMEDOUT; 160191388Semax return (-1); 161191388Semax } 162191388Semax 163191388Semax assert(FD_ISSET(s, &rfd)); 164191388Semax } 165191388Semax 166191388Semax while ((n = read(s, buf, size)) < 0) { 167191388Semax if (errno == EAGAIN || errno == EINTR) 168191388Semax continue; 169191388Semax 170191388Semax return (-1); 171191388Semax } 172191388Semax 173191388Semax switch (*((uint8_t *) buf)) { 174191388Semax case NG_HCI_CMD_PKT: { 175191388Semax ng_hci_cmd_pkt_t *h = (ng_hci_cmd_pkt_t *) buf; 176191388Semax 177191388Semax if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 178191388Semax return (n); 179191388Semax } break; 180191388Semax 181191388Semax case NG_HCI_ACL_DATA_PKT: { 182191388Semax ng_hci_acldata_pkt_t *h = (ng_hci_acldata_pkt_t *) buf; 183191388Semax 184191388Semax if (n >= sizeof(*h) && n == (sizeof(*h) + le16toh(h->length))) 185191388Semax return (n); 186191388Semax } break; 187191388Semax 188191388Semax case NG_HCI_SCO_DATA_PKT: { 189191388Semax ng_hci_scodata_pkt_t *h = (ng_hci_scodata_pkt_t *) buf; 190191388Semax 191191388Semax if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 192191388Semax return (n); 193191388Semax } break; 194191388Semax 195191388Semax case NG_HCI_EVENT_PKT: { 196191388Semax ng_hci_event_pkt_t *h = (ng_hci_event_pkt_t *) buf; 197191388Semax 198191388Semax if (n >= sizeof(*h) && n == (sizeof(*h) + h->length)) 199191388Semax return (n); 200191388Semax } break; 201191388Semax } 202191388Semax 203191388Semax errno = EIO; 204191388Semax return (-1); 205191388Semax} 206191388Semax 207191388Semaxint 208191388Semaxbt_devreq(int s, struct bt_devreq *r, time_t to) 209191388Semax{ 210191388Semax uint8_t buf[320]; /* more than enough */ 211191388Semax ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) buf; 212191388Semax ng_hci_command_compl_ep *cc = (ng_hci_command_compl_ep *)(e+1); 213191388Semax ng_hci_command_status_ep *cs = (ng_hci_command_status_ep*)(e+1); 214191388Semax struct bt_devfilter old, new; 215191388Semax time_t t_end; 216191388Semax uint16_t opcode; 217191388Semax ssize_t n; 218191388Semax int error; 219191388Semax 220191388Semax if (s < 0 || r == NULL || to < 0) { 221191388Semax errno = EINVAL; 222191388Semax return (-1); 223191388Semax } 224191388Semax 225191388Semax if ((r->rlen == 0 && r->rparam != NULL) || 226191388Semax (r->rlen > 0 && r->rparam == NULL)) { 227191388Semax errno = EINVAL; 228191388Semax return (-1); 229191388Semax } 230191388Semax 231191388Semax memset(&new, 0, sizeof(new)); 232191388Semax bt_devfilter_pkt_set(&new, NG_HCI_EVENT_PKT); 233191388Semax bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_COMPL); 234191388Semax bt_devfilter_evt_set(&new, NG_HCI_EVENT_COMMAND_STATUS); 235191388Semax if (r->event != 0) 236191388Semax bt_devfilter_evt_set(&new, r->event); 237191388Semax 238191388Semax if (bt_devfilter(s, &new, &old) < 0) 239191388Semax return (-1); 240191388Semax 241191388Semax error = 0; 242191388Semax 243191388Semax n = bt_devsend(s, r->opcode, r->cparam, r->clen); 244191388Semax if (n < 0) { 245191388Semax error = errno; 246191388Semax goto out; 247191388Semax } 248191388Semax 249191388Semax opcode = htole16(r->opcode); 250191388Semax t_end = time(NULL) + to; 251191388Semax 252191388Semax do { 253191388Semax to = t_end - time(NULL); 254191388Semax if (to < 0) 255191388Semax to = 0; 256191388Semax 257191388Semax n = bt_devrecv(s, buf, sizeof(buf), to); 258191388Semax if (n < 0) { 259191388Semax error = errno; 260191388Semax goto out; 261191388Semax } 262191388Semax 263191388Semax if (e->type != NG_HCI_EVENT_PKT) { 264191388Semax error = EIO; 265191388Semax goto out; 266191388Semax } 267191388Semax 268191388Semax n -= sizeof(*e); 269191388Semax 270191388Semax switch (e->event) { 271191388Semax case NG_HCI_EVENT_COMMAND_COMPL: 272191388Semax if (cc->opcode == opcode) { 273191388Semax n -= sizeof(*cc); 274191388Semax 275191388Semax if (r->rlen >= n) { 276191388Semax r->rlen = n; 277191388Semax memcpy(r->rparam, cc + 1, r->rlen); 278191388Semax } 279191388Semax 280191388Semax goto out; 281191388Semax } 282191388Semax break; 283191388Semax 284191388Semax case NG_HCI_EVENT_COMMAND_STATUS: 285191388Semax if (cs->opcode == opcode) { 286191388Semax if (r->event != NG_HCI_EVENT_COMMAND_STATUS) { 287191388Semax if (cs->status != 0) { 288191388Semax error = EIO; 289191388Semax goto out; 290191388Semax } 291191388Semax } else { 292191388Semax if (r->rlen >= n) { 293191388Semax r->rlen = n; 294191388Semax memcpy(r->rparam, cs, r->rlen); 295191388Semax } 296191388Semax 297191388Semax goto out; 298191388Semax } 299191388Semax } 300191388Semax break; 301191388Semax 302191388Semax default: 303191388Semax if (e->event == r->event) { 304191388Semax if (r->rlen >= n) { 305191388Semax r->rlen = n; 306191388Semax memcpy(r->rparam, e + 1, r->rlen); 307191388Semax } 308191388Semax 309191388Semax goto out; 310191388Semax } 311191388Semax break; 312191388Semax } 313191388Semax } while (to > 0); 314191388Semax 315191388Semax error = ETIMEDOUT; 316191388Semaxout: 317191388Semax bt_devfilter(s, &old, NULL); 318191388Semax 319191388Semax if (error != 0) { 320191388Semax errno = error; 321191388Semax return (-1); 322191388Semax } 323191388Semax 324191388Semax return (0); 325191388Semax} 326191388Semax 327191388Semaxint 328191388Semaxbt_devfilter(int s, struct bt_devfilter const *new, struct bt_devfilter *old) 329191388Semax{ 330191388Semax struct ng_btsocket_hci_raw_filter f; 331191388Semax socklen_t len; 332191388Semax 333191388Semax if (new == NULL && old == NULL) { 334191388Semax errno = EINVAL; 335191388Semax return (-1); 336191388Semax } 337191388Semax 338191388Semax if (old != NULL) { 339191388Semax len = sizeof(f); 340191388Semax if (getsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, &len) < 0) 341191388Semax return (-1); 342191388Semax 343191388Semax memset(old, 0, sizeof(*old)); 344191388Semax memcpy(old->packet_mask, &f.packet_mask, 345191388Semax MIN(sizeof(old->packet_mask), sizeof(f.packet_mask))); 346191388Semax memcpy(old->event_mask, &f.event_mask, 347191388Semax MIN(sizeof(old->event_mask), sizeof(f.packet_mask))); 348191388Semax } 349191388Semax 350191388Semax if (new != NULL) { 351191388Semax memset(&f, 0, sizeof(f)); 352191388Semax memcpy(&f.packet_mask, new->packet_mask, 353191388Semax MIN(sizeof(f.packet_mask), sizeof(new->event_mask))); 354191388Semax memcpy(&f.event_mask, new->event_mask, 355191388Semax MIN(sizeof(f.event_mask), sizeof(new->event_mask))); 356191388Semax 357191388Semax len = sizeof(f); 358191388Semax if (setsockopt(s, SOL_HCI_RAW, SO_HCI_RAW_FILTER, &f, len) < 0) 359191388Semax return (-1); 360191388Semax } 361191388Semax 362191388Semax return (0); 363191388Semax} 364191388Semax 365191388Semaxvoid 366191388Semaxbt_devfilter_pkt_set(struct bt_devfilter *filter, uint8_t type) 367191388Semax{ 368191388Semax bit_set(filter->packet_mask, type - 1); 369191388Semax} 370191388Semax 371191388Semaxvoid 372191388Semaxbt_devfilter_pkt_clr(struct bt_devfilter *filter, uint8_t type) 373191388Semax{ 374191388Semax bit_clear(filter->packet_mask, type - 1); 375191388Semax} 376191388Semax 377191388Semaxint 378191388Semaxbt_devfilter_pkt_tst(struct bt_devfilter const *filter, uint8_t type) 379191388Semax{ 380191388Semax return (bit_test(filter->packet_mask, type - 1)); 381191388Semax} 382191388Semax 383191388Semaxvoid 384191388Semaxbt_devfilter_evt_set(struct bt_devfilter *filter, uint8_t event) 385191388Semax{ 386191388Semax bit_set(filter->event_mask, event - 1); 387191388Semax} 388191388Semax 389191388Semaxvoid 390191388Semaxbt_devfilter_evt_clr(struct bt_devfilter *filter, uint8_t event) 391191388Semax{ 392191388Semax bit_clear(filter->event_mask, event - 1); 393191388Semax} 394191388Semax 395191388Semaxint 396191388Semaxbt_devfilter_evt_tst(struct bt_devfilter const *filter, uint8_t event) 397191388Semax{ 398191388Semax return (bit_test(filter->event_mask, event - 1)); 399191388Semax} 400191388Semax 401191388Semaxint 402191388Semaxbt_devinquiry(char const *devname, time_t length, int num_rsp, 403191388Semax struct bt_devinquiry **ii) 404191388Semax{ 405191388Semax uint8_t buf[320]; 406191388Semax char _devname[HCI_DEVNAME_SIZE]; 407191388Semax struct bt_devfilter f; 408191388Semax ng_hci_inquiry_cp *cp = (ng_hci_inquiry_cp *) buf; 409191388Semax ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) buf; 410191388Semax ng_hci_inquiry_result_ep *ep = (ng_hci_inquiry_result_ep *)(e+1); 411191388Semax ng_hci_inquiry_response *ir; 412191388Semax struct bt_devinquiry *i; 413191388Semax int s, n; 414191388Semax 415191388Semax if (ii == NULL) { 416191388Semax errno = EINVAL; 417191388Semax return (-1); 418191388Semax } 419191388Semax 420191388Semax if (devname == NULL) { 421191388Semax memset(_devname, 0, sizeof(_devname)); 422191388Semax devname = _devname; 423191388Semax 424191388Semax n = bt_devenum(bt_devany_cb, _devname); 425191388Semax if (n <= 0) { 426191388Semax if (n == 0) 427191388Semax *ii = NULL; 428191388Semax 429191388Semax return (n); 430191388Semax } 431191388Semax } 432191388Semax 433191388Semax s = bt_devopen(devname); 434191388Semax if (s < 0) 435191388Semax return (-1); 436191388Semax 437191388Semax if (bt_devfilter(s, NULL, &f) < 0) { 438191388Semax bt_devclose(s); 439191388Semax return (-1); 440191388Semax } 441191388Semax 442191388Semax bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_COMPL); 443191388Semax bt_devfilter_evt_set(&f, NG_HCI_EVENT_INQUIRY_RESULT); 444191388Semax 445191388Semax if (bt_devfilter(s, &f, NULL) < 0) { 446191388Semax bt_devclose(s); 447191388Semax return (-1); 448191388Semax } 449191388Semax 450191388Semax /* Always use GIAC LAP */ 451191388Semax cp->lap[0] = 0x33; 452191388Semax cp->lap[1] = 0x8b; 453191388Semax cp->lap[2] = 0x9e; 454191388Semax 455192113Semax /* 456192113Semax * Calculate inquire length in 1.28 second units 457192113Semax * v2.x specification says that 1.28 -> 61.44 seconds 458192113Semax * range is acceptable 459192113Semax */ 460191388Semax 461192113Semax if (length <= 0) 462192113Semax length = 5; 463192113Semax else if (length == 1) 464192113Semax length = 2; 465192113Semax else if (length > 62) 466192113Semax length = 62; 467191388Semax 468192113Semax cp->inquiry_length = (uint8_t)((length * 100) / 128); 469192113Semax 470191388Semax if (num_rsp <= 0 || num_rsp > 255) 471191388Semax num_rsp = 8; 472191388Semax cp->num_responses = (uint8_t) num_rsp; 473191388Semax 474191388Semax i = *ii = calloc(num_rsp, sizeof(struct bt_devinquiry)); 475191388Semax if (i == NULL) { 476191388Semax bt_devclose(s); 477191388Semax errno = ENOMEM; 478191388Semax return (-1); 479191388Semax } 480191388Semax 481191388Semax if (bt_devsend(s, 482191388Semax NG_HCI_OPCODE(NG_HCI_OGF_LINK_CONTROL, NG_HCI_OCF_INQUIRY), 483191388Semax cp, sizeof(*cp)) < 0) { 484191388Semax free(i); 485191388Semax bt_devclose(s); 486191388Semax return (-1); 487191388Semax } 488191388Semax 489191388Semaxwait_for_more: 490191388Semax 491192113Semax n = bt_devrecv(s, buf, sizeof(buf), length); 492191388Semax if (n < 0) { 493191388Semax free(i); 494191388Semax bt_devclose(s); 495191388Semax return (-1); 496191388Semax } 497191388Semax 498191388Semax if (n < sizeof(ng_hci_event_pkt_t)) { 499191388Semax free(i); 500191388Semax bt_devclose(s); 501191388Semax errno = EIO; 502191388Semax return (-1); 503191388Semax } 504191388Semax 505191388Semax switch (e->event) { 506191388Semax case NG_HCI_EVENT_INQUIRY_COMPL: 507191388Semax break; 508191388Semax 509191388Semax case NG_HCI_EVENT_INQUIRY_RESULT: 510191388Semax ir = (ng_hci_inquiry_response *)(ep + 1); 511191388Semax 512191388Semax for (n = 0; n < MIN(ep->num_responses, num_rsp); n ++) { 513191388Semax bdaddr_copy(&i->bdaddr, &ir->bdaddr); 514191388Semax i->pscan_rep_mode = ir->page_scan_rep_mode; 515191388Semax i->pscan_period_mode = ir->page_scan_period_mode; 516191388Semax memcpy(i->dev_class, ir->uclass, sizeof(i->dev_class)); 517191388Semax i->clock_offset = le16toh(ir->clock_offset); 518191388Semax 519191388Semax ir ++; 520191388Semax i ++; 521191388Semax num_rsp --; 522191388Semax } 523191388Semax /* FALLTHROUGH */ 524191388Semax 525191388Semax default: 526191388Semax goto wait_for_more; 527191388Semax /* NOT REACHED */ 528191388Semax } 529191388Semax 530191388Semax bt_devclose(s); 531191388Semax 532191388Semax return (i - *ii); 533191388Semax} 534191388Semax 535191388Semaxint 536189462Semaxbt_devinfo(struct bt_devinfo *di) 537189462Semax{ 538189462Semax union { 539189462Semax struct ng_btsocket_hci_raw_node_state r0; 540189462Semax struct ng_btsocket_hci_raw_node_bdaddr r1; 541189462Semax struct ng_btsocket_hci_raw_node_features r2; 542189462Semax struct ng_btsocket_hci_raw_node_buffer r3; 543189462Semax struct ng_btsocket_hci_raw_node_stat r4; 544189462Semax struct ng_btsocket_hci_raw_node_link_policy_mask r5; 545189462Semax struct ng_btsocket_hci_raw_node_packet_mask r6; 546189462Semax struct ng_btsocket_hci_raw_node_role_switch r7; 547189462Semax struct ng_btsocket_hci_raw_node_debug r8; 548189462Semax } rp; 549189462Semax struct sockaddr_hci ha; 550191388Semax socklen_t halen; 551189462Semax int s, rval; 552189462Semax 553189462Semax if (di == NULL) { 554189462Semax errno = EINVAL; 555189462Semax return (-1); 556189462Semax } 557189462Semax 558191388Semax s = bt_devopen(di->devname); 559189462Semax if (s < 0) 560189462Semax return (-1); 561189462Semax 562189462Semax rval = -1; 563189462Semax 564191388Semax halen = sizeof(ha); 565191388Semax if (getsockname(s, (struct sockaddr *) &ha, &halen) < 0) 566189462Semax goto bad; 567189462Semax strlcpy(di->devname, ha.hci_node, sizeof(di->devname)); 568189462Semax 569189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STATE, &rp.r0, sizeof(rp.r0)) < 0) 570189462Semax goto bad; 571189462Semax di->state = rp.r0.state; 572189462Semax 573189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BDADDR, &rp.r1, sizeof(rp.r1)) < 0) 574189462Semax goto bad; 575189462Semax bdaddr_copy(&di->bdaddr, &rp.r1.bdaddr); 576189462Semax 577189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_FEATURES, &rp.r2, sizeof(rp.r2)) < 0) 578189462Semax goto bad; 579189462Semax memcpy(di->features, rp.r2.features, sizeof(di->features)); 580189462Semax 581189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_BUFFER, &rp.r3, sizeof(rp.r3)) < 0) 582189462Semax goto bad; 583189462Semax di->cmd_free = rp.r3.buffer.cmd_free; 584189462Semax di->sco_size = rp.r3.buffer.sco_size; 585189462Semax di->sco_pkts = rp.r3.buffer.sco_pkts; 586189462Semax di->sco_free = rp.r3.buffer.sco_free; 587189462Semax di->acl_size = rp.r3.buffer.acl_size; 588189462Semax di->acl_pkts = rp.r3.buffer.acl_pkts; 589189462Semax di->acl_free = rp.r3.buffer.acl_free; 590189462Semax 591189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_STAT, &rp.r4, sizeof(rp.r4)) < 0) 592189462Semax goto bad; 593189462Semax di->cmd_sent = rp.r4.stat.cmd_sent; 594189462Semax di->evnt_recv = rp.r4.stat.evnt_recv; 595189462Semax di->acl_recv = rp.r4.stat.acl_recv; 596189462Semax di->acl_sent = rp.r4.stat.acl_sent; 597189462Semax di->sco_recv = rp.r4.stat.sco_recv; 598189462Semax di->sco_sent = rp.r4.stat.sco_sent; 599189462Semax di->bytes_recv = rp.r4.stat.bytes_recv; 600189462Semax di->bytes_sent = rp.r4.stat.bytes_sent; 601189462Semax 602189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_LINK_POLICY_MASK, 603189462Semax &rp.r5, sizeof(rp.r5)) < 0) 604189462Semax goto bad; 605189462Semax di->link_policy_info = rp.r5.policy_mask; 606189462Semax 607189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_PACKET_MASK, 608189462Semax &rp.r6, sizeof(rp.r6)) < 0) 609189462Semax goto bad; 610189462Semax di->packet_type_info = rp.r6.packet_mask; 611189462Semax 612189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_ROLE_SWITCH, 613189462Semax &rp.r7, sizeof(rp.r7)) < 0) 614189462Semax goto bad; 615189462Semax di->role_switch_info = rp.r7.role_switch; 616189462Semax 617189462Semax if (ioctl(s, SIOC_HCI_RAW_NODE_GET_DEBUG, &rp.r8, sizeof(rp.r8)) < 0) 618189462Semax goto bad; 619189462Semax di->debug = rp.r8.debug; 620189462Semax 621189462Semax rval = 0; 622189462Semaxbad: 623191388Semax bt_devclose(s); 624189462Semax 625189462Semax return (rval); 626189462Semax} 627189462Semax 628189462Semaxint 629189462Semaxbt_devenum(bt_devenum_cb_t cb, void *arg) 630189462Semax{ 631189462Semax struct ng_btsocket_hci_raw_node_list_names rp; 632189462Semax struct bt_devinfo di; 633189462Semax struct sockaddr_hci ha; 634189462Semax int s, i, count; 635189462Semax 636189462Semax rp.num_names = HCI_DEVMAX; 637189462Semax rp.names = (struct nodeinfo *) calloc(rp.num_names, 638189462Semax sizeof(struct nodeinfo)); 639189462Semax if (rp.names == NULL) { 640189462Semax errno = ENOMEM; 641189462Semax return (-1); 642189462Semax } 643189462Semax 644189462Semax memset(&ha, 0, sizeof(ha)); 645189462Semax ha.hci_len = sizeof(ha); 646189462Semax ha.hci_family = AF_BLUETOOTH; 647189462Semax ha.hci_node[0] = 'x'; 648189462Semax 649189462Semax s = socket(PF_BLUETOOTH, SOCK_RAW, BLUETOOTH_PROTO_HCI); 650189462Semax if (s < 0) { 651189462Semax free(rp.names); 652189462Semax 653189462Semax return (-1); 654189462Semax } 655189462Semax 656189462Semax if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 657189462Semax connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 658189462Semax ioctl(s, SIOC_HCI_RAW_NODE_LIST_NAMES, &rp, sizeof(rp)) < 0) { 659189462Semax close(s); 660189462Semax free(rp.names); 661189462Semax 662189462Semax return (-1); 663189462Semax } 664189462Semax 665189462Semax for (count = 0, i = 0; i < rp.num_names; i ++) { 666189462Semax strlcpy(di.devname, rp.names[i].name, sizeof(di.devname)); 667189462Semax if (bt_devinfo(&di) < 0) 668189462Semax continue; 669189462Semax 670189462Semax count ++; 671189462Semax 672189462Semax if (cb == NULL) 673189462Semax continue; 674189462Semax 675189462Semax strlcpy(ha.hci_node, rp.names[i].name, sizeof(ha.hci_node)); 676189462Semax if (bind(s, (struct sockaddr *) &ha, sizeof(ha)) < 0 || 677189462Semax connect(s, (struct sockaddr *) &ha, sizeof(ha)) < 0) 678189462Semax continue; 679189462Semax 680189462Semax if ((*cb)(s, &di, arg) > 0) 681189462Semax break; 682189462Semax } 683189462Semax 684189462Semax close (s); 685189462Semax free(rp.names); 686189462Semax 687189462Semax return (count); 688189462Semax} 689189462Semax 690191388Semaxstatic int 691191388Semaxbt_devany_cb(int s, struct bt_devinfo const *di, void *xdevname) 692191388Semax{ 693191388Semax strlcpy((char *) xdevname, di->devname, HCI_DEVNAME_SIZE); 694191388Semax return (1); 695191388Semax} 696191388Semax 697189462Semaxstatic char * 698189462Semaxbt_dev2node(char const *devname, char *nodename, int nnlen) 699189462Semax{ 700189462Semax static char const * bt_dev_prefix[] = { 701189462Semax "btccc", /* 3Com Bluetooth PC-CARD */ 702189462Semax "h4", /* UART/serial Bluetooth devices */ 703189462Semax "ubt", /* Bluetooth USB devices */ 704189462Semax NULL /* should be last */ 705189462Semax }; 706189462Semax 707189462Semax static char _nodename[HCI_DEVNAME_SIZE]; 708189462Semax char const **p; 709189462Semax char *ep; 710189462Semax int plen, unit; 711189462Semax 712189462Semax if (nodename == NULL) { 713189462Semax nodename = _nodename; 714189462Semax nnlen = HCI_DEVNAME_SIZE; 715189462Semax } 716189462Semax 717189462Semax for (p = bt_dev_prefix; *p != NULL; p ++) { 718189462Semax plen = strlen(*p); 719189462Semax if (strncmp(devname, *p, plen) != 0) 720189462Semax continue; 721189462Semax 722189462Semax unit = strtoul(devname + plen, &ep, 10); 723189462Semax if (*ep != '\0' && 724189462Semax strcmp(ep, "hci") != 0 && 725189462Semax strcmp(ep, "l2cap") != 0) 726189462Semax return (NULL); /* can't make sense of device name */ 727189462Semax 728189462Semax snprintf(nodename, nnlen, "%s%uhci", *p, unit); 729189462Semax 730189462Semax return (nodename); 731189462Semax } 732189462Semax 733189462Semax return (NULL); 734189462Semax} 735189462Semax 736