1878ed226SJulian Elischer /* 2878ed226SJulian Elischer * ng_hci_misc.c 3c398230bSWarner Losh */ 4c398230bSWarner Losh 5c398230bSWarner Losh /*- 6878ed226SJulian Elischer * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com> 7878ed226SJulian Elischer * All rights reserved. 8878ed226SJulian Elischer * 9878ed226SJulian Elischer * Redistribution and use in source and binary forms, with or without 10878ed226SJulian Elischer * modification, are permitted provided that the following conditions 11878ed226SJulian Elischer * are met: 12878ed226SJulian Elischer * 1. Redistributions of source code must retain the above copyright 13878ed226SJulian Elischer * notice, this list of conditions and the following disclaimer. 14878ed226SJulian Elischer * 2. Redistributions in binary form must reproduce the above copyright 15878ed226SJulian Elischer * notice, this list of conditions and the following disclaimer in the 16878ed226SJulian Elischer * documentation and/or other materials provided with the distribution. 17878ed226SJulian Elischer * 18878ed226SJulian Elischer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19878ed226SJulian Elischer * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20878ed226SJulian Elischer * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21878ed226SJulian Elischer * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22878ed226SJulian Elischer * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23878ed226SJulian Elischer * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24878ed226SJulian Elischer * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25878ed226SJulian Elischer * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26878ed226SJulian Elischer * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27878ed226SJulian Elischer * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28878ed226SJulian Elischer * SUCH DAMAGE. 29878ed226SJulian Elischer * 300986ab12SMaksim Yevmenkin * $Id: ng_hci_misc.c,v 1.5 2003/09/08 18:57:51 max Exp $ 31878ed226SJulian Elischer * $FreeBSD$ 32878ed226SJulian Elischer */ 33878ed226SJulian Elischer 34878ed226SJulian Elischer #include <sys/param.h> 35878ed226SJulian Elischer #include <sys/systm.h> 36878ed226SJulian Elischer #include <sys/kernel.h> 37878ed226SJulian Elischer #include <sys/malloc.h> 38878ed226SJulian Elischer #include <sys/mbuf.h> 39878ed226SJulian Elischer #include <sys/queue.h> 40878ed226SJulian Elischer #include <netgraph/ng_message.h> 41878ed226SJulian Elischer #include <netgraph/netgraph.h> 42b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_bluetooth.h> 43b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_hci.h> 44b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_var.h> 45b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_cmds.h> 46b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_evnt.h> 47b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_ulpi.h> 48b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/hci/ng_hci_misc.h> 49878ed226SJulian Elischer 50878ed226SJulian Elischer /****************************************************************************** 51878ed226SJulian Elischer ****************************************************************************** 52878ed226SJulian Elischer ** Utility routines 53878ed226SJulian Elischer ****************************************************************************** 54878ed226SJulian Elischer ******************************************************************************/ 55878ed226SJulian Elischer 56878ed226SJulian Elischer /* 57878ed226SJulian Elischer * Give packet to RAW hook 58878ed226SJulian Elischer * Assumes input mbuf is read only. 59878ed226SJulian Elischer */ 60878ed226SJulian Elischer 61878ed226SJulian Elischer void 62878ed226SJulian Elischer ng_hci_mtap(ng_hci_unit_p unit, struct mbuf *m0) 63878ed226SJulian Elischer { 64878ed226SJulian Elischer struct mbuf *m = NULL; 65878ed226SJulian Elischer int error = 0; 66878ed226SJulian Elischer 67878ed226SJulian Elischer if (unit->raw != NULL && NG_HOOK_IS_VALID(unit->raw)) { 68a163d034SWarner Losh m = m_dup(m0, M_DONTWAIT); 69878ed226SJulian Elischer if (m != NULL) 70878ed226SJulian Elischer NG_SEND_DATA_ONLY(error, unit->raw, m); 71878ed226SJulian Elischer 72878ed226SJulian Elischer if (error != 0) 73878ed226SJulian Elischer NG_HCI_INFO( 74878ed226SJulian Elischer "%s: %s - Could not forward packet, error=%d\n", 75878ed226SJulian Elischer __func__, NG_NODE_NAME(unit->node), error); 76878ed226SJulian Elischer } 77878ed226SJulian Elischer } /* ng_hci_mtap */ 78878ed226SJulian Elischer 79878ed226SJulian Elischer /* 80878ed226SJulian Elischer * Send notification to the upper layer's 81878ed226SJulian Elischer */ 82878ed226SJulian Elischer 83878ed226SJulian Elischer void 84878ed226SJulian Elischer ng_hci_node_is_up(node_p node, hook_p hook, void *arg1, int arg2) 85878ed226SJulian Elischer { 86878ed226SJulian Elischer ng_hci_unit_p unit = NULL; 87878ed226SJulian Elischer struct ng_mesg *msg = NULL; 88878ed226SJulian Elischer ng_hci_node_up_ep *ep = NULL; 89878ed226SJulian Elischer int error; 90878ed226SJulian Elischer 91878ed226SJulian Elischer if (node == NULL || NG_NODE_NOT_VALID(node) || 92878ed226SJulian Elischer hook == NULL || NG_HOOK_NOT_VALID(hook)) 93878ed226SJulian Elischer return; 94878ed226SJulian Elischer 95878ed226SJulian Elischer unit = (ng_hci_unit_p) NG_NODE_PRIVATE(node); 96878ed226SJulian Elischer if ((unit->state & NG_HCI_UNIT_READY) != NG_HCI_UNIT_READY) 97878ed226SJulian Elischer return; 98878ed226SJulian Elischer 99878ed226SJulian Elischer if (hook != unit->acl && hook != unit->sco) 100878ed226SJulian Elischer return; 101878ed226SJulian Elischer 102878ed226SJulian Elischer NG_MKMESSAGE(msg,NGM_HCI_COOKIE,NGM_HCI_NODE_UP,sizeof(*ep),M_NOWAIT); 103878ed226SJulian Elischer if (msg != NULL) { 104878ed226SJulian Elischer ep = (ng_hci_node_up_ep *)(msg->data); 105878ed226SJulian Elischer 106878ed226SJulian Elischer if (hook == unit->acl) { 107878ed226SJulian Elischer NG_HCI_BUFF_ACL_SIZE(unit->buffer, ep->pkt_size); 108878ed226SJulian Elischer NG_HCI_BUFF_ACL_TOTAL(unit->buffer, ep->num_pkts); 109878ed226SJulian Elischer } else { 110878ed226SJulian Elischer NG_HCI_BUFF_SCO_SIZE(unit->buffer, ep->pkt_size); 111878ed226SJulian Elischer NG_HCI_BUFF_SCO_TOTAL(unit->buffer, ep->num_pkts); 112878ed226SJulian Elischer } 113878ed226SJulian Elischer 114878ed226SJulian Elischer bcopy(&unit->bdaddr, &ep->bdaddr, sizeof(ep->bdaddr)); 115878ed226SJulian Elischer 1164ae439a3SMaksim Yevmenkin NG_SEND_MSG_HOOK(error, node, msg, hook, 0); 117878ed226SJulian Elischer } else 118878ed226SJulian Elischer error = ENOMEM; 119878ed226SJulian Elischer 120878ed226SJulian Elischer if (error != 0) 121878ed226SJulian Elischer NG_HCI_INFO( 122878ed226SJulian Elischer "%s: %s - failed to send NODE_UP message to hook \"%s\", error=%d\n", 123878ed226SJulian Elischer __func__, NG_NODE_NAME(unit->node), 124878ed226SJulian Elischer NG_HOOK_NAME(hook), error); 125878ed226SJulian Elischer } /* ng_hci_node_is_up */ 126878ed226SJulian Elischer 127878ed226SJulian Elischer /* 128878ed226SJulian Elischer * Clean unit (helper) 129878ed226SJulian Elischer */ 130878ed226SJulian Elischer 131878ed226SJulian Elischer void 132878ed226SJulian Elischer ng_hci_unit_clean(ng_hci_unit_p unit, int reason) 133878ed226SJulian Elischer { 134878ed226SJulian Elischer int size; 135878ed226SJulian Elischer 136878ed226SJulian Elischer /* Drain command queue */ 137878ed226SJulian Elischer if (unit->state & NG_HCI_UNIT_COMMAND_PENDING) 138878ed226SJulian Elischer ng_hci_command_untimeout(unit); 139878ed226SJulian Elischer 140878ed226SJulian Elischer NG_BT_MBUFQ_DRAIN(&unit->cmdq); 141878ed226SJulian Elischer NG_HCI_BUFF_CMD_SET(unit->buffer, 1); 142878ed226SJulian Elischer 143878ed226SJulian Elischer /* Clean up connection list */ 144878ed226SJulian Elischer while (!LIST_EMPTY(&unit->con_list)) { 145878ed226SJulian Elischer ng_hci_unit_con_p con = LIST_FIRST(&unit->con_list); 146878ed226SJulian Elischer 1470986ab12SMaksim Yevmenkin /* Remove all timeouts (if any) */ 1480986ab12SMaksim Yevmenkin if (con->flags & NG_HCI_CON_TIMEOUT_PENDING) 1490986ab12SMaksim Yevmenkin ng_hci_con_untimeout(con); 1500986ab12SMaksim Yevmenkin 151878ed226SJulian Elischer /* 152878ed226SJulian Elischer * Notify upper layer protocol and destroy connection 153878ed226SJulian Elischer * descriptor. Do not really care about the result. 154878ed226SJulian Elischer */ 155878ed226SJulian Elischer 156878ed226SJulian Elischer ng_hci_lp_discon_ind(con, reason); 157878ed226SJulian Elischer ng_hci_free_con(con); 158878ed226SJulian Elischer } 159878ed226SJulian Elischer 160878ed226SJulian Elischer NG_HCI_BUFF_ACL_TOTAL(unit->buffer, size); 161878ed226SJulian Elischer NG_HCI_BUFF_ACL_FREE(unit->buffer, size); 162878ed226SJulian Elischer 163878ed226SJulian Elischer NG_HCI_BUFF_SCO_TOTAL(unit->buffer, size); 164878ed226SJulian Elischer NG_HCI_BUFF_SCO_FREE(unit->buffer, size); 165878ed226SJulian Elischer 166878ed226SJulian Elischer /* Clean up neighbors list */ 167878ed226SJulian Elischer ng_hci_flush_neighbor_cache(unit); 168878ed226SJulian Elischer } /* ng_hci_unit_clean */ 169878ed226SJulian Elischer 170878ed226SJulian Elischer /* 171878ed226SJulian Elischer * Allocate and link new unit neighbor cache entry 172878ed226SJulian Elischer */ 173878ed226SJulian Elischer 174878ed226SJulian Elischer ng_hci_neighbor_p 175878ed226SJulian Elischer ng_hci_new_neighbor(ng_hci_unit_p unit) 176878ed226SJulian Elischer { 177878ed226SJulian Elischer ng_hci_neighbor_p n = NULL; 178878ed226SJulian Elischer 1791ede983cSDag-Erling Smørgrav n = malloc(sizeof(*n), M_NETGRAPH_HCI, 180878ed226SJulian Elischer M_NOWAIT | M_ZERO); 181878ed226SJulian Elischer if (n != NULL) { 182878ed226SJulian Elischer getmicrotime(&n->updated); 183878ed226SJulian Elischer LIST_INSERT_HEAD(&unit->neighbors, n, next); 184878ed226SJulian Elischer } 185878ed226SJulian Elischer 186878ed226SJulian Elischer return (n); 187878ed226SJulian Elischer } /* ng_hci_new_neighbor */ 188878ed226SJulian Elischer 189878ed226SJulian Elischer /* 190878ed226SJulian Elischer * Free unit neighbor cache entry 191878ed226SJulian Elischer */ 192878ed226SJulian Elischer 193878ed226SJulian Elischer void 194878ed226SJulian Elischer ng_hci_free_neighbor(ng_hci_neighbor_p n) 195878ed226SJulian Elischer { 196878ed226SJulian Elischer LIST_REMOVE(n, next); 197878ed226SJulian Elischer bzero(n, sizeof(*n)); 1981ede983cSDag-Erling Smørgrav free(n, M_NETGRAPH_HCI); 199878ed226SJulian Elischer } /* ng_hci_free_neighbor */ 200878ed226SJulian Elischer 201878ed226SJulian Elischer /* 202878ed226SJulian Elischer * Flush neighbor cache 203878ed226SJulian Elischer */ 204878ed226SJulian Elischer 205878ed226SJulian Elischer void 206878ed226SJulian Elischer ng_hci_flush_neighbor_cache(ng_hci_unit_p unit) 207878ed226SJulian Elischer { 208878ed226SJulian Elischer while (!LIST_EMPTY(&unit->neighbors)) 209878ed226SJulian Elischer ng_hci_free_neighbor(LIST_FIRST(&unit->neighbors)); 210878ed226SJulian Elischer } /* ng_hci_flush_neighbor_cache */ 211878ed226SJulian Elischer 212878ed226SJulian Elischer /* 213878ed226SJulian Elischer * Lookup unit in neighbor cache 214878ed226SJulian Elischer */ 215878ed226SJulian Elischer 216878ed226SJulian Elischer ng_hci_neighbor_p 217878ed226SJulian Elischer ng_hci_get_neighbor(ng_hci_unit_p unit, bdaddr_p bdaddr) 218878ed226SJulian Elischer { 219878ed226SJulian Elischer ng_hci_neighbor_p n = NULL; 220878ed226SJulian Elischer 221878ed226SJulian Elischer for (n = LIST_FIRST(&unit->neighbors); n != NULL; ) { 222878ed226SJulian Elischer ng_hci_neighbor_p nn = LIST_NEXT(n, next); 223878ed226SJulian Elischer 224878ed226SJulian Elischer if (!ng_hci_neighbor_stale(n)) { 225878ed226SJulian Elischer if (bcmp(&n->bdaddr, bdaddr, sizeof(*bdaddr)) == 0) 226878ed226SJulian Elischer break; 227878ed226SJulian Elischer } else 228878ed226SJulian Elischer ng_hci_free_neighbor(n); /* remove old entry */ 229878ed226SJulian Elischer 230878ed226SJulian Elischer n = nn; 231878ed226SJulian Elischer } 232878ed226SJulian Elischer 233878ed226SJulian Elischer return (n); 234878ed226SJulian Elischer } /* ng_hci_get_neighbor */ 235878ed226SJulian Elischer 236878ed226SJulian Elischer /* 237878ed226SJulian Elischer * Check if neighbor entry is stale 238878ed226SJulian Elischer */ 239878ed226SJulian Elischer 240878ed226SJulian Elischer int 241878ed226SJulian Elischer ng_hci_neighbor_stale(ng_hci_neighbor_p n) 242878ed226SJulian Elischer { 243878ed226SJulian Elischer struct timeval now; 244878ed226SJulian Elischer 245878ed226SJulian Elischer getmicrotime(&now); 246878ed226SJulian Elischer 247878ed226SJulian Elischer return (now.tv_sec - n->updated.tv_sec > bluetooth_hci_max_neighbor_age()); 248878ed226SJulian Elischer } /* ng_hci_neighbor_stale */ 249878ed226SJulian Elischer 250878ed226SJulian Elischer /* 251878ed226SJulian Elischer * Allocate and link new connection descriptor 252878ed226SJulian Elischer */ 253878ed226SJulian Elischer 254878ed226SJulian Elischer ng_hci_unit_con_p 255878ed226SJulian Elischer ng_hci_new_con(ng_hci_unit_p unit, int link_type) 256878ed226SJulian Elischer { 257878ed226SJulian Elischer ng_hci_unit_con_p con = NULL; 258878ed226SJulian Elischer int num_pkts; 2590986ab12SMaksim Yevmenkin static int fake_con_handle = 0x0f00; 260878ed226SJulian Elischer 2611ede983cSDag-Erling Smørgrav con = malloc(sizeof(*con), M_NETGRAPH_HCI, 262878ed226SJulian Elischer M_NOWAIT | M_ZERO); 263878ed226SJulian Elischer if (con != NULL) { 264878ed226SJulian Elischer con->unit = unit; 265878ed226SJulian Elischer con->state = NG_HCI_CON_CLOSED; 2660986ab12SMaksim Yevmenkin 2670986ab12SMaksim Yevmenkin /* 2680986ab12SMaksim Yevmenkin * XXX 2690986ab12SMaksim Yevmenkin * 2700986ab12SMaksim Yevmenkin * Assign fake connection handle to the connection descriptor. 2710986ab12SMaksim Yevmenkin * Bluetooth specification marks 0x0f00 - 0x0fff connection 2720986ab12SMaksim Yevmenkin * handles as reserved. We need this fake connection handles 2730986ab12SMaksim Yevmenkin * for timeouts. Connection handle will be passed as argument 2740986ab12SMaksim Yevmenkin * to timeout so when timeout happens we can find the right 2750986ab12SMaksim Yevmenkin * connection descriptor. We can not pass pointers, because 2760986ab12SMaksim Yevmenkin * timeouts are external (to Netgraph) events and there might 2770986ab12SMaksim Yevmenkin * be a race when node/hook goes down and timeout event already 2780986ab12SMaksim Yevmenkin * went into node's queue 2790986ab12SMaksim Yevmenkin */ 2800986ab12SMaksim Yevmenkin 2810986ab12SMaksim Yevmenkin con->con_handle = fake_con_handle ++; 2820986ab12SMaksim Yevmenkin if (fake_con_handle > 0x0fff) 2830986ab12SMaksim Yevmenkin fake_con_handle = 0x0f00; 2840986ab12SMaksim Yevmenkin 285878ed226SJulian Elischer con->link_type = link_type; 286878ed226SJulian Elischer 287878ed226SJulian Elischer if (con->link_type == NG_HCI_LINK_ACL) 288878ed226SJulian Elischer NG_HCI_BUFF_ACL_TOTAL(unit->buffer, num_pkts); 289878ed226SJulian Elischer else 290878ed226SJulian Elischer NG_HCI_BUFF_SCO_TOTAL(unit->buffer, num_pkts); 291878ed226SJulian Elischer 292878ed226SJulian Elischer NG_BT_ITEMQ_INIT(&con->conq, num_pkts); 293878ed226SJulian Elischer 294b81d7730SMaksim Yevmenkin ng_callout_init(&con->con_timo); 295878ed226SJulian Elischer 296878ed226SJulian Elischer LIST_INSERT_HEAD(&unit->con_list, con, next); 297878ed226SJulian Elischer } 298878ed226SJulian Elischer 299878ed226SJulian Elischer return (con); 300878ed226SJulian Elischer } /* ng_hci_new_con */ 301878ed226SJulian Elischer 302878ed226SJulian Elischer /* 303878ed226SJulian Elischer * Free connection descriptor 304878ed226SJulian Elischer */ 305878ed226SJulian Elischer 306878ed226SJulian Elischer void 307878ed226SJulian Elischer ng_hci_free_con(ng_hci_unit_con_p con) 308878ed226SJulian Elischer { 309878ed226SJulian Elischer LIST_REMOVE(con, next); 310878ed226SJulian Elischer 311878ed226SJulian Elischer /* 312878ed226SJulian Elischer * If we have pending packets then assume that Host Controller has 313878ed226SJulian Elischer * flushed these packets and we can free them too 314878ed226SJulian Elischer */ 315878ed226SJulian Elischer 316878ed226SJulian Elischer if (con->link_type == NG_HCI_LINK_ACL) 317878ed226SJulian Elischer NG_HCI_BUFF_ACL_FREE(con->unit->buffer, con->pending); 318878ed226SJulian Elischer else 319878ed226SJulian Elischer NG_HCI_BUFF_SCO_FREE(con->unit->buffer, con->pending); 320878ed226SJulian Elischer 321878ed226SJulian Elischer NG_BT_ITEMQ_DESTROY(&con->conq); 322878ed226SJulian Elischer 323878ed226SJulian Elischer bzero(con, sizeof(*con)); 3241ede983cSDag-Erling Smørgrav free(con, M_NETGRAPH_HCI); 325878ed226SJulian Elischer } /* ng_hci_free_con */ 326878ed226SJulian Elischer 327878ed226SJulian Elischer /* 328878ed226SJulian Elischer * Lookup connection for given unit and connection handle. 329878ed226SJulian Elischer */ 330878ed226SJulian Elischer 331878ed226SJulian Elischer ng_hci_unit_con_p 332878ed226SJulian Elischer ng_hci_con_by_handle(ng_hci_unit_p unit, int con_handle) 333878ed226SJulian Elischer { 334878ed226SJulian Elischer ng_hci_unit_con_p con = NULL; 335878ed226SJulian Elischer 336878ed226SJulian Elischer LIST_FOREACH(con, &unit->con_list, next) 337878ed226SJulian Elischer if (con->con_handle == con_handle) 338878ed226SJulian Elischer break; 339878ed226SJulian Elischer 340878ed226SJulian Elischer return (con); 341878ed226SJulian Elischer } /* ng_hci_con_by_handle */ 342878ed226SJulian Elischer 343878ed226SJulian Elischer /* 344878ed226SJulian Elischer * Lookup connection for given unit, link type and remove unit address 345878ed226SJulian Elischer */ 346878ed226SJulian Elischer 347878ed226SJulian Elischer ng_hci_unit_con_p 348878ed226SJulian Elischer ng_hci_con_by_bdaddr(ng_hci_unit_p unit, bdaddr_p bdaddr, int link_type) 349878ed226SJulian Elischer { 350878ed226SJulian Elischer ng_hci_unit_con_p con = NULL; 351878ed226SJulian Elischer 352878ed226SJulian Elischer LIST_FOREACH(con, &unit->con_list, next) 353878ed226SJulian Elischer if (con->link_type == link_type && 354878ed226SJulian Elischer bcmp(&con->bdaddr, bdaddr, sizeof(bdaddr_t)) == 0) 355878ed226SJulian Elischer break; 356878ed226SJulian Elischer 357878ed226SJulian Elischer return (con); 358878ed226SJulian Elischer } /* ng_hci_con_by_bdaddr */ 359878ed226SJulian Elischer 360878ed226SJulian Elischer /* 361878ed226SJulian Elischer * Set HCI command timeout 362f9d9e1b4SGleb Smirnoff * XXX FIXME: check return code from ng_callout 363878ed226SJulian Elischer */ 364878ed226SJulian Elischer 3650986ab12SMaksim Yevmenkin int 366878ed226SJulian Elischer ng_hci_command_timeout(ng_hci_unit_p unit) 367878ed226SJulian Elischer { 3680986ab12SMaksim Yevmenkin if (unit->state & NG_HCI_UNIT_COMMAND_PENDING) 3690986ab12SMaksim Yevmenkin panic( 3700986ab12SMaksim Yevmenkin "%s: %s - Duplicated command timeout!\n", __func__, NG_NODE_NAME(unit->node)); 3710986ab12SMaksim Yevmenkin 372878ed226SJulian Elischer unit->state |= NG_HCI_UNIT_COMMAND_PENDING; 373f9d9e1b4SGleb Smirnoff ng_callout(&unit->cmd_timo, unit->node, NULL, 3740986ab12SMaksim Yevmenkin bluetooth_hci_command_timeout(), 3750986ab12SMaksim Yevmenkin ng_hci_process_command_timeout, NULL, 0); 3760986ab12SMaksim Yevmenkin 3770986ab12SMaksim Yevmenkin return (0); 378878ed226SJulian Elischer } /* ng_hci_command_timeout */ 379878ed226SJulian Elischer 380878ed226SJulian Elischer /* 381878ed226SJulian Elischer * Unset HCI command timeout 382878ed226SJulian Elischer */ 383878ed226SJulian Elischer 3840986ab12SMaksim Yevmenkin int 385878ed226SJulian Elischer ng_hci_command_untimeout(ng_hci_unit_p unit) 386878ed226SJulian Elischer { 3870986ab12SMaksim Yevmenkin if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING)) 3880986ab12SMaksim Yevmenkin panic( 3890986ab12SMaksim Yevmenkin "%s: %s - No command timeout!\n", __func__, NG_NODE_NAME(unit->node)); 3900986ab12SMaksim Yevmenkin 391f9d9e1b4SGleb Smirnoff if (ng_uncallout(&unit->cmd_timo, unit->node) == 0) 3920986ab12SMaksim Yevmenkin return (ETIMEDOUT); 3930986ab12SMaksim Yevmenkin 394878ed226SJulian Elischer unit->state &= ~NG_HCI_UNIT_COMMAND_PENDING; 3950986ab12SMaksim Yevmenkin 3960986ab12SMaksim Yevmenkin return (0); 397878ed226SJulian Elischer } /* ng_hci_command_untimeout */ 398878ed226SJulian Elischer 399878ed226SJulian Elischer /* 400878ed226SJulian Elischer * Set HCI connection timeout 401f9d9e1b4SGleb Smirnoff * XXX FIXME: check return code from ng_callout 402878ed226SJulian Elischer */ 403878ed226SJulian Elischer 4040986ab12SMaksim Yevmenkin int 405878ed226SJulian Elischer ng_hci_con_timeout(ng_hci_unit_con_p con) 406878ed226SJulian Elischer { 4070986ab12SMaksim Yevmenkin if (con->flags & NG_HCI_CON_TIMEOUT_PENDING) 4080986ab12SMaksim Yevmenkin panic( 4090986ab12SMaksim Yevmenkin "%s: %s - Duplicated connection timeout!\n", 4100986ab12SMaksim Yevmenkin __func__, NG_NODE_NAME(con->unit->node)); 4110986ab12SMaksim Yevmenkin 412878ed226SJulian Elischer con->flags |= NG_HCI_CON_TIMEOUT_PENDING; 413f9d9e1b4SGleb Smirnoff ng_callout(&con->con_timo, con->unit->node, NULL, 4140986ab12SMaksim Yevmenkin bluetooth_hci_connect_timeout(), 4150986ab12SMaksim Yevmenkin ng_hci_process_con_timeout, NULL, 4160986ab12SMaksim Yevmenkin con->con_handle); 4170986ab12SMaksim Yevmenkin 4180986ab12SMaksim Yevmenkin return (0); 419878ed226SJulian Elischer } /* ng_hci_con_timeout */ 420878ed226SJulian Elischer 421878ed226SJulian Elischer /* 422878ed226SJulian Elischer * Unset HCI connection timeout 423878ed226SJulian Elischer */ 424878ed226SJulian Elischer 4250986ab12SMaksim Yevmenkin int 426878ed226SJulian Elischer ng_hci_con_untimeout(ng_hci_unit_con_p con) 427878ed226SJulian Elischer { 4280986ab12SMaksim Yevmenkin if (!(con->flags & NG_HCI_CON_TIMEOUT_PENDING)) 4290986ab12SMaksim Yevmenkin panic( 4300986ab12SMaksim Yevmenkin "%s: %s - No connection timeout!\n", __func__, NG_NODE_NAME(con->unit->node)); 4310986ab12SMaksim Yevmenkin 432f9d9e1b4SGleb Smirnoff if (ng_uncallout(&con->con_timo, con->unit->node) == 0) 4330986ab12SMaksim Yevmenkin return (ETIMEDOUT); 4340986ab12SMaksim Yevmenkin 435878ed226SJulian Elischer con->flags &= ~NG_HCI_CON_TIMEOUT_PENDING; 4360986ab12SMaksim Yevmenkin 4370986ab12SMaksim Yevmenkin return (0); 438878ed226SJulian Elischer } /* ng_hci_con_untimeout */ 439878ed226SJulian Elischer 440878ed226SJulian Elischer #if 0 441878ed226SJulian Elischer /* 442878ed226SJulian Elischer * Convert numeric error code/reason to a string 443878ed226SJulian Elischer */ 444878ed226SJulian Elischer 445878ed226SJulian Elischer char const * const 446878ed226SJulian Elischer ng_hci_str_error(u_int16_t code) 447878ed226SJulian Elischer { 448878ed226SJulian Elischer #define LAST_ERROR_CODE ((sizeof(s)/sizeof(s[0]))-1) 449878ed226SJulian Elischer static char const * const s[] = { 450878ed226SJulian Elischer /* 0x00 */ "No error", 451878ed226SJulian Elischer /* 0x01 */ "Unknown HCI command", 452878ed226SJulian Elischer /* 0x02 */ "No connection", 453878ed226SJulian Elischer /* 0x03 */ "Hardware failure", 454878ed226SJulian Elischer /* 0x04 */ "Page timeout", 455878ed226SJulian Elischer /* 0x05 */ "Authentication failure", 456878ed226SJulian Elischer /* 0x06 */ "Key missing", 457878ed226SJulian Elischer /* 0x07 */ "Memory full", 458878ed226SJulian Elischer /* 0x08 */ "Connection timeout", 459878ed226SJulian Elischer /* 0x09 */ "Max number of connections", 460878ed226SJulian Elischer /* 0x0a */ "Max number of SCO connections to a unit", 461878ed226SJulian Elischer /* 0x0b */ "ACL connection already exists", 462878ed226SJulian Elischer /* 0x0c */ "Command disallowed", 463878ed226SJulian Elischer /* 0x0d */ "Host rejected due to limited resources", 464878ed226SJulian Elischer /* 0x0e */ "Host rejected due to securiity reasons", 465878ed226SJulian Elischer /* 0x0f */ "Host rejected due to remote unit is a personal unit", 466878ed226SJulian Elischer /* 0x10 */ "Host timeout", 467878ed226SJulian Elischer /* 0x11 */ "Unsupported feature or parameter value", 468878ed226SJulian Elischer /* 0x12 */ "Invalid HCI command parameter", 469878ed226SJulian Elischer /* 0x13 */ "Other end terminated connection: User ended connection", 470878ed226SJulian Elischer /* 0x14 */ "Other end terminated connection: Low resources", 471878ed226SJulian Elischer /* 0x15 */ "Other end terminated connection: About to power off", 472878ed226SJulian Elischer /* 0x16 */ "Connection terminated by local host", 473878ed226SJulian Elischer /* 0x17 */ "Repeated attempts", 474878ed226SJulian Elischer /* 0x18 */ "Pairing not allowed", 475878ed226SJulian Elischer /* 0x19 */ "Unknown LMP PDU", 476878ed226SJulian Elischer /* 0x1a */ "Unsupported remote feature", 477878ed226SJulian Elischer /* 0x1b */ "SCO offset rejected", 478878ed226SJulian Elischer /* 0x1c */ "SCO interval rejected", 479878ed226SJulian Elischer /* 0x1d */ "SCO air mode rejected", 480878ed226SJulian Elischer /* 0x1e */ "Invalid LMP parameters", 481878ed226SJulian Elischer /* 0x1f */ "Unspecified error", 482878ed226SJulian Elischer /* 0x20 */ "Unsupported LMP parameter value", 483878ed226SJulian Elischer /* 0x21 */ "Role change not allowed", 484878ed226SJulian Elischer /* 0x22 */ "LMP response timeout", 485878ed226SJulian Elischer /* 0x23 */ "LMP error transaction collision", 486878ed226SJulian Elischer /* 0x24 */ "LMP PSU not allowed", 487878ed226SJulian Elischer /* 0x25 */ "Encryption mode not acceptable", 488878ed226SJulian Elischer /* 0x26 */ "Unit key used", 489878ed226SJulian Elischer /* 0x27 */ "QoS is not supported", 490878ed226SJulian Elischer /* 0x28 */ "Instant passed", 491878ed226SJulian Elischer /* 0x29 */ "Paring with unit key not supported", 492878ed226SJulian Elischer /* SHOULD ALWAYS BE LAST */ "Unknown error" 493878ed226SJulian Elischer }; 494878ed226SJulian Elischer 495878ed226SJulian Elischer return ((code >= LAST_ERROR_CODE)? s[LAST_ERROR_CODE] : s[code]); 496878ed226SJulian Elischer } /* ng_hci_str_error */ 497878ed226SJulian Elischer #endif 498878ed226SJulian Elischer 499