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