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$ 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 } 349301558Stakawata 350301558Stakawata ch->idtype = idtype; 351107120Sjulian if (ch->scid != NG_L2CAP_NULL_CID) { 352107120Sjulian /* Initialize channel */ 353107120Sjulian ch->psm = psm; 354107120Sjulian ch->con = con; 355107120Sjulian ch->state = NG_L2CAP_CLOSED; 356107120Sjulian 357107120Sjulian /* Set MTU and flow control settings to defaults */ 358107120Sjulian ch->imtu = NG_L2CAP_MTU_DEFAULT; 359107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->iflow, sizeof(ch->iflow)); 360107120Sjulian 361107120Sjulian ch->omtu = NG_L2CAP_MTU_DEFAULT; 362107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->oflow, sizeof(ch->oflow)); 363107120Sjulian 364107120Sjulian ch->flush_timo = NG_L2CAP_FLUSH_TIMO_DEFAULT; 365107120Sjulian ch->link_timo = NG_L2CAP_LINK_TIMO_DEFAULT; 366107120Sjulian 367107120Sjulian LIST_INSERT_HEAD(&l2cap->chan_list, ch, next); 368114878Sjulian 369114878Sjulian ng_l2cap_con_ref(con); 370107120Sjulian } else { 371107120Sjulian bzero(ch, sizeof(*ch)); 372184205Sdes free(ch, M_NETGRAPH_L2CAP); 373107120Sjulian ch = NULL; 374107120Sjulian } 375107120Sjulian 376107120Sjulian return (ch); 377107120Sjulian} /* ng_l2cap_new_chan */ 378107120Sjulian 379107120Sjulian 380107120Sjulianng_l2cap_chan_p 381281198Stakawatang_l2cap_chan_by_scid(ng_l2cap_p l2cap, u_int16_t scid, int idtype) 382107120Sjulian{ 383107120Sjulian ng_l2cap_chan_p ch = NULL; 384107120Sjulian 385290038Stakawata if((idtype == NG_L2CAP_L2CA_IDTYPE_ATT)|| 386290038Stakawata (idtype == NG_L2CAP_L2CA_IDTYPE_SMP)){ 387281198Stakawata return NULL; 388281198Stakawata } 389281198Stakawata 390281198Stakawata LIST_FOREACH(ch, &l2cap->chan_list, next){ 391281198Stakawata if((idtype != NG_L2CAP_L2CA_IDTYPE_BREDR)&& 392281198Stakawata (ch->con->linktype == NG_HCI_LINK_ACL )) 393281198Stakawata continue; 394281198Stakawata if((idtype != NG_L2CAP_L2CA_IDTYPE_LE)&& 395281198Stakawata (ch->con->linktype != NG_HCI_LINK_ACL )) 396281198Stakawata continue; 397107120Sjulian if (ch->scid == scid) 398107120Sjulian break; 399281198Stakawata } 400281198Stakawata return (ch); 401281198Stakawata} /* ng_l2cap_chan_by_scid */ 402107120Sjulian 403281198Stakawatang_l2cap_chan_p 404281198Stakawatang_l2cap_chan_by_conhandle(ng_l2cap_p l2cap, uint16_t scid, 405281198Stakawata u_int16_t con_handle) 406281198Stakawata{ 407281198Stakawata ng_l2cap_chan_p ch = NULL; 408281198Stakawata 409281198Stakawata 410281198Stakawata LIST_FOREACH(ch, &l2cap->chan_list, next){ 411281198Stakawata if ((ch->scid == scid) && 412281198Stakawata (ch->con->con_handle == con_handle)) 413281198Stakawata break; 414281198Stakawata } 415107120Sjulian return (ch); 416107120Sjulian} /* ng_l2cap_chan_by_scid */ 417107120Sjulian 418107120Sjulian/* 419107120Sjulian * Free channel descriptor. 420107120Sjulian */ 421107120Sjulian 422107120Sjulianvoid 423107120Sjulianng_l2cap_free_chan(ng_l2cap_chan_p ch) 424107120Sjulian{ 425107120Sjulian ng_l2cap_cmd_p f = NULL, n = NULL; 426107120Sjulian 427107120Sjulian f = TAILQ_FIRST(&ch->con->cmd_list); 428281198Stakawata 429107120Sjulian while (f != NULL) { 430107120Sjulian n = TAILQ_NEXT(f, next); 431107120Sjulian 432107120Sjulian if (f->ch == ch) { 433107120Sjulian ng_l2cap_unlink_cmd(f); 434121054Semax if (f->flags & NG_L2CAP_CMD_PENDING) 435121054Semax ng_l2cap_command_untimeout(f); 436107120Sjulian ng_l2cap_free_cmd(f); 437107120Sjulian } 438107120Sjulian 439107120Sjulian f = n; 440107120Sjulian } 441107120Sjulian 442107120Sjulian LIST_REMOVE(ch, next); 443114878Sjulian 444114878Sjulian ng_l2cap_con_unref(ch->con); 445114878Sjulian 446107120Sjulian bzero(ch, sizeof(*ch)); 447184205Sdes free(ch, M_NETGRAPH_L2CAP); 448107120Sjulian} /* ng_l2cap_free_chan */ 449107120Sjulian 450107120Sjulian/* 451107120Sjulian * Create new L2CAP command descriptor. WILL NOT add command to the queue. 452107120Sjulian */ 453107120Sjulian 454107120Sjulianng_l2cap_cmd_p 455107120Sjulianng_l2cap_new_cmd(ng_l2cap_con_p con, ng_l2cap_chan_p ch, u_int8_t ident, 456107120Sjulian u_int8_t code, u_int32_t token) 457107120Sjulian{ 458107120Sjulian ng_l2cap_cmd_p cmd = NULL; 459107120Sjulian 460107120Sjulian KASSERT((ch == NULL || ch->con == con), 461107120Sjulian("%s: %s - invalid channel pointer!\n", 462107120Sjulian __func__, NG_NODE_NAME(con->l2cap->node))); 463107120Sjulian 464184205Sdes cmd = malloc(sizeof(*cmd), M_NETGRAPH_L2CAP, 465107120Sjulian M_NOWAIT|M_ZERO); 466107120Sjulian if (cmd == NULL) 467107120Sjulian return (NULL); 468107120Sjulian 469107120Sjulian cmd->con = con; 470107120Sjulian cmd->ch = ch; 471107120Sjulian cmd->ident = ident; 472107120Sjulian cmd->code = code; 473107120Sjulian cmd->token = token; 474137163Semax ng_callout_init(&cmd->timo); 475107120Sjulian 476107120Sjulian return (cmd); 477107120Sjulian} /* ng_l2cap_new_cmd */ 478107120Sjulian 479107120Sjulian/* 480121054Semax * Get pending (i.e. initiated by local side) L2CAP command descriptor by ident 481107120Sjulian */ 482107120Sjulian 483107120Sjulianng_l2cap_cmd_p 484107120Sjulianng_l2cap_cmd_by_ident(ng_l2cap_con_p con, u_int8_t ident) 485107120Sjulian{ 486107120Sjulian ng_l2cap_cmd_p cmd = NULL; 487107120Sjulian 488121054Semax TAILQ_FOREACH(cmd, &con->cmd_list, next) { 489121054Semax if ((cmd->flags & NG_L2CAP_CMD_PENDING) && cmd->ident == ident) { 490121054Semax KASSERT((cmd->con == con), 491121054Semax("%s: %s - invalid connection pointer!\n", 492121054Semax __func__, NG_NODE_NAME(con->l2cap->node))); 493121054Semax 494107120Sjulian break; 495121054Semax } 496121054Semax } 497107120Sjulian 498107120Sjulian return (cmd); 499107120Sjulian} /* ng_l2cap_cmd_by_ident */ 500107120Sjulian 501107120Sjulian/* 502107120Sjulian * Set LP timeout 503138268Sglebius * XXX FIXME: check return code from ng_callout 504107120Sjulian */ 505107120Sjulian 506121054Semaxint 507107120Sjulianng_l2cap_lp_timeout(ng_l2cap_con_p con) 508107120Sjulian{ 509114878Sjulian if (con->flags & (NG_L2CAP_CON_LP_TIMO|NG_L2CAP_CON_AUTO_DISCON_TIMO)) 510121054Semax panic( 511121054Semax"%s: %s - invalid timeout, state=%d, flags=%#x\n", 512114878Sjulian __func__, NG_NODE_NAME(con->l2cap->node), 513114878Sjulian con->state, con->flags); 514114878Sjulian 515114878Sjulian con->flags |= NG_L2CAP_CON_LP_TIMO; 516138268Sglebius ng_callout(&con->con_timo, con->l2cap->node, NULL, 517121054Semax bluetooth_hci_connect_timeout(), 518121054Semax ng_l2cap_process_lp_timeout, NULL, 519121054Semax con->con_handle); 520121054Semax 521121054Semax return (0); 522107120Sjulian} /* ng_l2cap_lp_timeout */ 523107120Sjulian 524107120Sjulian/* 525107120Sjulian * Unset LP timeout 526107120Sjulian */ 527107120Sjulian 528121054Semaxint 529107120Sjulianng_l2cap_lp_untimeout(ng_l2cap_con_p con) 530107120Sjulian{ 531121054Semax if (!(con->flags & NG_L2CAP_CON_LP_TIMO)) 532121054Semax panic( 533121054Semax"%s: %s - no LP connection timeout, state=%d, flags=%#x\n", 534121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 535121054Semax con->state, con->flags); 536121054Semax 537138268Sglebius if (ng_uncallout(&con->con_timo, con->l2cap->node) == 0) 538121054Semax return (ETIMEDOUT); 539121054Semax 540114878Sjulian con->flags &= ~NG_L2CAP_CON_LP_TIMO; 541121054Semax 542121054Semax return (0); 543107120Sjulian} /* ng_l2cap_lp_untimeout */ 544107120Sjulian 545107120Sjulian/* 546121054Semax * Set L2CAP command timeout 547138268Sglebius * XXX FIXME: check return code from ng_callout 548107120Sjulian */ 549107120Sjulian 550121054Semaxint 551121054Semaxng_l2cap_command_timeout(ng_l2cap_cmd_p cmd, int timo) 552107120Sjulian{ 553121054Semax int arg; 554107120Sjulian 555121054Semax if (cmd->flags & NG_L2CAP_CMD_PENDING) 556121054Semax panic( 557121054Semax"%s: %s - duplicated command timeout, code=%#x, flags=%#x\n", 558121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 559121054Semax cmd->code, cmd->flags); 560107120Sjulian 561121054Semax arg = ((cmd->ident << 16) | cmd->con->con_handle); 562121054Semax cmd->flags |= NG_L2CAP_CMD_PENDING; 563138268Sglebius ng_callout(&cmd->timo, cmd->con->l2cap->node, NULL, timo, 564121054Semax ng_l2cap_process_command_timeout, NULL, arg); 565107120Sjulian 566121054Semax return (0); 567107120Sjulian} /* ng_l2cap_command_timeout */ 568107120Sjulian 569107120Sjulian/* 570107120Sjulian * Unset L2CAP command timeout 571107120Sjulian */ 572107120Sjulian 573121054Semaxint 574107120Sjulianng_l2cap_command_untimeout(ng_l2cap_cmd_p cmd) 575107120Sjulian{ 576121054Semax if (!(cmd->flags & NG_L2CAP_CMD_PENDING)) 577121054Semax panic( 578121054Semax"%s: %s - no command timeout, code=%#x, flags=%#x\n", 579121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 580121054Semax cmd->code, cmd->flags); 581107120Sjulian 582138268Sglebius if (ng_uncallout(&cmd->timo, cmd->con->l2cap->node) == 0) 583121054Semax return (ETIMEDOUT); 584107120Sjulian 585121054Semax cmd->flags &= ~NG_L2CAP_CMD_PENDING; 586107120Sjulian 587121054Semax return (0); 588121054Semax} /* ng_l2cap_command_untimeout */ 589107120Sjulian 590107120Sjulian/* 591107120Sjulian * Prepend "m"buf with "size" bytes 592107120Sjulian */ 593107120Sjulian 594107120Sjulianstruct mbuf * 595107120Sjulianng_l2cap_prepend(struct mbuf *m, int size) 596107120Sjulian{ 597243882Sglebius M_PREPEND(m, size, M_NOWAIT); 598107120Sjulian if (m == NULL || (m->m_len < size && (m = m_pullup(m, size)) == NULL)) 599107120Sjulian return (NULL); 600107120Sjulian 601107120Sjulian return (m); 602107120Sjulian} /* ng_l2cap_prepend */ 603107120Sjulian 604107120Sjulian/* 605107120Sjulian * Default flow settings 606107120Sjulian */ 607107120Sjulian 608107120Sjulianng_l2cap_flow_p 609107120Sjulianng_l2cap_default_flow(void) 610107120Sjulian{ 611107120Sjulian static ng_l2cap_flow_t default_flow = { 612107120Sjulian /* flags */ 0x0, 613107120Sjulian /* service_type */ NG_HCI_SERVICE_TYPE_BEST_EFFORT, 614107120Sjulian /* token_rate */ 0xffffffff, /* maximum */ 615107120Sjulian /* token_bucket_size */ 0xffffffff, /* maximum */ 616107120Sjulian /* peak_bandwidth */ 0x00000000, /* maximum */ 617107120Sjulian /* latency */ 0xffffffff, /* don't care */ 618107120Sjulian /* delay_variation */ 0xffffffff /* don't care */ 619107120Sjulian }; 620107120Sjulian 621107120Sjulian return (&default_flow); 622107120Sjulian} /* ng_l2cap_default_flow */ 623107120Sjulian 624107120Sjulian/* 625107120Sjulian * Get next available channel ID 626107120Sjulian * XXX FIXME this is *UGLY* but will do for now 627107120Sjulian */ 628107120Sjulian 629107120Sjulianstatic u_int16_t 630281198Stakawatang_l2cap_get_cid(ng_l2cap_p l2cap,int isle) 631107120Sjulian{ 632281198Stakawata u_int16_t cid ; 633281198Stakawata u_int16_t endcid; 634281198Stakawata uint16_t mask; 635281198Stakawata int idtype; 636281198Stakawata if(isle){ 637281198Stakawata endcid = l2cap->lecid; 638281198Stakawata /*Assume Last CID is 2^n-1 */ 639281198Stakawata mask = NG_L2CAP_LELAST_CID; 640281198Stakawata idtype = NG_L2CAP_L2CA_IDTYPE_LE; 641281198Stakawata }else{ 642281198Stakawata endcid = l2cap->cid; 643281198Stakawata /*Assume Last CID is 2^n-1 */ 644281198Stakawata mask = NG_L2CAP_LAST_CID; 645281198Stakawata idtype = NG_L2CAP_L2CA_IDTYPE_BREDR; 646281198Stakawata } 647281198Stakawata cid = (endcid+1) & mask; 648281198Stakawata 649107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 650107120Sjulian cid = NG_L2CAP_FIRST_CID; 651107120Sjulian 652281198Stakawata while (cid != endcid) { 653281198Stakawata if (ng_l2cap_chan_by_scid(l2cap, cid, idtype) == NULL) { 654281198Stakawata if(!isle){ 655281198Stakawata l2cap->cid = cid; 656281198Stakawata }else{ 657281198Stakawata l2cap->lecid = cid; 658281198Stakawata } 659107120Sjulian return (cid); 660107120Sjulian } 661107120Sjulian 662107120Sjulian cid ++; 663281198Stakawata cid &= mask; 664107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 665107120Sjulian cid = NG_L2CAP_FIRST_CID; 666107120Sjulian } 667107120Sjulian 668107120Sjulian return (NG_L2CAP_NULL_CID); 669107120Sjulian} /* ng_l2cap_get_cid */ 670107120Sjulian 671107120Sjulian/* 672107120Sjulian * Get next available command ident 673107120Sjulian * XXX FIXME this is *UGLY* but will do for now 674107120Sjulian */ 675107120Sjulian 676107120Sjulianu_int8_t 677107120Sjulianng_l2cap_get_ident(ng_l2cap_con_p con) 678107120Sjulian{ 679107120Sjulian u_int8_t ident = con->ident + 1; 680107120Sjulian 681107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 682107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 683107120Sjulian 684107120Sjulian while (ident != con->ident) { 685107120Sjulian if (ng_l2cap_cmd_by_ident(con, ident) == NULL) { 686107120Sjulian con->ident = ident; 687107120Sjulian 688107120Sjulian return (ident); 689107120Sjulian } 690107120Sjulian 691107120Sjulian ident ++; 692107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 693107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 694107120Sjulian } 695107120Sjulian 696107120Sjulian return (NG_L2CAP_NULL_IDENT); 697107120Sjulian} /* ng_l2cap_get_ident */ 698107120Sjulian 699