ng_l2cap_misc.c revision 298813
1107120Sjulian/* 2107120Sjulian * ng_l2cap_misc.c 3139823Simp */ 4139823Simp 5139823Simp/*- 6107120Sjulian * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com> 7107120Sjulian * All rights reserved. 8107120Sjulian * 9107120Sjulian * Redistribution and use in source and binary forms, with or without 10107120Sjulian * modification, are permitted provided that the following conditions 11107120Sjulian * are met: 12107120Sjulian * 1. Redistributions of source code must retain the above copyright 13107120Sjulian * notice, this list of conditions and the following disclaimer. 14107120Sjulian * 2. Redistributions in binary form must reproduce the above copyright 15107120Sjulian * notice, this list of conditions and the following disclaimer in the 16107120Sjulian * documentation and/or other materials provided with the distribution. 17107120Sjulian * 18107120Sjulian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19107120Sjulian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20107120Sjulian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21107120Sjulian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 22107120Sjulian * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23107120Sjulian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24107120Sjulian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25107120Sjulian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26107120Sjulian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27107120Sjulian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28107120Sjulian * SUCH DAMAGE. 29107120Sjulian * 30121054Semax * $Id: ng_l2cap_misc.c,v 1.5 2003/09/08 19:11:45 max Exp $ 31107120Sjulian * $FreeBSD: head/sys/netgraph/bluetooth/l2cap/ng_l2cap_misc.c 298813 2016-04-29 21:25:05Z pfg $ 32107120Sjulian */ 33107120Sjulian 34107120Sjulian#include <sys/param.h> 35107120Sjulian#include <sys/systm.h> 36107120Sjulian#include <sys/kernel.h> 37107120Sjulian#include <sys/malloc.h> 38107120Sjulian#include <sys/mbuf.h> 39107120Sjulian#include <sys/queue.h> 40107120Sjulian#include <netgraph/ng_message.h> 41107120Sjulian#include <netgraph/netgraph.h> 42128688Semax#include <netgraph/bluetooth/include/ng_bluetooth.h> 43128688Semax#include <netgraph/bluetooth/include/ng_hci.h> 44128688Semax#include <netgraph/bluetooth/include/ng_l2cap.h> 45128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_var.h> 46128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_cmds.h> 47128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_evnt.h> 48128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_llpi.h> 49128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_ulpi.h> 50128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_misc.h> 51107120Sjulian 52281198Stakawatastatic u_int16_t ng_l2cap_get_cid (ng_l2cap_p, int); 53107120Sjulian 54107120Sjulian/****************************************************************************** 55107120Sjulian ****************************************************************************** 56107120Sjulian ** Utility routines 57107120Sjulian ****************************************************************************** 58107120Sjulian ******************************************************************************/ 59107120Sjulian 60107120Sjulian/* 61107120Sjulian * Send hook information to the upper layer 62107120Sjulian */ 63107120Sjulian 64107120Sjulianvoid 65107120Sjulianng_l2cap_send_hook_info(node_p node, hook_p hook, void *arg1, int arg2) 66107120Sjulian{ 67107120Sjulian ng_l2cap_p l2cap = NULL; 68107120Sjulian struct ng_mesg *msg = NULL; 69107120Sjulian int error = 0; 70281198Stakawata ng_l2cap_node_hook_info_ep *ep ; 71107120Sjulian 72107120Sjulian if (node == NULL || NG_NODE_NOT_VALID(node) || 73107120Sjulian hook == NULL || NG_HOOK_NOT_VALID(hook)) 74107120Sjulian return; 75107120Sjulian 76107120Sjulian l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 77107120Sjulian if (l2cap->hci == NULL || NG_HOOK_NOT_VALID(l2cap->hci) || 78107120Sjulian bcmp(&l2cap->bdaddr, NG_HCI_BDADDR_ANY, sizeof(l2cap->bdaddr)) == 0) 79107120Sjulian return; 80107120Sjulian 81107120Sjulian NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_NODE_HOOK_INFO, 82281198Stakawata sizeof(*ep), M_NOWAIT); 83281198Stakawata 84107120Sjulian if (msg != NULL) { 85281198Stakawata ep = (ng_l2cap_node_hook_info_ep *) &msg->data; 86281198Stakawata bcopy(&l2cap->bdaddr, &ep->addr, sizeof(bdaddr_t)); 87128076Semax NG_SEND_MSG_HOOK(error, node, msg, hook, 0); 88107120Sjulian } else 89107120Sjulian error = ENOMEM; 90107120Sjulian 91107120Sjulian if (error != 0) 92107120Sjulian NG_L2CAP_INFO( 93107120Sjulian"%s: %s - failed to send HOOK_INFO message to hook \"%s\", error=%d\n", 94107120Sjulian __func__, NG_NODE_NAME(l2cap->node), NG_HOOK_NAME(hook), 95107120Sjulian error); 96107120Sjulian} /* ng_l2cap_send_hook_info */ 97107120Sjulian 98107120Sjulian/* 99114878Sjulian * Create new connection descriptor for the "remote" unit. 100114878Sjulian * Will link connection descriptor to the l2cap node. 101107120Sjulian */ 102107120Sjulian 103107120Sjulianng_l2cap_con_p 104281198Stakawatang_l2cap_new_con(ng_l2cap_p l2cap, bdaddr_p bdaddr, int type) 105107120Sjulian{ 106121054Semax static int fake_con_handle = 0x0f00; 107107120Sjulian ng_l2cap_con_p con = NULL; 108107120Sjulian 109107120Sjulian /* Create new connection descriptor */ 110184205Sdes con = malloc(sizeof(*con), M_NETGRAPH_L2CAP, 111107120Sjulian M_NOWAIT|M_ZERO); 112107120Sjulian if (con == NULL) 113107120Sjulian return (NULL); 114107120Sjulian 115107120Sjulian con->l2cap = l2cap; 116107120Sjulian con->state = NG_L2CAP_CON_CLOSED; 117290038Stakawata con->encryption = 0; 118121054Semax /* 119121054Semax * XXX 120121054Semax * 121121054Semax * Assign fake connection handle to the connection descriptor. 122121054Semax * Bluetooth specification marks 0x0f00 - 0x0fff connection 123121054Semax * handles as reserved. We need this fake connection handles 124121054Semax * for timeouts. Connection handle will be passed as argument 125121054Semax * to timeout so when timeout happens we can find the right 126121054Semax * connection descriptor. We can not pass pointers, because 127121054Semax * timeouts are external (to Netgraph) events and there might 128121054Semax * be a race when node/hook goes down and timeout event already 129121054Semax * went into node's queue 130121054Semax */ 131121054Semax 132121054Semax con->con_handle = fake_con_handle ++; 133121054Semax if (fake_con_handle > 0x0fff) 134121054Semax fake_con_handle = 0x0f00; 135121054Semax 136107120Sjulian bcopy(bdaddr, &con->remote, sizeof(con->remote)); 137281198Stakawata con->linktype = type; 138137163Semax ng_callout_init(&con->con_timo); 139107120Sjulian 140107120Sjulian con->ident = NG_L2CAP_FIRST_IDENT - 1; 141107120Sjulian TAILQ_INIT(&con->cmd_list); 142107120Sjulian 143107120Sjulian /* Link connection */ 144107120Sjulian LIST_INSERT_HEAD(&l2cap->con_list, con, next); 145107120Sjulian 146107120Sjulian return (con); 147107120Sjulian} /* ng_l2cap_new_con */ 148107120Sjulian 149107120Sjulian/* 150114878Sjulian * Add reference to the connection descriptor 151114878Sjulian */ 152114878Sjulian 153114878Sjulianvoid 154114878Sjulianng_l2cap_con_ref(ng_l2cap_con_p con) 155114878Sjulian{ 156114878Sjulian con->refcnt ++; 157114878Sjulian 158114878Sjulian if (con->flags & NG_L2CAP_CON_AUTO_DISCON_TIMO) { 159114878Sjulian if ((con->state != NG_L2CAP_CON_OPEN) || 160114878Sjulian (con->flags & NG_L2CAP_CON_OUTGOING) == 0) 161121054Semax panic( 162121054Semax"%s: %s - bad auto disconnect timeout, state=%d, flags=%#x\n", 163121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 164121054Semax con->state, con->flags); 165114878Sjulian 166114878Sjulian ng_l2cap_discon_untimeout(con); 167114878Sjulian } 168114878Sjulian} /* ng_l2cap_con_ref */ 169114878Sjulian 170114878Sjulian/* 171114878Sjulian * Remove reference from the connection descriptor 172114878Sjulian */ 173114878Sjulian 174114878Sjulianvoid 175114878Sjulianng_l2cap_con_unref(ng_l2cap_con_p con) 176114878Sjulian{ 177114878Sjulian con->refcnt --; 178114878Sjulian 179114878Sjulian if (con->refcnt < 0) 180121054Semax panic( 181121054Semax"%s: %s - con->refcnt < 0\n", __func__, NG_NODE_NAME(con->l2cap->node)); 182114878Sjulian 183114878Sjulian /* 184114878Sjulian * Set auto disconnect timer only if the following conditions are met: 185114878Sjulian * 1) we have no reference on the connection 186114878Sjulian * 2) connection is in OPEN state 187114878Sjulian * 3) it is an outgoing connection 188114878Sjulian * 4) disconnect timeout > 0 189149679Semax * 5) connection is not dying 190114878Sjulian */ 191114878Sjulian 192114878Sjulian if ((con->refcnt == 0) && 193114878Sjulian (con->state == NG_L2CAP_CON_OPEN) && 194114878Sjulian (con->flags & NG_L2CAP_CON_OUTGOING) && 195149679Semax (con->l2cap->discon_timo > 0) && 196149679Semax ((con->flags & NG_L2CAP_CON_DYING) == 0)) 197114878Sjulian ng_l2cap_discon_timeout(con); 198114878Sjulian} /* ng_l2cap_con_unref */ 199114878Sjulian 200114878Sjulian/* 201114878Sjulian * Set auto disconnect timeout 202138268Sglebius * XXX FIXME: check return code from ng_callout 203114878Sjulian */ 204114878Sjulian 205121054Semaxint 206114878Sjulianng_l2cap_discon_timeout(ng_l2cap_con_p con) 207114878Sjulian{ 208114878Sjulian if (con->flags & (NG_L2CAP_CON_LP_TIMO|NG_L2CAP_CON_AUTO_DISCON_TIMO)) 209121054Semax panic( 210121054Semax"%s: %s - invalid timeout, state=%d, flags=%#x\n", 211114878Sjulian __func__, NG_NODE_NAME(con->l2cap->node), 212114878Sjulian con->state, con->flags); 213114878Sjulian 214114878Sjulian con->flags |= NG_L2CAP_CON_AUTO_DISCON_TIMO; 215138268Sglebius ng_callout(&con->con_timo, con->l2cap->node, NULL, 216121054Semax con->l2cap->discon_timo * hz, 217121054Semax ng_l2cap_process_discon_timeout, NULL, 218121054Semax con->con_handle); 219121054Semax 220121054Semax return (0); 221114878Sjulian} /* ng_l2cap_discon_timeout */ 222114878Sjulian 223114878Sjulian/* 224114878Sjulian * Unset auto disconnect timeout 225114878Sjulian */ 226114878Sjulian 227121054Semaxint 228114878Sjulianng_l2cap_discon_untimeout(ng_l2cap_con_p con) 229114878Sjulian{ 230121054Semax if (!(con->flags & NG_L2CAP_CON_AUTO_DISCON_TIMO)) 231121054Semax panic( 232121054Semax"%s: %s - no disconnect timeout, state=%d, flags=%#x\n", 233121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 234121054Semax con->state, con->flags); 235121054Semax 236138268Sglebius if (ng_uncallout(&con->con_timo, con->l2cap->node) == 0) 237121054Semax return (ETIMEDOUT); 238121054Semax 239114878Sjulian con->flags &= ~NG_L2CAP_CON_AUTO_DISCON_TIMO; 240121054Semax 241121054Semax return (0); 242114878Sjulian} /* ng_l2cap_discon_untimeout */ 243114878Sjulian 244114878Sjulian/* 245107120Sjulian * Free connection descriptor. Will unlink connection and free everything. 246107120Sjulian */ 247107120Sjulian 248107120Sjulianvoid 249107120Sjulianng_l2cap_free_con(ng_l2cap_con_p con) 250107120Sjulian{ 251107120Sjulian ng_l2cap_chan_p f = NULL, n = NULL; 252107120Sjulian 253114878Sjulian con->state = NG_L2CAP_CON_CLOSED; 254114878Sjulian 255121054Semax while (con->tx_pkt != NULL) { 256121054Semax struct mbuf *m = con->tx_pkt->m_nextpkt; 257107120Sjulian 258121054Semax m_freem(con->tx_pkt); 259121054Semax con->tx_pkt = m; 260107120Sjulian } 261107120Sjulian 262107120Sjulian NG_FREE_M(con->rx_pkt); 263107120Sjulian 264107120Sjulian for (f = LIST_FIRST(&con->l2cap->chan_list); f != NULL; ) { 265107120Sjulian n = LIST_NEXT(f, next); 266107120Sjulian 267107120Sjulian if (f->con == con) 268107120Sjulian ng_l2cap_free_chan(f); 269107120Sjulian 270107120Sjulian f = n; 271107120Sjulian } 272107120Sjulian 273107120Sjulian while (!TAILQ_EMPTY(&con->cmd_list)) { 274107120Sjulian ng_l2cap_cmd_p cmd = TAILQ_FIRST(&con->cmd_list); 275107120Sjulian 276107120Sjulian ng_l2cap_unlink_cmd(cmd); 277121054Semax if (cmd->flags & NG_L2CAP_CMD_PENDING) 278121054Semax ng_l2cap_command_untimeout(cmd); 279107120Sjulian ng_l2cap_free_cmd(cmd); 280107120Sjulian } 281107120Sjulian 282149679Semax if (con->flags & (NG_L2CAP_CON_AUTO_DISCON_TIMO|NG_L2CAP_CON_LP_TIMO)) 283149679Semax panic( 284149679Semax"%s: %s - timeout pending! state=%d, flags=%#x\n", 285149679Semax __func__, NG_NODE_NAME(con->l2cap->node), 286149679Semax con->state, con->flags); 287149679Semax 288107120Sjulian LIST_REMOVE(con, next); 289149679Semax 290107120Sjulian bzero(con, sizeof(*con)); 291184205Sdes free(con, M_NETGRAPH_L2CAP); 292107120Sjulian} /* ng_l2cap_free_con */ 293107120Sjulian 294107120Sjulian/* 295107120Sjulian * Get connection by "remote" address 296107120Sjulian */ 297107120Sjulian 298107120Sjulianng_l2cap_con_p 299281198Stakawatang_l2cap_con_by_addr(ng_l2cap_p l2cap, bdaddr_p bdaddr, unsigned int type) 300107120Sjulian{ 301107120Sjulian ng_l2cap_con_p con = NULL; 302107120Sjulian 303107120Sjulian LIST_FOREACH(con, &l2cap->con_list, next) 304281198Stakawata if ((bcmp(bdaddr, &con->remote, sizeof(con->remote)) == 0)&& 305281198Stakawata (con->linktype == type)) 306107120Sjulian break; 307107120Sjulian 308107120Sjulian return (con); 309107120Sjulian} /* ng_l2cap_con_by_addr */ 310107120Sjulian 311107120Sjulian/* 312107120Sjulian * Get connection by "handle" 313107120Sjulian */ 314107120Sjulian 315107120Sjulianng_l2cap_con_p 316107120Sjulianng_l2cap_con_by_handle(ng_l2cap_p l2cap, u_int16_t con_handle) 317107120Sjulian{ 318107120Sjulian ng_l2cap_con_p con = NULL; 319107120Sjulian 320107120Sjulian LIST_FOREACH(con, &l2cap->con_list, next) 321107120Sjulian if (con->con_handle == con_handle) 322107120Sjulian break; 323107120Sjulian 324107120Sjulian return (con); 325107120Sjulian} /* ng_l2cap_con_by_handle */ 326107120Sjulian 327107120Sjulian/* 328298813Spfg * Allocate new L2CAP channel descriptor on "con" connection with "psm". 329107120Sjulian * Will link the channel to the l2cap node 330107120Sjulian */ 331107120Sjulian 332107120Sjulianng_l2cap_chan_p 333281198Stakawatang_l2cap_new_chan(ng_l2cap_p l2cap, ng_l2cap_con_p con, u_int16_t psm, int idtype) 334107120Sjulian{ 335107120Sjulian ng_l2cap_chan_p ch = NULL; 336107120Sjulian 337184205Sdes ch = malloc(sizeof(*ch), M_NETGRAPH_L2CAP, 338107120Sjulian M_NOWAIT|M_ZERO); 339107120Sjulian if (ch == NULL) 340107120Sjulian return (NULL); 341281198Stakawata if(idtype == NG_L2CAP_L2CA_IDTYPE_ATT){ 342281198Stakawata ch->scid = ch->dcid = NG_L2CAP_ATT_CID; 343290038Stakawata }else if(idtype == NG_L2CAP_L2CA_IDTYPE_SMP){ 344290038Stakawata ch->scid = ch->dcid = NG_L2CAP_SMP_CID; 345281198Stakawata }else{ 346281198Stakawata ch->scid = ng_l2cap_get_cid(l2cap, 347281198Stakawata (con->linktype!= NG_HCI_LINK_ACL)); 348281198Stakawata } 349107120Sjulian 350107120Sjulian if (ch->scid != NG_L2CAP_NULL_CID) { 351107120Sjulian /* Initialize channel */ 352107120Sjulian ch->psm = psm; 353107120Sjulian ch->con = con; 354107120Sjulian ch->state = NG_L2CAP_CLOSED; 355107120Sjulian 356107120Sjulian /* Set MTU and flow control settings to defaults */ 357107120Sjulian ch->imtu = NG_L2CAP_MTU_DEFAULT; 358107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->iflow, sizeof(ch->iflow)); 359107120Sjulian 360107120Sjulian ch->omtu = NG_L2CAP_MTU_DEFAULT; 361107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->oflow, sizeof(ch->oflow)); 362107120Sjulian 363107120Sjulian ch->flush_timo = NG_L2CAP_FLUSH_TIMO_DEFAULT; 364107120Sjulian ch->link_timo = NG_L2CAP_LINK_TIMO_DEFAULT; 365107120Sjulian 366107120Sjulian LIST_INSERT_HEAD(&l2cap->chan_list, ch, next); 367114878Sjulian 368114878Sjulian ng_l2cap_con_ref(con); 369107120Sjulian } else { 370107120Sjulian bzero(ch, sizeof(*ch)); 371184205Sdes free(ch, M_NETGRAPH_L2CAP); 372107120Sjulian ch = NULL; 373107120Sjulian } 374107120Sjulian 375107120Sjulian return (ch); 376107120Sjulian} /* ng_l2cap_new_chan */ 377107120Sjulian 378107120Sjulian 379107120Sjulianng_l2cap_chan_p 380281198Stakawatang_l2cap_chan_by_scid(ng_l2cap_p l2cap, u_int16_t scid, int idtype) 381107120Sjulian{ 382107120Sjulian ng_l2cap_chan_p ch = NULL; 383107120Sjulian 384290038Stakawata if((idtype == NG_L2CAP_L2CA_IDTYPE_ATT)|| 385290038Stakawata (idtype == NG_L2CAP_L2CA_IDTYPE_SMP)){ 386281198Stakawata return NULL; 387281198Stakawata } 388281198Stakawata 389281198Stakawata LIST_FOREACH(ch, &l2cap->chan_list, next){ 390281198Stakawata if((idtype != NG_L2CAP_L2CA_IDTYPE_BREDR)&& 391281198Stakawata (ch->con->linktype == NG_HCI_LINK_ACL )) 392281198Stakawata continue; 393281198Stakawata if((idtype != NG_L2CAP_L2CA_IDTYPE_LE)&& 394281198Stakawata (ch->con->linktype != NG_HCI_LINK_ACL )) 395281198Stakawata continue; 396107120Sjulian if (ch->scid == scid) 397107120Sjulian break; 398281198Stakawata } 399281198Stakawata return (ch); 400281198Stakawata} /* ng_l2cap_chan_by_scid */ 401107120Sjulian 402281198Stakawatang_l2cap_chan_p 403281198Stakawatang_l2cap_chan_by_conhandle(ng_l2cap_p l2cap, uint16_t scid, 404281198Stakawata u_int16_t con_handle) 405281198Stakawata{ 406281198Stakawata ng_l2cap_chan_p ch = NULL; 407281198Stakawata 408281198Stakawata 409281198Stakawata LIST_FOREACH(ch, &l2cap->chan_list, next){ 410281198Stakawata if ((ch->scid == scid) && 411281198Stakawata (ch->con->con_handle == con_handle)) 412281198Stakawata break; 413281198Stakawata } 414107120Sjulian return (ch); 415107120Sjulian} /* ng_l2cap_chan_by_scid */ 416107120Sjulian 417107120Sjulian/* 418107120Sjulian * Free channel descriptor. 419107120Sjulian */ 420107120Sjulian 421107120Sjulianvoid 422107120Sjulianng_l2cap_free_chan(ng_l2cap_chan_p ch) 423107120Sjulian{ 424107120Sjulian ng_l2cap_cmd_p f = NULL, n = NULL; 425107120Sjulian 426107120Sjulian f = TAILQ_FIRST(&ch->con->cmd_list); 427281198Stakawata 428107120Sjulian while (f != NULL) { 429107120Sjulian n = TAILQ_NEXT(f, next); 430107120Sjulian 431107120Sjulian if (f->ch == ch) { 432107120Sjulian ng_l2cap_unlink_cmd(f); 433121054Semax if (f->flags & NG_L2CAP_CMD_PENDING) 434121054Semax ng_l2cap_command_untimeout(f); 435107120Sjulian ng_l2cap_free_cmd(f); 436107120Sjulian } 437107120Sjulian 438107120Sjulian f = n; 439107120Sjulian } 440107120Sjulian 441107120Sjulian LIST_REMOVE(ch, next); 442114878Sjulian 443114878Sjulian ng_l2cap_con_unref(ch->con); 444114878Sjulian 445107120Sjulian bzero(ch, sizeof(*ch)); 446184205Sdes free(ch, M_NETGRAPH_L2CAP); 447107120Sjulian} /* ng_l2cap_free_chan */ 448107120Sjulian 449107120Sjulian/* 450107120Sjulian * Create new L2CAP command descriptor. WILL NOT add command to the queue. 451107120Sjulian */ 452107120Sjulian 453107120Sjulianng_l2cap_cmd_p 454107120Sjulianng_l2cap_new_cmd(ng_l2cap_con_p con, ng_l2cap_chan_p ch, u_int8_t ident, 455107120Sjulian u_int8_t code, u_int32_t token) 456107120Sjulian{ 457107120Sjulian ng_l2cap_cmd_p cmd = NULL; 458107120Sjulian 459107120Sjulian KASSERT((ch == NULL || ch->con == con), 460107120Sjulian("%s: %s - invalid channel pointer!\n", 461107120Sjulian __func__, NG_NODE_NAME(con->l2cap->node))); 462107120Sjulian 463184205Sdes cmd = malloc(sizeof(*cmd), M_NETGRAPH_L2CAP, 464107120Sjulian M_NOWAIT|M_ZERO); 465107120Sjulian if (cmd == NULL) 466107120Sjulian return (NULL); 467107120Sjulian 468107120Sjulian cmd->con = con; 469107120Sjulian cmd->ch = ch; 470107120Sjulian cmd->ident = ident; 471107120Sjulian cmd->code = code; 472107120Sjulian cmd->token = token; 473137163Semax ng_callout_init(&cmd->timo); 474107120Sjulian 475107120Sjulian return (cmd); 476107120Sjulian} /* ng_l2cap_new_cmd */ 477107120Sjulian 478107120Sjulian/* 479121054Semax * Get pending (i.e. initiated by local side) L2CAP command descriptor by ident 480107120Sjulian */ 481107120Sjulian 482107120Sjulianng_l2cap_cmd_p 483107120Sjulianng_l2cap_cmd_by_ident(ng_l2cap_con_p con, u_int8_t ident) 484107120Sjulian{ 485107120Sjulian ng_l2cap_cmd_p cmd = NULL; 486107120Sjulian 487121054Semax TAILQ_FOREACH(cmd, &con->cmd_list, next) { 488121054Semax if ((cmd->flags & NG_L2CAP_CMD_PENDING) && cmd->ident == ident) { 489121054Semax KASSERT((cmd->con == con), 490121054Semax("%s: %s - invalid connection pointer!\n", 491121054Semax __func__, NG_NODE_NAME(con->l2cap->node))); 492121054Semax 493107120Sjulian break; 494121054Semax } 495121054Semax } 496107120Sjulian 497107120Sjulian return (cmd); 498107120Sjulian} /* ng_l2cap_cmd_by_ident */ 499107120Sjulian 500107120Sjulian/* 501107120Sjulian * Set LP timeout 502138268Sglebius * XXX FIXME: check return code from ng_callout 503107120Sjulian */ 504107120Sjulian 505121054Semaxint 506107120Sjulianng_l2cap_lp_timeout(ng_l2cap_con_p con) 507107120Sjulian{ 508114878Sjulian if (con->flags & (NG_L2CAP_CON_LP_TIMO|NG_L2CAP_CON_AUTO_DISCON_TIMO)) 509121054Semax panic( 510121054Semax"%s: %s - invalid timeout, state=%d, flags=%#x\n", 511114878Sjulian __func__, NG_NODE_NAME(con->l2cap->node), 512114878Sjulian con->state, con->flags); 513114878Sjulian 514114878Sjulian con->flags |= NG_L2CAP_CON_LP_TIMO; 515138268Sglebius ng_callout(&con->con_timo, con->l2cap->node, NULL, 516121054Semax bluetooth_hci_connect_timeout(), 517121054Semax ng_l2cap_process_lp_timeout, NULL, 518121054Semax con->con_handle); 519121054Semax 520121054Semax return (0); 521107120Sjulian} /* ng_l2cap_lp_timeout */ 522107120Sjulian 523107120Sjulian/* 524107120Sjulian * Unset LP timeout 525107120Sjulian */ 526107120Sjulian 527121054Semaxint 528107120Sjulianng_l2cap_lp_untimeout(ng_l2cap_con_p con) 529107120Sjulian{ 530121054Semax if (!(con->flags & NG_L2CAP_CON_LP_TIMO)) 531121054Semax panic( 532121054Semax"%s: %s - no LP connection timeout, state=%d, flags=%#x\n", 533121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 534121054Semax con->state, con->flags); 535121054Semax 536138268Sglebius if (ng_uncallout(&con->con_timo, con->l2cap->node) == 0) 537121054Semax return (ETIMEDOUT); 538121054Semax 539114878Sjulian con->flags &= ~NG_L2CAP_CON_LP_TIMO; 540121054Semax 541121054Semax return (0); 542107120Sjulian} /* ng_l2cap_lp_untimeout */ 543107120Sjulian 544107120Sjulian/* 545121054Semax * Set L2CAP command timeout 546138268Sglebius * XXX FIXME: check return code from ng_callout 547107120Sjulian */ 548107120Sjulian 549121054Semaxint 550121054Semaxng_l2cap_command_timeout(ng_l2cap_cmd_p cmd, int timo) 551107120Sjulian{ 552121054Semax int arg; 553107120Sjulian 554121054Semax if (cmd->flags & NG_L2CAP_CMD_PENDING) 555121054Semax panic( 556121054Semax"%s: %s - duplicated command timeout, code=%#x, flags=%#x\n", 557121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 558121054Semax cmd->code, cmd->flags); 559107120Sjulian 560121054Semax arg = ((cmd->ident << 16) | cmd->con->con_handle); 561121054Semax cmd->flags |= NG_L2CAP_CMD_PENDING; 562138268Sglebius ng_callout(&cmd->timo, cmd->con->l2cap->node, NULL, timo, 563121054Semax ng_l2cap_process_command_timeout, NULL, arg); 564107120Sjulian 565121054Semax return (0); 566107120Sjulian} /* ng_l2cap_command_timeout */ 567107120Sjulian 568107120Sjulian/* 569107120Sjulian * Unset L2CAP command timeout 570107120Sjulian */ 571107120Sjulian 572121054Semaxint 573107120Sjulianng_l2cap_command_untimeout(ng_l2cap_cmd_p cmd) 574107120Sjulian{ 575121054Semax if (!(cmd->flags & NG_L2CAP_CMD_PENDING)) 576121054Semax panic( 577121054Semax"%s: %s - no command timeout, code=%#x, flags=%#x\n", 578121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 579121054Semax cmd->code, cmd->flags); 580107120Sjulian 581138268Sglebius if (ng_uncallout(&cmd->timo, cmd->con->l2cap->node) == 0) 582121054Semax return (ETIMEDOUT); 583107120Sjulian 584121054Semax cmd->flags &= ~NG_L2CAP_CMD_PENDING; 585107120Sjulian 586121054Semax return (0); 587121054Semax} /* ng_l2cap_command_untimeout */ 588107120Sjulian 589107120Sjulian/* 590107120Sjulian * Prepend "m"buf with "size" bytes 591107120Sjulian */ 592107120Sjulian 593107120Sjulianstruct mbuf * 594107120Sjulianng_l2cap_prepend(struct mbuf *m, int size) 595107120Sjulian{ 596243882Sglebius M_PREPEND(m, size, M_NOWAIT); 597107120Sjulian if (m == NULL || (m->m_len < size && (m = m_pullup(m, size)) == NULL)) 598107120Sjulian return (NULL); 599107120Sjulian 600107120Sjulian return (m); 601107120Sjulian} /* ng_l2cap_prepend */ 602107120Sjulian 603107120Sjulian/* 604107120Sjulian * Default flow settings 605107120Sjulian */ 606107120Sjulian 607107120Sjulianng_l2cap_flow_p 608107120Sjulianng_l2cap_default_flow(void) 609107120Sjulian{ 610107120Sjulian static ng_l2cap_flow_t default_flow = { 611107120Sjulian /* flags */ 0x0, 612107120Sjulian /* service_type */ NG_HCI_SERVICE_TYPE_BEST_EFFORT, 613107120Sjulian /* token_rate */ 0xffffffff, /* maximum */ 614107120Sjulian /* token_bucket_size */ 0xffffffff, /* maximum */ 615107120Sjulian /* peak_bandwidth */ 0x00000000, /* maximum */ 616107120Sjulian /* latency */ 0xffffffff, /* don't care */ 617107120Sjulian /* delay_variation */ 0xffffffff /* don't care */ 618107120Sjulian }; 619107120Sjulian 620107120Sjulian return (&default_flow); 621107120Sjulian} /* ng_l2cap_default_flow */ 622107120Sjulian 623107120Sjulian/* 624107120Sjulian * Get next available channel ID 625107120Sjulian * XXX FIXME this is *UGLY* but will do for now 626107120Sjulian */ 627107120Sjulian 628107120Sjulianstatic u_int16_t 629281198Stakawatang_l2cap_get_cid(ng_l2cap_p l2cap,int isle) 630107120Sjulian{ 631281198Stakawata u_int16_t cid ; 632281198Stakawata u_int16_t endcid; 633281198Stakawata uint16_t mask; 634281198Stakawata int idtype; 635281198Stakawata if(isle){ 636281198Stakawata endcid = l2cap->lecid; 637281198Stakawata /*Assume Last CID is 2^n-1 */ 638281198Stakawata mask = NG_L2CAP_LELAST_CID; 639281198Stakawata idtype = NG_L2CAP_L2CA_IDTYPE_LE; 640281198Stakawata }else{ 641281198Stakawata endcid = l2cap->cid; 642281198Stakawata /*Assume Last CID is 2^n-1 */ 643281198Stakawata mask = NG_L2CAP_LAST_CID; 644281198Stakawata idtype = NG_L2CAP_L2CA_IDTYPE_BREDR; 645281198Stakawata } 646281198Stakawata cid = (endcid+1) & mask; 647281198Stakawata 648107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 649107120Sjulian cid = NG_L2CAP_FIRST_CID; 650107120Sjulian 651281198Stakawata while (cid != endcid) { 652281198Stakawata if (ng_l2cap_chan_by_scid(l2cap, cid, idtype) == NULL) { 653281198Stakawata if(!isle){ 654281198Stakawata l2cap->cid = cid; 655281198Stakawata }else{ 656281198Stakawata l2cap->lecid = cid; 657281198Stakawata } 658107120Sjulian return (cid); 659107120Sjulian } 660107120Sjulian 661107120Sjulian cid ++; 662281198Stakawata cid &= mask; 663107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 664107120Sjulian cid = NG_L2CAP_FIRST_CID; 665107120Sjulian } 666107120Sjulian 667107120Sjulian return (NG_L2CAP_NULL_CID); 668107120Sjulian} /* ng_l2cap_get_cid */ 669107120Sjulian 670107120Sjulian/* 671107120Sjulian * Get next available command ident 672107120Sjulian * XXX FIXME this is *UGLY* but will do for now 673107120Sjulian */ 674107120Sjulian 675107120Sjulianu_int8_t 676107120Sjulianng_l2cap_get_ident(ng_l2cap_con_p con) 677107120Sjulian{ 678107120Sjulian u_int8_t ident = con->ident + 1; 679107120Sjulian 680107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 681107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 682107120Sjulian 683107120Sjulian while (ident != con->ident) { 684107120Sjulian if (ng_l2cap_cmd_by_ident(con, ident) == NULL) { 685107120Sjulian con->ident = ident; 686107120Sjulian 687107120Sjulian return (ident); 688107120Sjulian } 689107120Sjulian 690107120Sjulian ident ++; 691107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 692107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 693107120Sjulian } 694107120Sjulian 695107120Sjulian return (NG_L2CAP_NULL_IDENT); 696107120Sjulian} /* ng_l2cap_get_ident */ 697107120Sjulian 698