ng_l2cap_misc.c revision 137163
1107120Sjulian/* 2107120Sjulian * ng_l2cap_misc.c 3107120Sjulian * 4107120Sjulian * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com> 5107120Sjulian * All rights reserved. 6107120Sjulian * 7107120Sjulian * Redistribution and use in source and binary forms, with or without 8107120Sjulian * modification, are permitted provided that the following conditions 9107120Sjulian * are met: 10107120Sjulian * 1. Redistributions of source code must retain the above copyright 11107120Sjulian * notice, this list of conditions and the following disclaimer. 12107120Sjulian * 2. Redistributions in binary form must reproduce the above copyright 13107120Sjulian * notice, this list of conditions and the following disclaimer in the 14107120Sjulian * documentation and/or other materials provided with the distribution. 15107120Sjulian * 16107120Sjulian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17107120Sjulian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18107120Sjulian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19107120Sjulian * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 20107120Sjulian * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21107120Sjulian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22107120Sjulian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23107120Sjulian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24107120Sjulian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25107120Sjulian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26107120Sjulian * SUCH DAMAGE. 27107120Sjulian * 28121054Semax * $Id: ng_l2cap_misc.c,v 1.5 2003/09/08 19:11:45 max Exp $ 29107120Sjulian * $FreeBSD: head/sys/netgraph/bluetooth/l2cap/ng_l2cap_misc.c 137163 2004-11-03 18:00:49Z emax $ 30107120Sjulian */ 31107120Sjulian 32107120Sjulian#include <sys/param.h> 33107120Sjulian#include <sys/systm.h> 34107120Sjulian#include <sys/kernel.h> 35107120Sjulian#include <sys/malloc.h> 36107120Sjulian#include <sys/mbuf.h> 37107120Sjulian#include <sys/queue.h> 38107120Sjulian#include <netgraph/ng_message.h> 39107120Sjulian#include <netgraph/netgraph.h> 40128688Semax#include <netgraph/bluetooth/include/ng_bluetooth.h> 41128688Semax#include <netgraph/bluetooth/include/ng_hci.h> 42128688Semax#include <netgraph/bluetooth/include/ng_l2cap.h> 43128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_var.h> 44128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_cmds.h> 45128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_evnt.h> 46128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_llpi.h> 47128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_ulpi.h> 48128688Semax#include <netgraph/bluetooth/l2cap/ng_l2cap_misc.h> 49107120Sjulian 50121054Semaxstatic u_int16_t ng_l2cap_get_cid (ng_l2cap_p); 51107120Sjulian 52107120Sjulian/****************************************************************************** 53107120Sjulian ****************************************************************************** 54107120Sjulian ** Utility routines 55107120Sjulian ****************************************************************************** 56107120Sjulian ******************************************************************************/ 57107120Sjulian 58107120Sjulian/* 59107120Sjulian * Send hook information to the upper layer 60107120Sjulian */ 61107120Sjulian 62107120Sjulianvoid 63107120Sjulianng_l2cap_send_hook_info(node_p node, hook_p hook, void *arg1, int arg2) 64107120Sjulian{ 65107120Sjulian ng_l2cap_p l2cap = NULL; 66107120Sjulian struct ng_mesg *msg = NULL; 67107120Sjulian int error = 0; 68107120Sjulian 69107120Sjulian if (node == NULL || NG_NODE_NOT_VALID(node) || 70107120Sjulian hook == NULL || NG_HOOK_NOT_VALID(hook)) 71107120Sjulian return; 72107120Sjulian 73107120Sjulian l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 74107120Sjulian if (l2cap->hci == NULL || NG_HOOK_NOT_VALID(l2cap->hci) || 75107120Sjulian bcmp(&l2cap->bdaddr, NG_HCI_BDADDR_ANY, sizeof(l2cap->bdaddr)) == 0) 76107120Sjulian return; 77107120Sjulian 78107120Sjulian NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_NODE_HOOK_INFO, 79107120Sjulian sizeof(bdaddr_t), M_NOWAIT); 80107120Sjulian if (msg != NULL) { 81107120Sjulian bcopy(&l2cap->bdaddr, msg->data, sizeof(bdaddr_t)); 82128076Semax NG_SEND_MSG_HOOK(error, node, msg, hook, 0); 83107120Sjulian } else 84107120Sjulian error = ENOMEM; 85107120Sjulian 86107120Sjulian if (error != 0) 87107120Sjulian NG_L2CAP_INFO( 88107120Sjulian"%s: %s - failed to send HOOK_INFO message to hook \"%s\", error=%d\n", 89107120Sjulian __func__, NG_NODE_NAME(l2cap->node), NG_HOOK_NAME(hook), 90107120Sjulian error); 91107120Sjulian} /* ng_l2cap_send_hook_info */ 92107120Sjulian 93107120Sjulian/* 94114878Sjulian * Create new connection descriptor for the "remote" unit. 95114878Sjulian * Will link connection descriptor to the l2cap node. 96107120Sjulian */ 97107120Sjulian 98107120Sjulianng_l2cap_con_p 99107120Sjulianng_l2cap_new_con(ng_l2cap_p l2cap, bdaddr_p bdaddr) 100107120Sjulian{ 101121054Semax static int fake_con_handle = 0x0f00; 102107120Sjulian ng_l2cap_con_p con = NULL; 103107120Sjulian 104107120Sjulian /* Create new connection descriptor */ 105107120Sjulian MALLOC(con, ng_l2cap_con_p, sizeof(*con), M_NETGRAPH_L2CAP, 106107120Sjulian M_NOWAIT|M_ZERO); 107107120Sjulian if (con == NULL) 108107120Sjulian return (NULL); 109107120Sjulian 110107120Sjulian con->l2cap = l2cap; 111107120Sjulian con->state = NG_L2CAP_CON_CLOSED; 112107120Sjulian 113121054Semax /* 114121054Semax * XXX 115121054Semax * 116121054Semax * Assign fake connection handle to the connection descriptor. 117121054Semax * Bluetooth specification marks 0x0f00 - 0x0fff connection 118121054Semax * handles as reserved. We need this fake connection handles 119121054Semax * for timeouts. Connection handle will be passed as argument 120121054Semax * to timeout so when timeout happens we can find the right 121121054Semax * connection descriptor. We can not pass pointers, because 122121054Semax * timeouts are external (to Netgraph) events and there might 123121054Semax * be a race when node/hook goes down and timeout event already 124121054Semax * went into node's queue 125121054Semax */ 126121054Semax 127121054Semax con->con_handle = fake_con_handle ++; 128121054Semax if (fake_con_handle > 0x0fff) 129121054Semax fake_con_handle = 0x0f00; 130121054Semax 131107120Sjulian bcopy(bdaddr, &con->remote, sizeof(con->remote)); 132137163Semax ng_callout_init(&con->con_timo); 133107120Sjulian 134107120Sjulian con->ident = NG_L2CAP_FIRST_IDENT - 1; 135107120Sjulian TAILQ_INIT(&con->cmd_list); 136107120Sjulian 137107120Sjulian /* Link connection */ 138107120Sjulian LIST_INSERT_HEAD(&l2cap->con_list, con, next); 139107120Sjulian 140107120Sjulian return (con); 141107120Sjulian} /* ng_l2cap_new_con */ 142107120Sjulian 143107120Sjulian/* 144114878Sjulian * Add reference to the connection descriptor 145114878Sjulian */ 146114878Sjulian 147114878Sjulianvoid 148114878Sjulianng_l2cap_con_ref(ng_l2cap_con_p con) 149114878Sjulian{ 150114878Sjulian con->refcnt ++; 151114878Sjulian 152114878Sjulian if (con->flags & NG_L2CAP_CON_AUTO_DISCON_TIMO) { 153114878Sjulian if ((con->state != NG_L2CAP_CON_OPEN) || 154114878Sjulian (con->flags & NG_L2CAP_CON_OUTGOING) == 0) 155121054Semax panic( 156121054Semax"%s: %s - bad auto disconnect timeout, state=%d, flags=%#x\n", 157121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 158121054Semax con->state, con->flags); 159114878Sjulian 160114878Sjulian ng_l2cap_discon_untimeout(con); 161114878Sjulian } 162114878Sjulian} /* ng_l2cap_con_ref */ 163114878Sjulian 164114878Sjulian/* 165114878Sjulian * Remove reference from the connection descriptor 166114878Sjulian */ 167114878Sjulian 168114878Sjulianvoid 169114878Sjulianng_l2cap_con_unref(ng_l2cap_con_p con) 170114878Sjulian{ 171114878Sjulian con->refcnt --; 172114878Sjulian 173114878Sjulian if (con->refcnt < 0) 174121054Semax panic( 175121054Semax"%s: %s - con->refcnt < 0\n", __func__, NG_NODE_NAME(con->l2cap->node)); 176114878Sjulian 177114878Sjulian /* 178114878Sjulian * Set auto disconnect timer only if the following conditions are met: 179114878Sjulian * 1) we have no reference on the connection 180114878Sjulian * 2) connection is in OPEN state 181114878Sjulian * 3) it is an outgoing connection 182114878Sjulian * 4) disconnect timeout > 0 183114878Sjulian */ 184114878Sjulian 185114878Sjulian if ((con->refcnt == 0) && 186114878Sjulian (con->state == NG_L2CAP_CON_OPEN) && 187114878Sjulian (con->flags & NG_L2CAP_CON_OUTGOING) && 188121054Semax (con->l2cap->discon_timo > 0)) 189114878Sjulian ng_l2cap_discon_timeout(con); 190114878Sjulian} /* ng_l2cap_con_unref */ 191114878Sjulian 192114878Sjulian/* 193114878Sjulian * Set auto disconnect timeout 194137163Semax * XXX FIXME: check return code from ng_timeout 195114878Sjulian */ 196114878Sjulian 197121054Semaxint 198114878Sjulianng_l2cap_discon_timeout(ng_l2cap_con_p con) 199114878Sjulian{ 200114878Sjulian if (con->flags & (NG_L2CAP_CON_LP_TIMO|NG_L2CAP_CON_AUTO_DISCON_TIMO)) 201121054Semax panic( 202121054Semax"%s: %s - invalid timeout, state=%d, flags=%#x\n", 203114878Sjulian __func__, NG_NODE_NAME(con->l2cap->node), 204114878Sjulian con->state, con->flags); 205114878Sjulian 206114878Sjulian con->flags |= NG_L2CAP_CON_AUTO_DISCON_TIMO; 207137163Semax ng_timeout(&con->con_timo, con->l2cap->node, NULL, 208121054Semax con->l2cap->discon_timo * hz, 209121054Semax ng_l2cap_process_discon_timeout, NULL, 210121054Semax con->con_handle); 211121054Semax 212121054Semax return (0); 213114878Sjulian} /* ng_l2cap_discon_timeout */ 214114878Sjulian 215114878Sjulian/* 216114878Sjulian * Unset auto disconnect timeout 217114878Sjulian */ 218114878Sjulian 219121054Semaxint 220114878Sjulianng_l2cap_discon_untimeout(ng_l2cap_con_p con) 221114878Sjulian{ 222121054Semax if (!(con->flags & NG_L2CAP_CON_AUTO_DISCON_TIMO)) 223121054Semax panic( 224121054Semax"%s: %s - no disconnect timeout, state=%d, flags=%#x\n", 225121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 226121054Semax con->state, con->flags); 227121054Semax 228137163Semax if (ng_untimeout(&con->con_timo, con->l2cap->node) == 0) 229121054Semax return (ETIMEDOUT); 230121054Semax 231114878Sjulian con->flags &= ~NG_L2CAP_CON_AUTO_DISCON_TIMO; 232121054Semax 233121054Semax return (0); 234114878Sjulian} /* ng_l2cap_discon_untimeout */ 235114878Sjulian 236114878Sjulian/* 237107120Sjulian * Free connection descriptor. Will unlink connection and free everything. 238107120Sjulian */ 239107120Sjulian 240107120Sjulianvoid 241107120Sjulianng_l2cap_free_con(ng_l2cap_con_p con) 242107120Sjulian{ 243107120Sjulian ng_l2cap_chan_p f = NULL, n = NULL; 244107120Sjulian 245114878Sjulian con->state = NG_L2CAP_CON_CLOSED; 246114878Sjulian 247121054Semax while (con->tx_pkt != NULL) { 248121054Semax struct mbuf *m = con->tx_pkt->m_nextpkt; 249107120Sjulian 250121054Semax m_freem(con->tx_pkt); 251121054Semax con->tx_pkt = m; 252107120Sjulian } 253107120Sjulian 254107120Sjulian NG_FREE_M(con->rx_pkt); 255107120Sjulian 256107120Sjulian for (f = LIST_FIRST(&con->l2cap->chan_list); f != NULL; ) { 257107120Sjulian n = LIST_NEXT(f, next); 258107120Sjulian 259107120Sjulian if (f->con == con) 260107120Sjulian ng_l2cap_free_chan(f); 261107120Sjulian 262107120Sjulian f = n; 263107120Sjulian } 264107120Sjulian 265107120Sjulian while (!TAILQ_EMPTY(&con->cmd_list)) { 266107120Sjulian ng_l2cap_cmd_p cmd = TAILQ_FIRST(&con->cmd_list); 267107120Sjulian 268107120Sjulian ng_l2cap_unlink_cmd(cmd); 269121054Semax if (cmd->flags & NG_L2CAP_CMD_PENDING) 270121054Semax ng_l2cap_command_untimeout(cmd); 271107120Sjulian ng_l2cap_free_cmd(cmd); 272107120Sjulian } 273107120Sjulian 274107120Sjulian LIST_REMOVE(con, next); 275107120Sjulian bzero(con, sizeof(*con)); 276107120Sjulian FREE(con, M_NETGRAPH_L2CAP); 277107120Sjulian} /* ng_l2cap_free_con */ 278107120Sjulian 279107120Sjulian/* 280107120Sjulian * Get connection by "remote" address 281107120Sjulian */ 282107120Sjulian 283107120Sjulianng_l2cap_con_p 284107120Sjulianng_l2cap_con_by_addr(ng_l2cap_p l2cap, bdaddr_p bdaddr) 285107120Sjulian{ 286107120Sjulian ng_l2cap_con_p con = NULL; 287107120Sjulian 288107120Sjulian LIST_FOREACH(con, &l2cap->con_list, next) 289107120Sjulian if (bcmp(bdaddr, &con->remote, sizeof(con->remote)) == 0) 290107120Sjulian break; 291107120Sjulian 292107120Sjulian return (con); 293107120Sjulian} /* ng_l2cap_con_by_addr */ 294107120Sjulian 295107120Sjulian/* 296107120Sjulian * Get connection by "handle" 297107120Sjulian */ 298107120Sjulian 299107120Sjulianng_l2cap_con_p 300107120Sjulianng_l2cap_con_by_handle(ng_l2cap_p l2cap, u_int16_t con_handle) 301107120Sjulian{ 302107120Sjulian ng_l2cap_con_p con = NULL; 303107120Sjulian 304107120Sjulian LIST_FOREACH(con, &l2cap->con_list, next) 305107120Sjulian if (con->con_handle == con_handle) 306107120Sjulian break; 307107120Sjulian 308107120Sjulian return (con); 309107120Sjulian} /* ng_l2cap_con_by_handle */ 310107120Sjulian 311107120Sjulian/* 312107120Sjulian * Allocate new L2CAP channel descriptor on "con" conection with "psm". 313107120Sjulian * Will link the channel to the l2cap node 314107120Sjulian */ 315107120Sjulian 316107120Sjulianng_l2cap_chan_p 317107120Sjulianng_l2cap_new_chan(ng_l2cap_p l2cap, ng_l2cap_con_p con, u_int16_t psm) 318107120Sjulian{ 319107120Sjulian ng_l2cap_chan_p ch = NULL; 320107120Sjulian 321107120Sjulian MALLOC(ch, ng_l2cap_chan_p, sizeof(*ch), M_NETGRAPH_L2CAP, 322107120Sjulian M_NOWAIT|M_ZERO); 323107120Sjulian if (ch == NULL) 324107120Sjulian return (NULL); 325107120Sjulian 326107120Sjulian ch->scid = ng_l2cap_get_cid(l2cap); 327107120Sjulian 328107120Sjulian if (ch->scid != NG_L2CAP_NULL_CID) { 329107120Sjulian /* Initialize channel */ 330107120Sjulian ch->psm = psm; 331107120Sjulian ch->con = con; 332107120Sjulian ch->state = NG_L2CAP_CLOSED; 333107120Sjulian 334107120Sjulian /* Set MTU and flow control settings to defaults */ 335107120Sjulian ch->imtu = NG_L2CAP_MTU_DEFAULT; 336107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->iflow, sizeof(ch->iflow)); 337107120Sjulian 338107120Sjulian ch->omtu = NG_L2CAP_MTU_DEFAULT; 339107120Sjulian bcopy(ng_l2cap_default_flow(), &ch->oflow, sizeof(ch->oflow)); 340107120Sjulian 341107120Sjulian ch->flush_timo = NG_L2CAP_FLUSH_TIMO_DEFAULT; 342107120Sjulian ch->link_timo = NG_L2CAP_LINK_TIMO_DEFAULT; 343107120Sjulian 344107120Sjulian LIST_INSERT_HEAD(&l2cap->chan_list, ch, next); 345114878Sjulian 346114878Sjulian ng_l2cap_con_ref(con); 347107120Sjulian } else { 348107120Sjulian bzero(ch, sizeof(*ch)); 349107120Sjulian FREE(ch, M_NETGRAPH_L2CAP); 350107120Sjulian ch = NULL; 351107120Sjulian } 352107120Sjulian 353107120Sjulian return (ch); 354107120Sjulian} /* ng_l2cap_new_chan */ 355107120Sjulian 356107120Sjulian/* 357107120Sjulian * Get channel by source (local) channel ID 358107120Sjulian */ 359107120Sjulian 360107120Sjulianng_l2cap_chan_p 361107120Sjulianng_l2cap_chan_by_scid(ng_l2cap_p l2cap, u_int16_t scid) 362107120Sjulian{ 363107120Sjulian ng_l2cap_chan_p ch = NULL; 364107120Sjulian 365107120Sjulian LIST_FOREACH(ch, &l2cap->chan_list, next) 366107120Sjulian if (ch->scid == scid) 367107120Sjulian break; 368107120Sjulian 369107120Sjulian return (ch); 370107120Sjulian} /* ng_l2cap_chan_by_scid */ 371107120Sjulian 372107120Sjulian/* 373107120Sjulian * Free channel descriptor. 374107120Sjulian */ 375107120Sjulian 376107120Sjulianvoid 377107120Sjulianng_l2cap_free_chan(ng_l2cap_chan_p ch) 378107120Sjulian{ 379107120Sjulian ng_l2cap_cmd_p f = NULL, n = NULL; 380107120Sjulian 381107120Sjulian f = TAILQ_FIRST(&ch->con->cmd_list); 382107120Sjulian while (f != NULL) { 383107120Sjulian n = TAILQ_NEXT(f, next); 384107120Sjulian 385107120Sjulian if (f->ch == ch) { 386107120Sjulian ng_l2cap_unlink_cmd(f); 387121054Semax if (f->flags & NG_L2CAP_CMD_PENDING) 388121054Semax ng_l2cap_command_untimeout(f); 389107120Sjulian ng_l2cap_free_cmd(f); 390107120Sjulian } 391107120Sjulian 392107120Sjulian f = n; 393107120Sjulian } 394107120Sjulian 395107120Sjulian LIST_REMOVE(ch, next); 396114878Sjulian 397114878Sjulian ng_l2cap_con_unref(ch->con); 398114878Sjulian 399107120Sjulian bzero(ch, sizeof(*ch)); 400107120Sjulian FREE(ch, M_NETGRAPH_L2CAP); 401107120Sjulian} /* ng_l2cap_free_chan */ 402107120Sjulian 403107120Sjulian/* 404107120Sjulian * Create new L2CAP command descriptor. WILL NOT add command to the queue. 405107120Sjulian */ 406107120Sjulian 407107120Sjulianng_l2cap_cmd_p 408107120Sjulianng_l2cap_new_cmd(ng_l2cap_con_p con, ng_l2cap_chan_p ch, u_int8_t ident, 409107120Sjulian u_int8_t code, u_int32_t token) 410107120Sjulian{ 411107120Sjulian ng_l2cap_cmd_p cmd = NULL; 412107120Sjulian 413107120Sjulian KASSERT((ch == NULL || ch->con == con), 414107120Sjulian("%s: %s - invalid channel pointer!\n", 415107120Sjulian __func__, NG_NODE_NAME(con->l2cap->node))); 416107120Sjulian 417107120Sjulian MALLOC(cmd, ng_l2cap_cmd_p, sizeof(*cmd), M_NETGRAPH_L2CAP, 418107120Sjulian M_NOWAIT|M_ZERO); 419107120Sjulian if (cmd == NULL) 420107120Sjulian return (NULL); 421107120Sjulian 422107120Sjulian cmd->con = con; 423107120Sjulian cmd->ch = ch; 424107120Sjulian cmd->ident = ident; 425107120Sjulian cmd->code = code; 426107120Sjulian cmd->token = token; 427137163Semax ng_callout_init(&cmd->timo); 428107120Sjulian 429107120Sjulian return (cmd); 430107120Sjulian} /* ng_l2cap_new_cmd */ 431107120Sjulian 432107120Sjulian/* 433121054Semax * Get pending (i.e. initiated by local side) L2CAP command descriptor by ident 434107120Sjulian */ 435107120Sjulian 436107120Sjulianng_l2cap_cmd_p 437107120Sjulianng_l2cap_cmd_by_ident(ng_l2cap_con_p con, u_int8_t ident) 438107120Sjulian{ 439107120Sjulian ng_l2cap_cmd_p cmd = NULL; 440107120Sjulian 441121054Semax TAILQ_FOREACH(cmd, &con->cmd_list, next) { 442121054Semax if ((cmd->flags & NG_L2CAP_CMD_PENDING) && cmd->ident == ident) { 443121054Semax KASSERT((cmd->con == con), 444121054Semax("%s: %s - invalid connection pointer!\n", 445121054Semax __func__, NG_NODE_NAME(con->l2cap->node))); 446121054Semax 447107120Sjulian break; 448121054Semax } 449121054Semax } 450107120Sjulian 451107120Sjulian return (cmd); 452107120Sjulian} /* ng_l2cap_cmd_by_ident */ 453107120Sjulian 454107120Sjulian/* 455107120Sjulian * Set LP timeout 456137163Semax * XXX FIXME: check return code from ng_timeout 457107120Sjulian */ 458107120Sjulian 459121054Semaxint 460107120Sjulianng_l2cap_lp_timeout(ng_l2cap_con_p con) 461107120Sjulian{ 462114878Sjulian if (con->flags & (NG_L2CAP_CON_LP_TIMO|NG_L2CAP_CON_AUTO_DISCON_TIMO)) 463121054Semax panic( 464121054Semax"%s: %s - invalid timeout, state=%d, flags=%#x\n", 465114878Sjulian __func__, NG_NODE_NAME(con->l2cap->node), 466114878Sjulian con->state, con->flags); 467114878Sjulian 468114878Sjulian con->flags |= NG_L2CAP_CON_LP_TIMO; 469137163Semax ng_timeout(&con->con_timo, con->l2cap->node, NULL, 470121054Semax bluetooth_hci_connect_timeout(), 471121054Semax ng_l2cap_process_lp_timeout, NULL, 472121054Semax con->con_handle); 473121054Semax 474121054Semax return (0); 475107120Sjulian} /* ng_l2cap_lp_timeout */ 476107120Sjulian 477107120Sjulian/* 478107120Sjulian * Unset LP timeout 479107120Sjulian */ 480107120Sjulian 481121054Semaxint 482107120Sjulianng_l2cap_lp_untimeout(ng_l2cap_con_p con) 483107120Sjulian{ 484121054Semax if (!(con->flags & NG_L2CAP_CON_LP_TIMO)) 485121054Semax panic( 486121054Semax"%s: %s - no LP connection timeout, state=%d, flags=%#x\n", 487121054Semax __func__, NG_NODE_NAME(con->l2cap->node), 488121054Semax con->state, con->flags); 489121054Semax 490137163Semax if (ng_untimeout(&con->con_timo, con->l2cap->node) == 0) 491121054Semax return (ETIMEDOUT); 492121054Semax 493114878Sjulian con->flags &= ~NG_L2CAP_CON_LP_TIMO; 494121054Semax 495121054Semax return (0); 496107120Sjulian} /* ng_l2cap_lp_untimeout */ 497107120Sjulian 498107120Sjulian/* 499121054Semax * Set L2CAP command timeout 500137163Semax * XXX FIXME: check return code from ng_timeout 501107120Sjulian */ 502107120Sjulian 503121054Semaxint 504121054Semaxng_l2cap_command_timeout(ng_l2cap_cmd_p cmd, int timo) 505107120Sjulian{ 506121054Semax int arg; 507107120Sjulian 508121054Semax if (cmd->flags & NG_L2CAP_CMD_PENDING) 509121054Semax panic( 510121054Semax"%s: %s - duplicated command timeout, code=%#x, flags=%#x\n", 511121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 512121054Semax cmd->code, cmd->flags); 513107120Sjulian 514121054Semax arg = ((cmd->ident << 16) | cmd->con->con_handle); 515121054Semax cmd->flags |= NG_L2CAP_CMD_PENDING; 516137163Semax ng_timeout(&cmd->timo, cmd->con->l2cap->node, NULL, timo, 517121054Semax ng_l2cap_process_command_timeout, NULL, arg); 518107120Sjulian 519121054Semax return (0); 520107120Sjulian} /* ng_l2cap_command_timeout */ 521107120Sjulian 522107120Sjulian/* 523107120Sjulian * Unset L2CAP command timeout 524107120Sjulian */ 525107120Sjulian 526121054Semaxint 527107120Sjulianng_l2cap_command_untimeout(ng_l2cap_cmd_p cmd) 528107120Sjulian{ 529121054Semax if (!(cmd->flags & NG_L2CAP_CMD_PENDING)) 530121054Semax panic( 531121054Semax"%s: %s - no command timeout, code=%#x, flags=%#x\n", 532121054Semax __func__, NG_NODE_NAME(cmd->con->l2cap->node), 533121054Semax cmd->code, cmd->flags); 534107120Sjulian 535137163Semax if (ng_untimeout(&cmd->timo, cmd->con->l2cap->node) == 0) 536121054Semax return (ETIMEDOUT); 537107120Sjulian 538121054Semax cmd->flags &= ~NG_L2CAP_CMD_PENDING; 539107120Sjulian 540121054Semax return (0); 541121054Semax} /* ng_l2cap_command_untimeout */ 542107120Sjulian 543107120Sjulian/* 544107120Sjulian * Prepend "m"buf with "size" bytes 545107120Sjulian */ 546107120Sjulian 547107120Sjulianstruct mbuf * 548107120Sjulianng_l2cap_prepend(struct mbuf *m, int size) 549107120Sjulian{ 550111119Simp M_PREPEND(m, size, M_DONTWAIT); 551107120Sjulian if (m == NULL || (m->m_len < size && (m = m_pullup(m, size)) == NULL)) 552107120Sjulian return (NULL); 553107120Sjulian 554107120Sjulian return (m); 555107120Sjulian} /* ng_l2cap_prepend */ 556107120Sjulian 557107120Sjulian/* 558107120Sjulian * Default flow settings 559107120Sjulian */ 560107120Sjulian 561107120Sjulianng_l2cap_flow_p 562107120Sjulianng_l2cap_default_flow(void) 563107120Sjulian{ 564107120Sjulian static ng_l2cap_flow_t default_flow = { 565107120Sjulian /* flags */ 0x0, 566107120Sjulian /* service_type */ NG_HCI_SERVICE_TYPE_BEST_EFFORT, 567107120Sjulian /* token_rate */ 0xffffffff, /* maximum */ 568107120Sjulian /* token_bucket_size */ 0xffffffff, /* maximum */ 569107120Sjulian /* peak_bandwidth */ 0x00000000, /* maximum */ 570107120Sjulian /* latency */ 0xffffffff, /* don't care */ 571107120Sjulian /* delay_variation */ 0xffffffff /* don't care */ 572107120Sjulian }; 573107120Sjulian 574107120Sjulian return (&default_flow); 575107120Sjulian} /* ng_l2cap_default_flow */ 576107120Sjulian 577107120Sjulian/* 578107120Sjulian * Get next available channel ID 579107120Sjulian * XXX FIXME this is *UGLY* but will do for now 580107120Sjulian */ 581107120Sjulian 582107120Sjulianstatic u_int16_t 583107120Sjulianng_l2cap_get_cid(ng_l2cap_p l2cap) 584107120Sjulian{ 585107120Sjulian u_int16_t cid = l2cap->cid + 1; 586107120Sjulian 587107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 588107120Sjulian cid = NG_L2CAP_FIRST_CID; 589107120Sjulian 590107120Sjulian while (cid != l2cap->cid) { 591107120Sjulian if (ng_l2cap_chan_by_scid(l2cap, cid) == NULL) { 592107120Sjulian l2cap->cid = cid; 593107120Sjulian 594107120Sjulian return (cid); 595107120Sjulian } 596107120Sjulian 597107120Sjulian cid ++; 598107120Sjulian if (cid < NG_L2CAP_FIRST_CID) 599107120Sjulian cid = NG_L2CAP_FIRST_CID; 600107120Sjulian } 601107120Sjulian 602107120Sjulian return (NG_L2CAP_NULL_CID); 603107120Sjulian} /* ng_l2cap_get_cid */ 604107120Sjulian 605107120Sjulian/* 606107120Sjulian * Get next available command ident 607107120Sjulian * XXX FIXME this is *UGLY* but will do for now 608107120Sjulian */ 609107120Sjulian 610107120Sjulianu_int8_t 611107120Sjulianng_l2cap_get_ident(ng_l2cap_con_p con) 612107120Sjulian{ 613107120Sjulian u_int8_t ident = con->ident + 1; 614107120Sjulian 615107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 616107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 617107120Sjulian 618107120Sjulian while (ident != con->ident) { 619107120Sjulian if (ng_l2cap_cmd_by_ident(con, ident) == NULL) { 620107120Sjulian con->ident = ident; 621107120Sjulian 622107120Sjulian return (ident); 623107120Sjulian } 624107120Sjulian 625107120Sjulian ident ++; 626107120Sjulian if (ident < NG_L2CAP_FIRST_IDENT) 627107120Sjulian ident = NG_L2CAP_FIRST_IDENT; 628107120Sjulian } 629107120Sjulian 630107120Sjulian return (NG_L2CAP_NULL_IDENT); 631107120Sjulian} /* ng_l2cap_get_ident */ 632107120Sjulian 633