1878ed226SJulian Elischer /* 2878ed226SJulian Elischer * ng_l2cap_main.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 * 30f2bb1caeSJulian Elischer * $Id: ng_l2cap_main.c,v 1.2 2003/04/28 21:44:59 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> 42878ed226SJulian Elischer #include <netgraph/ng_parse.h> 43b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_bluetooth.h> 44b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_hci.h> 45b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_l2cap.h> 46b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_var.h> 47b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_cmds.h> 48b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_evnt.h> 49b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_llpi.h> 50b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_ulpi.h> 51b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_misc.h> 52b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/l2cap/ng_l2cap_prse.h> 53878ed226SJulian Elischer 54878ed226SJulian Elischer /****************************************************************************** 55878ed226SJulian Elischer ****************************************************************************** 56878ed226SJulian Elischer ** This node implements Link Layer Control and Adaptation Protocol (L2CAP) 57878ed226SJulian Elischer ****************************************************************************** 58878ed226SJulian Elischer ******************************************************************************/ 59878ed226SJulian Elischer 60878ed226SJulian Elischer /* MALLOC define */ 61878ed226SJulian Elischer #ifdef NG_SEPARATE_MALLOC 62878ed226SJulian Elischer MALLOC_DEFINE(M_NETGRAPH_L2CAP, "netgraph_l2cap", 63878ed226SJulian Elischer "Netgraph Bluetooth L2CAP node"); 64878ed226SJulian Elischer #else 65878ed226SJulian Elischer #define M_NETGRAPH_L2CAP M_NETGRAPH 66878ed226SJulian Elischer #endif /* NG_SEPARATE_MALLOC */ 67878ed226SJulian Elischer 68878ed226SJulian Elischer /* Netgraph node methods */ 69878ed226SJulian Elischer static ng_constructor_t ng_l2cap_constructor; 70878ed226SJulian Elischer static ng_shutdown_t ng_l2cap_shutdown; 71878ed226SJulian Elischer static ng_newhook_t ng_l2cap_newhook; 72878ed226SJulian Elischer static ng_connect_t ng_l2cap_connect; 73878ed226SJulian Elischer static ng_disconnect_t ng_l2cap_disconnect; 74878ed226SJulian Elischer static ng_rcvmsg_t ng_l2cap_lower_rcvmsg; 75878ed226SJulian Elischer static ng_rcvmsg_t ng_l2cap_upper_rcvmsg; 76878ed226SJulian Elischer static ng_rcvmsg_t ng_l2cap_default_rcvmsg; 77878ed226SJulian Elischer static ng_rcvdata_t ng_l2cap_rcvdata; 78878ed226SJulian Elischer 79878ed226SJulian Elischer /* Netgraph node type descriptor */ 80878ed226SJulian Elischer static struct ng_type typestruct = { 81f8aae777SJulian Elischer .version = NG_ABI_VERSION, 82f8aae777SJulian Elischer .name = NG_L2CAP_NODE_TYPE, 83f8aae777SJulian Elischer .constructor = ng_l2cap_constructor, 84f8aae777SJulian Elischer .rcvmsg = ng_l2cap_default_rcvmsg, 85f8aae777SJulian Elischer .shutdown = ng_l2cap_shutdown, 86f8aae777SJulian Elischer .newhook = ng_l2cap_newhook, 87f8aae777SJulian Elischer .connect = ng_l2cap_connect, 88f8aae777SJulian Elischer .rcvdata = ng_l2cap_rcvdata, 89f8aae777SJulian Elischer .disconnect = ng_l2cap_disconnect, 90f8aae777SJulian Elischer .cmdlist = ng_l2cap_cmdlist, 91878ed226SJulian Elischer }; 92878ed226SJulian Elischer NETGRAPH_INIT(l2cap, &typestruct); 93878ed226SJulian Elischer MODULE_VERSION(ng_l2cap, NG_BLUETOOTH_VERSION); 94878ed226SJulian Elischer MODULE_DEPEND(ng_l2cap, ng_bluetooth, NG_BLUETOOTH_VERSION, 95878ed226SJulian Elischer NG_BLUETOOTH_VERSION, NG_BLUETOOTH_VERSION); 96878ed226SJulian Elischer 97878ed226SJulian Elischer /***************************************************************************** 98878ed226SJulian Elischer ***************************************************************************** 99878ed226SJulian Elischer ** Netgraph methods implementation 100878ed226SJulian Elischer ***************************************************************************** 101878ed226SJulian Elischer *****************************************************************************/ 102878ed226SJulian Elischer 103878ed226SJulian Elischer static void ng_l2cap_cleanup (ng_l2cap_p); 104878ed226SJulian Elischer static void ng_l2cap_destroy_channels (ng_l2cap_p); 105878ed226SJulian Elischer 106878ed226SJulian Elischer /* 107878ed226SJulian Elischer * Create new instance of L2CAP node 108878ed226SJulian Elischer */ 109878ed226SJulian Elischer 110878ed226SJulian Elischer static int 111878ed226SJulian Elischer ng_l2cap_constructor(node_p node) 112878ed226SJulian Elischer { 113878ed226SJulian Elischer ng_l2cap_p l2cap = NULL; 114878ed226SJulian Elischer 115878ed226SJulian Elischer /* Create new L2CAP node */ 116*674d86bfSGleb Smirnoff l2cap = malloc(sizeof(*l2cap), M_NETGRAPH_L2CAP, M_WAITOK | M_ZERO); 117878ed226SJulian Elischer 118878ed226SJulian Elischer l2cap->node = node; 119878ed226SJulian Elischer l2cap->debug = NG_L2CAP_WARN_LEVEL; 120f2bb1caeSJulian Elischer l2cap->discon_timo = 5; /* sec */ 121878ed226SJulian Elischer 122878ed226SJulian Elischer LIST_INIT(&l2cap->con_list); 123878ed226SJulian Elischer LIST_INIT(&l2cap->chan_list); 124878ed226SJulian Elischer 125878ed226SJulian Elischer NG_NODE_SET_PRIVATE(node, l2cap); 126878ed226SJulian Elischer NG_NODE_FORCE_WRITER(node); 127878ed226SJulian Elischer 128878ed226SJulian Elischer return (0); 129878ed226SJulian Elischer } /* ng_l2cap_constructor */ 130878ed226SJulian Elischer 131878ed226SJulian Elischer /* 132878ed226SJulian Elischer * Shutdown L2CAP node 133878ed226SJulian Elischer */ 134878ed226SJulian Elischer 135878ed226SJulian Elischer static int 136878ed226SJulian Elischer ng_l2cap_shutdown(node_p node) 137878ed226SJulian Elischer { 138878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 139878ed226SJulian Elischer 140878ed226SJulian Elischer NG_NODE_SET_PRIVATE(node, NULL); 141878ed226SJulian Elischer NG_NODE_UNREF(node); 142878ed226SJulian Elischer 143878ed226SJulian Elischer /* Clean up L2CAP node. Delete all connection, channels and commands */ 144878ed226SJulian Elischer l2cap->node = NULL; 145878ed226SJulian Elischer ng_l2cap_cleanup(l2cap); 146878ed226SJulian Elischer 147878ed226SJulian Elischer bzero(l2cap, sizeof(*l2cap)); 1481ede983cSDag-Erling Smørgrav free(l2cap, M_NETGRAPH_L2CAP); 149878ed226SJulian Elischer 150878ed226SJulian Elischer return (0); 151878ed226SJulian Elischer } /* ng_l2cap_shutdown */ 152878ed226SJulian Elischer 153878ed226SJulian Elischer /* 154878ed226SJulian Elischer * Give our OK for a hook to be added. HCI layer is connected to the HCI 155878ed226SJulian Elischer * (NG_L2CAP_HOOK_HCI) hook. As per specification L2CAP layer MUST provide 156878ed226SJulian Elischer * Procol/Service Multiplexing, so the L2CAP node provides separate hooks 157878ed226SJulian Elischer * for SDP (NG_L2CAP_HOOK_SDP), RFCOMM (NG_L2CAP_HOOK_RFCOMM) and TCP 158878ed226SJulian Elischer * (NG_L2CAP_HOOK_TCP) protcols. Unknown PSM will be forwarded to 159878ed226SJulian Elischer * NG_L2CAP_HOOK_ORPHAN hook. Control node/application is connected to 160878ed226SJulian Elischer * control (NG_L2CAP_HOOK_CTL) hook. 161878ed226SJulian Elischer */ 162878ed226SJulian Elischer 163878ed226SJulian Elischer static int 164878ed226SJulian Elischer ng_l2cap_newhook(node_p node, hook_p hook, char const *name) 165878ed226SJulian Elischer { 166878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 167878ed226SJulian Elischer hook_p *h = NULL; 168878ed226SJulian Elischer 169878ed226SJulian Elischer if (strcmp(name, NG_L2CAP_HOOK_HCI) == 0) 170878ed226SJulian Elischer h = &l2cap->hci; 171878ed226SJulian Elischer else if (strcmp(name, NG_L2CAP_HOOK_L2C) == 0) 172878ed226SJulian Elischer h = &l2cap->l2c; 173878ed226SJulian Elischer else if (strcmp(name, NG_L2CAP_HOOK_CTL) == 0) 174878ed226SJulian Elischer h = &l2cap->ctl; 175878ed226SJulian Elischer else 176878ed226SJulian Elischer return (EINVAL); 177878ed226SJulian Elischer 178878ed226SJulian Elischer if (*h != NULL) 179878ed226SJulian Elischer return (EISCONN); 180878ed226SJulian Elischer 181878ed226SJulian Elischer *h = hook; 182878ed226SJulian Elischer 183878ed226SJulian Elischer return (0); 184878ed226SJulian Elischer } /* ng_l2cap_newhook */ 185878ed226SJulian Elischer 186878ed226SJulian Elischer /* 187878ed226SJulian Elischer * Give our final OK to connect hook. Nothing to do here. 188878ed226SJulian Elischer */ 189878ed226SJulian Elischer 190878ed226SJulian Elischer static int 191878ed226SJulian Elischer ng_l2cap_connect(hook_p hook) 192878ed226SJulian Elischer { 193878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(NG_HOOK_NODE(hook)); 194878ed226SJulian Elischer int error = 0; 195878ed226SJulian Elischer 196878ed226SJulian Elischer if (hook == l2cap->hci) 197878ed226SJulian Elischer NG_HOOK_SET_RCVMSG(hook, ng_l2cap_lower_rcvmsg); 198878ed226SJulian Elischer else 199878ed226SJulian Elischer if (hook == l2cap->l2c || hook == l2cap->ctl) { 200878ed226SJulian Elischer NG_HOOK_SET_RCVMSG(hook, ng_l2cap_upper_rcvmsg); 201878ed226SJulian Elischer 202878ed226SJulian Elischer /* Send delayed notification to the upper layer */ 203878ed226SJulian Elischer error = ng_send_fn(l2cap->node, hook, ng_l2cap_send_hook_info, 204878ed226SJulian Elischer NULL, 0); 205878ed226SJulian Elischer } else 206878ed226SJulian Elischer error = EINVAL; 207878ed226SJulian Elischer 208878ed226SJulian Elischer return (error); 209878ed226SJulian Elischer } /* ng_l2cap_connect */ 210878ed226SJulian Elischer 211878ed226SJulian Elischer /* 212878ed226SJulian Elischer * Disconnect the hook. For downstream hook we must notify upper layers. 213878ed226SJulian Elischer * 214878ed226SJulian Elischer * XXX For upstream hooks this is really ugly :( Hook was disconnected and it 215878ed226SJulian Elischer * XXX is now too late to do anything. For now we just clean up our own mess 216878ed226SJulian Elischer * XXX and remove all channels that use disconnected upstream hook. If we don't 217878ed226SJulian Elischer * XXX do that then L2CAP node can get out of sync with upper layers. 218878ed226SJulian Elischer * XXX No notification will be sent to remote peer. 219878ed226SJulian Elischer */ 220878ed226SJulian Elischer 221878ed226SJulian Elischer static int 222878ed226SJulian Elischer ng_l2cap_disconnect(hook_p hook) 223878ed226SJulian Elischer { 224878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(NG_HOOK_NODE(hook)); 225878ed226SJulian Elischer hook_p *h = NULL; 226878ed226SJulian Elischer 227878ed226SJulian Elischer if (hook == l2cap->hci) { 228878ed226SJulian Elischer ng_l2cap_cleanup(l2cap); 229878ed226SJulian Elischer h = &l2cap->hci; 230878ed226SJulian Elischer } else 231878ed226SJulian Elischer if (hook == l2cap->l2c) { 232878ed226SJulian Elischer ng_l2cap_destroy_channels(l2cap); 233878ed226SJulian Elischer h = &l2cap->l2c; 234878ed226SJulian Elischer } else 235878ed226SJulian Elischer if (hook == l2cap->ctl) 236878ed226SJulian Elischer h = &l2cap->ctl; 237878ed226SJulian Elischer else 238878ed226SJulian Elischer return (EINVAL); 239878ed226SJulian Elischer 240878ed226SJulian Elischer *h = NULL; 241878ed226SJulian Elischer 242878ed226SJulian Elischer /* Shutdown when all hooks are disconnected */ 243878ed226SJulian Elischer if (NG_NODE_NUMHOOKS(NG_HOOK_NODE(hook)) == 0 && 244878ed226SJulian Elischer NG_NODE_IS_VALID(NG_HOOK_NODE(hook))) 245878ed226SJulian Elischer ng_rmnode_self(NG_HOOK_NODE(hook)); 246878ed226SJulian Elischer 247878ed226SJulian Elischer return (0); 248878ed226SJulian Elischer } /* ng_l2cap_disconnect */ 249878ed226SJulian Elischer 250878ed226SJulian Elischer /* 251878ed226SJulian Elischer * Process control message from lower layer 252878ed226SJulian Elischer */ 253878ed226SJulian Elischer 254878ed226SJulian Elischer static int 255878ed226SJulian Elischer ng_l2cap_lower_rcvmsg(node_p node, item_p item, hook_p lasthook) 256878ed226SJulian Elischer { 257878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 258878ed226SJulian Elischer struct ng_mesg *msg = NGI_MSG(item); /* item still has message */ 259878ed226SJulian Elischer int error = 0; 260878ed226SJulian Elischer 261878ed226SJulian Elischer switch (msg->header.typecookie) { 262878ed226SJulian Elischer case NGM_HCI_COOKIE: 263878ed226SJulian Elischer switch (msg->header.cmd) { 264878ed226SJulian Elischer /* HCI node is ready */ 265878ed226SJulian Elischer case NGM_HCI_NODE_UP: { 266878ed226SJulian Elischer ng_hci_node_up_ep *ep = NULL; 267878ed226SJulian Elischer 268878ed226SJulian Elischer if (msg->header.arglen != sizeof(*ep)) 269878ed226SJulian Elischer error = EMSGSIZE; 270878ed226SJulian Elischer else { 271878ed226SJulian Elischer ep = (ng_hci_node_up_ep *)(msg->data); 272878ed226SJulian Elischer 273878ed226SJulian Elischer NG_L2CAP_INFO( 274878ed226SJulian Elischer "%s: %s - HCI node is up, bdaddr: %x:%x:%x:%x:%x:%x, " \ 275878ed226SJulian Elischer "pkt_size=%d bytes, num_pkts=%d\n", __func__, NG_NODE_NAME(l2cap->node), 276878ed226SJulian Elischer ep->bdaddr.b[5], ep->bdaddr.b[4], 277878ed226SJulian Elischer ep->bdaddr.b[3], ep->bdaddr.b[2], 278878ed226SJulian Elischer ep->bdaddr.b[1], ep->bdaddr.b[0], 279878ed226SJulian Elischer ep->pkt_size, ep->num_pkts); 280878ed226SJulian Elischer 281878ed226SJulian Elischer bcopy(&ep->bdaddr, &l2cap->bdaddr, 282878ed226SJulian Elischer sizeof(l2cap->bdaddr)); 283878ed226SJulian Elischer l2cap->pkt_size = ep->pkt_size; 284878ed226SJulian Elischer l2cap->num_pkts = ep->num_pkts; 285878ed226SJulian Elischer 286878ed226SJulian Elischer /* Notify upper layers */ 287878ed226SJulian Elischer ng_l2cap_send_hook_info(l2cap->node, 288878ed226SJulian Elischer l2cap->l2c, NULL, 0); 289878ed226SJulian Elischer ng_l2cap_send_hook_info(l2cap->node, 290878ed226SJulian Elischer l2cap->ctl, NULL, 0); 291878ed226SJulian Elischer } 292878ed226SJulian Elischer } break; 293878ed226SJulian Elischer 294878ed226SJulian Elischer case NGM_HCI_SYNC_CON_QUEUE: { 295878ed226SJulian Elischer ng_hci_sync_con_queue_ep *ep = NULL; 296878ed226SJulian Elischer ng_l2cap_con_p con = NULL; 297878ed226SJulian Elischer 298878ed226SJulian Elischer if (msg->header.arglen != sizeof(*ep)) 299878ed226SJulian Elischer error = EMSGSIZE; 300878ed226SJulian Elischer else { 301878ed226SJulian Elischer ep = (ng_hci_sync_con_queue_ep *)(msg->data); 302878ed226SJulian Elischer con = ng_l2cap_con_by_handle(l2cap, 303878ed226SJulian Elischer ep->con_handle); 304878ed226SJulian Elischer if (con == NULL) 305878ed226SJulian Elischer break; 306878ed226SJulian Elischer 307878ed226SJulian Elischer NG_L2CAP_INFO( 308878ed226SJulian Elischer "%s: %s - sync HCI connection queue, con_handle=%d, pending=%d, completed=%d\n", 309878ed226SJulian Elischer __func__, NG_NODE_NAME(l2cap->node), 310878ed226SJulian Elischer ep->con_handle, con->pending, 311878ed226SJulian Elischer ep->completed); 312878ed226SJulian Elischer 313878ed226SJulian Elischer con->pending -= ep->completed; 314878ed226SJulian Elischer if (con->pending < 0) { 315878ed226SJulian Elischer NG_L2CAP_WARN( 316878ed226SJulian Elischer "%s: %s - pending packet counter is out of sync! " \ 317878ed226SJulian Elischer "con_handle=%d, pending=%d, completed=%d\n", __func__, 318878ed226SJulian Elischer NG_NODE_NAME(l2cap->node), 319878ed226SJulian Elischer con->con_handle, con->pending, 320878ed226SJulian Elischer ep->completed); 321878ed226SJulian Elischer 322878ed226SJulian Elischer con->pending = 0; 323878ed226SJulian Elischer } 324878ed226SJulian Elischer 325878ed226SJulian Elischer ng_l2cap_lp_deliver(con); 326878ed226SJulian Elischer } 327878ed226SJulian Elischer } break; 328878ed226SJulian Elischer 329878ed226SJulian Elischer /* LP_ConnectCfm[Neg] */ 330878ed226SJulian Elischer case NGM_HCI_LP_CON_CFM: 331878ed226SJulian Elischer error = ng_l2cap_lp_con_cfm(l2cap, msg); 332878ed226SJulian Elischer break; 333878ed226SJulian Elischer 334878ed226SJulian Elischer /* LP_ConnectInd */ 335878ed226SJulian Elischer case NGM_HCI_LP_CON_IND: 336878ed226SJulian Elischer error = ng_l2cap_lp_con_ind(l2cap, msg); 337878ed226SJulian Elischer break; 338878ed226SJulian Elischer 339878ed226SJulian Elischer /* LP_DisconnectInd */ 340878ed226SJulian Elischer case NGM_HCI_LP_DISCON_IND: 341878ed226SJulian Elischer error = ng_l2cap_lp_discon_ind(l2cap, msg); 342878ed226SJulian Elischer break; 343878ed226SJulian Elischer 344878ed226SJulian Elischer /* LP_QoSSetupCfm[Neg] */ 345878ed226SJulian Elischer case NGM_HCI_LP_QOS_CFM: 346878ed226SJulian Elischer error = ng_l2cap_lp_qos_cfm(l2cap, msg); 347878ed226SJulian Elischer break; 348878ed226SJulian Elischer 349878ed226SJulian Elischer /* LP_OoSViolationInd */ 350878ed226SJulian Elischer case NGM_HCI_LP_QOS_IND: 351878ed226SJulian Elischer error = ng_l2cap_lp_qos_ind(l2cap, msg); 352878ed226SJulian Elischer break; 353878ed226SJulian Elischer 354878ed226SJulian Elischer default: 355878ed226SJulian Elischer error = EINVAL; 356878ed226SJulian Elischer break; 357878ed226SJulian Elischer } 358878ed226SJulian Elischer break; 359878ed226SJulian Elischer 360878ed226SJulian Elischer default: 361878ed226SJulian Elischer return (ng_l2cap_default_rcvmsg(node, item, lasthook)); 362878ed226SJulian Elischer /* NOT REACHED */ 363878ed226SJulian Elischer } 364878ed226SJulian Elischer 365878ed226SJulian Elischer NG_FREE_ITEM(item); 366878ed226SJulian Elischer 367878ed226SJulian Elischer return (error); 368878ed226SJulian Elischer } /* ng_l2cap_lower_rcvmsg */ 369878ed226SJulian Elischer 370878ed226SJulian Elischer /* 371878ed226SJulian Elischer * Process control message from upper layer 372878ed226SJulian Elischer */ 373878ed226SJulian Elischer 374878ed226SJulian Elischer static int 375878ed226SJulian Elischer ng_l2cap_upper_rcvmsg(node_p node, item_p item, hook_p lasthook) 376878ed226SJulian Elischer { 377878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 378878ed226SJulian Elischer struct ng_mesg *msg = NGI_MSG(item); /* item still has message */ 379878ed226SJulian Elischer int error = 0; 380878ed226SJulian Elischer 381878ed226SJulian Elischer switch (msg->header.typecookie) { 382878ed226SJulian Elischer case NGM_L2CAP_COOKIE: 383878ed226SJulian Elischer switch (msg->header.cmd) { 384878ed226SJulian Elischer /* L2CA_Connect */ 385878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON: 386878ed226SJulian Elischer error = ng_l2cap_l2ca_con_req(l2cap, msg); 387878ed226SJulian Elischer break; 388878ed226SJulian Elischer 389878ed226SJulian Elischer /* L2CA_ConnectRsp */ 390878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON_RSP: 391878ed226SJulian Elischer error = ng_l2cap_l2ca_con_rsp_req(l2cap, msg); 392878ed226SJulian Elischer break; 393878ed226SJulian Elischer 394878ed226SJulian Elischer /* L2CA_Config */ 395878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG: 396878ed226SJulian Elischer error = ng_l2cap_l2ca_cfg_req(l2cap, msg); 397878ed226SJulian Elischer break; 398878ed226SJulian Elischer 399878ed226SJulian Elischer /* L2CA_ConfigRsp */ 400878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG_RSP: 401878ed226SJulian Elischer error = ng_l2cap_l2ca_cfg_rsp_req(l2cap, msg); 402878ed226SJulian Elischer break; 403878ed226SJulian Elischer 404878ed226SJulian Elischer /* L2CA_Disconnect */ 405878ed226SJulian Elischer case NGM_L2CAP_L2CA_DISCON: 406878ed226SJulian Elischer error = ng_l2cap_l2ca_discon_req(l2cap, msg); 407878ed226SJulian Elischer break; 408878ed226SJulian Elischer 409878ed226SJulian Elischer /* L2CA_GroupCreate */ 410878ed226SJulian Elischer case NGM_L2CAP_L2CA_GRP_CREATE: 411878ed226SJulian Elischer error = ng_l2cap_l2ca_grp_create(l2cap, msg); 412878ed226SJulian Elischer break; 413878ed226SJulian Elischer 414878ed226SJulian Elischer /* L2CA_GroupClose */ 415878ed226SJulian Elischer case NGM_L2CAP_L2CA_GRP_CLOSE: 416878ed226SJulian Elischer error = ng_l2cap_l2ca_grp_close(l2cap, msg); 417878ed226SJulian Elischer break; 418878ed226SJulian Elischer 419878ed226SJulian Elischer /* L2CA_GroupAddMember */ 420878ed226SJulian Elischer case NGM_L2CAP_L2CA_GRP_ADD_MEMBER: 421878ed226SJulian Elischer error = ng_l2cap_l2ca_grp_add_member_req(l2cap, msg); 422878ed226SJulian Elischer break; 423878ed226SJulian Elischer 424878ed226SJulian Elischer /* L2CA_GroupDeleteMember */ 425878ed226SJulian Elischer case NGM_L2CAP_L2CA_GRP_REM_MEMBER: 426878ed226SJulian Elischer error = ng_l2cap_l2ca_grp_rem_member(l2cap, msg); 427878ed226SJulian Elischer break; 428878ed226SJulian Elischer 429878ed226SJulian Elischer /* L2CA_GroupMembership */ 430878ed226SJulian Elischer case NGM_L2CAP_L2CA_GRP_MEMBERSHIP: 431878ed226SJulian Elischer error = ng_l2cap_l2ca_grp_get_members(l2cap, msg); 432878ed226SJulian Elischer break; 433878ed226SJulian Elischer 434878ed226SJulian Elischer /* L2CA_Ping */ 435878ed226SJulian Elischer case NGM_L2CAP_L2CA_PING: 436878ed226SJulian Elischer error = ng_l2cap_l2ca_ping_req(l2cap, msg); 437878ed226SJulian Elischer break; 438878ed226SJulian Elischer 439878ed226SJulian Elischer /* L2CA_GetInfo */ 440878ed226SJulian Elischer case NGM_L2CAP_L2CA_GET_INFO: 441878ed226SJulian Elischer error = ng_l2cap_l2ca_get_info_req(l2cap, msg); 442878ed226SJulian Elischer break; 443878ed226SJulian Elischer 444878ed226SJulian Elischer /* L2CA_EnableCLT */ 445878ed226SJulian Elischer case NGM_L2CAP_L2CA_ENABLE_CLT: 446878ed226SJulian Elischer error = ng_l2cap_l2ca_enable_clt(l2cap, msg); 447878ed226SJulian Elischer break; 448878ed226SJulian Elischer 449878ed226SJulian Elischer default: 450878ed226SJulian Elischer return (ng_l2cap_default_rcvmsg(node, item, lasthook)); 451878ed226SJulian Elischer /* NOT REACHED */ 452878ed226SJulian Elischer } 453878ed226SJulian Elischer break; 454878ed226SJulian Elischer 455878ed226SJulian Elischer default: 456878ed226SJulian Elischer return (ng_l2cap_default_rcvmsg(node, item, lasthook)); 457878ed226SJulian Elischer /* NOT REACHED */ 458878ed226SJulian Elischer } 459878ed226SJulian Elischer 460878ed226SJulian Elischer NG_FREE_ITEM(item); 461878ed226SJulian Elischer 462878ed226SJulian Elischer return (error); 463878ed226SJulian Elischer } /* ng_l2cap_upper_rcvmsg */ 464878ed226SJulian Elischer 465878ed226SJulian Elischer /* 466878ed226SJulian Elischer * Default control message processing routine 467878ed226SJulian Elischer */ 468878ed226SJulian Elischer 469878ed226SJulian Elischer static int 470878ed226SJulian Elischer ng_l2cap_default_rcvmsg(node_p node, item_p item, hook_p lasthook) 471878ed226SJulian Elischer { 472878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(node); 473878ed226SJulian Elischer struct ng_mesg *msg = NULL, *rsp = NULL; 474878ed226SJulian Elischer int error = 0; 475878ed226SJulian Elischer 476878ed226SJulian Elischer /* Detach and process message */ 477878ed226SJulian Elischer NGI_GET_MSG(item, msg); 478878ed226SJulian Elischer 479878ed226SJulian Elischer switch (msg->header.typecookie) { 480878ed226SJulian Elischer case NGM_GENERIC_COOKIE: 481878ed226SJulian Elischer switch (msg->header.cmd) { 482878ed226SJulian Elischer case NGM_TEXT_STATUS: 483878ed226SJulian Elischer NG_MKRESPONSE(rsp, msg, NG_TEXTRESPONSE, M_NOWAIT); 484878ed226SJulian Elischer if (rsp == NULL) 485878ed226SJulian Elischer error = ENOMEM; 486878ed226SJulian Elischer else 487878ed226SJulian Elischer snprintf(rsp->data, NG_TEXTRESPONSE, 488878ed226SJulian Elischer "bdaddr %x:%x:%x:%x:%x:%x, " \ 489878ed226SJulian Elischer "pkt_size %d\n" \ 490878ed226SJulian Elischer "Hooks %s %s %s\n" \ 491878ed226SJulian Elischer "Flags %#x\n", 492878ed226SJulian Elischer l2cap->bdaddr.b[5], l2cap->bdaddr.b[4], 493878ed226SJulian Elischer l2cap->bdaddr.b[3], l2cap->bdaddr.b[2], 494878ed226SJulian Elischer l2cap->bdaddr.b[1], l2cap->bdaddr.b[0], 495878ed226SJulian Elischer l2cap->pkt_size, 496878ed226SJulian Elischer (l2cap->hci != NULL)? 497878ed226SJulian Elischer NG_L2CAP_HOOK_HCI : "", 498878ed226SJulian Elischer (l2cap->l2c != NULL)? 499878ed226SJulian Elischer NG_L2CAP_HOOK_L2C : "", 500878ed226SJulian Elischer (l2cap->ctl != NULL)? 501878ed226SJulian Elischer NG_L2CAP_HOOK_CTL : "", 502878ed226SJulian Elischer l2cap->flags); 503878ed226SJulian Elischer break; 504878ed226SJulian Elischer 505878ed226SJulian Elischer default: 506878ed226SJulian Elischer error = EINVAL; 507878ed226SJulian Elischer break; 508878ed226SJulian Elischer } 509878ed226SJulian Elischer break; 510878ed226SJulian Elischer 511878ed226SJulian Elischer /* Messages from the upper layer or directed to the local node */ 512878ed226SJulian Elischer case NGM_L2CAP_COOKIE: 513878ed226SJulian Elischer switch (msg->header.cmd) { 514878ed226SJulian Elischer /* Get node flags */ 515878ed226SJulian Elischer case NGM_L2CAP_NODE_GET_FLAGS: 516878ed226SJulian Elischer NG_MKRESPONSE(rsp, msg, sizeof(ng_l2cap_node_flags_ep), 517878ed226SJulian Elischer M_NOWAIT); 518878ed226SJulian Elischer if (rsp == NULL) 519878ed226SJulian Elischer error = ENOMEM; 520878ed226SJulian Elischer else 521878ed226SJulian Elischer *((ng_l2cap_node_flags_ep *)(rsp->data)) = 522878ed226SJulian Elischer l2cap->flags; 523878ed226SJulian Elischer break; 524878ed226SJulian Elischer 525878ed226SJulian Elischer /* Get node debug */ 526878ed226SJulian Elischer case NGM_L2CAP_NODE_GET_DEBUG: 527878ed226SJulian Elischer NG_MKRESPONSE(rsp, msg, sizeof(ng_l2cap_node_debug_ep), 528878ed226SJulian Elischer M_NOWAIT); 529878ed226SJulian Elischer if (rsp == NULL) 530878ed226SJulian Elischer error = ENOMEM; 531878ed226SJulian Elischer else 532878ed226SJulian Elischer *((ng_l2cap_node_debug_ep *)(rsp->data)) = 533878ed226SJulian Elischer l2cap->debug; 534878ed226SJulian Elischer break; 535878ed226SJulian Elischer 536878ed226SJulian Elischer /* Set node debug */ 537878ed226SJulian Elischer case NGM_L2CAP_NODE_SET_DEBUG: 538878ed226SJulian Elischer if (msg->header.arglen != 539878ed226SJulian Elischer sizeof(ng_l2cap_node_debug_ep)) 540878ed226SJulian Elischer error = EMSGSIZE; 541878ed226SJulian Elischer else 542878ed226SJulian Elischer l2cap->debug = 543878ed226SJulian Elischer *((ng_l2cap_node_debug_ep *)(msg->data)); 544878ed226SJulian Elischer break; 545878ed226SJulian Elischer 546878ed226SJulian Elischer /* Get connection list */ 547878ed226SJulian Elischer case NGM_L2CAP_NODE_GET_CON_LIST: { 548878ed226SJulian Elischer ng_l2cap_con_p con = NULL; 549878ed226SJulian Elischer ng_l2cap_node_con_list_ep *e1 = NULL; 550878ed226SJulian Elischer ng_l2cap_node_con_ep *e2 = NULL; 551878ed226SJulian Elischer int n = 0; 552878ed226SJulian Elischer 553878ed226SJulian Elischer /* Count number of connections */ 554878ed226SJulian Elischer LIST_FOREACH(con, &l2cap->con_list, next) 555878ed226SJulian Elischer n++; 556878ed226SJulian Elischer if (n > NG_L2CAP_MAX_CON_NUM) 557878ed226SJulian Elischer n = NG_L2CAP_MAX_CON_NUM; 558878ed226SJulian Elischer 559878ed226SJulian Elischer /* Prepare response */ 560878ed226SJulian Elischer NG_MKRESPONSE(rsp, msg, 561878ed226SJulian Elischer sizeof(*e1) + n * sizeof(*e2), M_NOWAIT); 562878ed226SJulian Elischer if (rsp == NULL) { 563878ed226SJulian Elischer error = ENOMEM; 564878ed226SJulian Elischer break; 565878ed226SJulian Elischer } 566878ed226SJulian Elischer 567878ed226SJulian Elischer e1 = (ng_l2cap_node_con_list_ep *)(rsp->data); 568878ed226SJulian Elischer e2 = (ng_l2cap_node_con_ep *)(e1 + 1); 569878ed226SJulian Elischer 570878ed226SJulian Elischer e1->num_connections = n; 571878ed226SJulian Elischer 572878ed226SJulian Elischer LIST_FOREACH(con, &l2cap->con_list, next) { 573878ed226SJulian Elischer e2->state = con->state; 574878ed226SJulian Elischer 575f2bb1caeSJulian Elischer e2->flags = con->flags; 576878ed226SJulian Elischer if (con->tx_pkt != NULL) 577878ed226SJulian Elischer e2->flags |= NG_L2CAP_CON_TX; 578878ed226SJulian Elischer if (con->rx_pkt != NULL) 579878ed226SJulian Elischer e2->flags |= NG_L2CAP_CON_RX; 580878ed226SJulian Elischer 581878ed226SJulian Elischer e2->pending = con->pending; 582878ed226SJulian Elischer 583878ed226SJulian Elischer e2->con_handle = con->con_handle; 584878ed226SJulian Elischer bcopy(&con->remote, &e2->remote, 585878ed226SJulian Elischer sizeof(e2->remote)); 586878ed226SJulian Elischer 587878ed226SJulian Elischer e2 ++; 588878ed226SJulian Elischer if (--n <= 0) 589878ed226SJulian Elischer break; 590878ed226SJulian Elischer } 591878ed226SJulian Elischer } break; 592878ed226SJulian Elischer 593878ed226SJulian Elischer /* Get channel list */ 594878ed226SJulian Elischer case NGM_L2CAP_NODE_GET_CHAN_LIST: { 595878ed226SJulian Elischer ng_l2cap_chan_p ch = NULL; 596878ed226SJulian Elischer ng_l2cap_node_chan_list_ep *e1 = NULL; 597878ed226SJulian Elischer ng_l2cap_node_chan_ep *e2 = NULL; 598878ed226SJulian Elischer int n = 0; 599878ed226SJulian Elischer 600878ed226SJulian Elischer /* Count number of channels */ 601878ed226SJulian Elischer LIST_FOREACH(ch, &l2cap->chan_list, next) 602878ed226SJulian Elischer n ++; 603878ed226SJulian Elischer if (n > NG_L2CAP_MAX_CHAN_NUM) 604878ed226SJulian Elischer n = NG_L2CAP_MAX_CHAN_NUM; 605878ed226SJulian Elischer 606878ed226SJulian Elischer /* Prepare response */ 607878ed226SJulian Elischer NG_MKRESPONSE(rsp, msg, 608878ed226SJulian Elischer sizeof(ng_l2cap_node_chan_list_ep) + 609878ed226SJulian Elischer n * sizeof(ng_l2cap_node_chan_ep), M_NOWAIT); 610878ed226SJulian Elischer if (rsp == NULL) { 611878ed226SJulian Elischer error = ENOMEM; 612878ed226SJulian Elischer break; 613878ed226SJulian Elischer } 614878ed226SJulian Elischer 615878ed226SJulian Elischer e1 = (ng_l2cap_node_chan_list_ep *)(rsp->data); 616878ed226SJulian Elischer e2 = (ng_l2cap_node_chan_ep *)(e1 + 1); 617878ed226SJulian Elischer 618878ed226SJulian Elischer e1->num_channels = n; 619878ed226SJulian Elischer 620878ed226SJulian Elischer LIST_FOREACH(ch, &l2cap->chan_list, next) { 621878ed226SJulian Elischer e2->state = ch->state; 622878ed226SJulian Elischer 623878ed226SJulian Elischer e2->scid = ch->scid; 624878ed226SJulian Elischer e2->dcid = ch->dcid; 625878ed226SJulian Elischer 626878ed226SJulian Elischer e2->imtu = ch->imtu; 627878ed226SJulian Elischer e2->omtu = ch->omtu; 628878ed226SJulian Elischer 629878ed226SJulian Elischer e2->psm = ch->psm; 630878ed226SJulian Elischer bcopy(&ch->con->remote, &e2->remote, 631878ed226SJulian Elischer sizeof(e2->remote)); 632878ed226SJulian Elischer 633878ed226SJulian Elischer e2 ++; 634878ed226SJulian Elischer if (--n <= 0) 635878ed226SJulian Elischer break; 636878ed226SJulian Elischer } 637878ed226SJulian Elischer } break; 638878ed226SJulian Elischer 639f2bb1caeSJulian Elischer case NGM_L2CAP_NODE_GET_AUTO_DISCON_TIMO: 640f2bb1caeSJulian Elischer NG_MKRESPONSE(rsp, msg, 641f2bb1caeSJulian Elischer sizeof(ng_l2cap_node_auto_discon_ep), M_NOWAIT); 642f2bb1caeSJulian Elischer if (rsp == NULL) 643f2bb1caeSJulian Elischer error = ENOMEM; 644f2bb1caeSJulian Elischer else 645f2bb1caeSJulian Elischer *((ng_l2cap_node_auto_discon_ep *)(rsp->data)) = 646f2bb1caeSJulian Elischer l2cap->discon_timo; 647f2bb1caeSJulian Elischer break; 648f2bb1caeSJulian Elischer 649f2bb1caeSJulian Elischer case NGM_L2CAP_NODE_SET_AUTO_DISCON_TIMO: 650f2bb1caeSJulian Elischer if (msg->header.arglen != 651f2bb1caeSJulian Elischer sizeof(ng_l2cap_node_auto_discon_ep)) 652f2bb1caeSJulian Elischer error = EMSGSIZE; 653f2bb1caeSJulian Elischer else 654f2bb1caeSJulian Elischer l2cap->discon_timo = 655f2bb1caeSJulian Elischer *((ng_l2cap_node_auto_discon_ep *) 656f2bb1caeSJulian Elischer (msg->data)); 657f2bb1caeSJulian Elischer break; 658f2bb1caeSJulian Elischer 659878ed226SJulian Elischer default: 660878ed226SJulian Elischer error = EINVAL; 661878ed226SJulian Elischer break; 662878ed226SJulian Elischer } 663878ed226SJulian Elischer break; 664878ed226SJulian Elischer 665878ed226SJulian Elischer default: 666878ed226SJulian Elischer error = EINVAL; 667878ed226SJulian Elischer break; 668878ed226SJulian Elischer } 669878ed226SJulian Elischer 670878ed226SJulian Elischer NG_RESPOND_MSG(error, node, item, rsp); 671878ed226SJulian Elischer NG_FREE_MSG(msg); 672878ed226SJulian Elischer 673878ed226SJulian Elischer return (error); 674878ed226SJulian Elischer } /* ng_l2cap_rcvmsg */ 675878ed226SJulian Elischer 676878ed226SJulian Elischer /* 677878ed226SJulian Elischer * Process data packet from one of our hooks. 678878ed226SJulian Elischer * 679878ed226SJulian Elischer * From the HCI hook we expect to receive ACL data packets. ACL data packets 680878ed226SJulian Elischer * gets re-assembled into one L2CAP packet (according to length) and then gets 681878ed226SJulian Elischer * processed. 682878ed226SJulian Elischer * 683878ed226SJulian Elischer * NOTE: We expect to receive L2CAP packet header in the first fragment. 684878ed226SJulian Elischer * Otherwise we WILL NOT be able to get length of the L2CAP packet. 685878ed226SJulian Elischer * 686878ed226SJulian Elischer * Signaling L2CAP packets (destination channel ID == 0x1) are processed within 687878ed226SJulian Elischer * the node. Connectionless data packets (destination channel ID == 0x2) will 688878ed226SJulian Elischer * be forwarded to appropriate upstream hook unless it is not connected or 689878ed226SJulian Elischer * connectionless traffic for the specified PSM was disabled. 690878ed226SJulian Elischer * 691878ed226SJulian Elischer * From the upstream hooks we expect to receive data packets. These data 692878ed226SJulian Elischer * packets will be converted into L2CAP data packets. The length of each 693878ed226SJulian Elischer * L2CAP packet must not exceed channel's omtu (our peer's imtu). Then 694878ed226SJulian Elischer * these L2CAP packets will be converted to ACL data packets (according to 695878ed226SJulian Elischer * HCI layer MTU) and sent to lower layer. 696878ed226SJulian Elischer * 697878ed226SJulian Elischer * No data is expected from the control hook. 698878ed226SJulian Elischer */ 699878ed226SJulian Elischer 700878ed226SJulian Elischer static int 701878ed226SJulian Elischer ng_l2cap_rcvdata(hook_p hook, item_p item) 702878ed226SJulian Elischer { 703878ed226SJulian Elischer ng_l2cap_p l2cap = (ng_l2cap_p) NG_NODE_PRIVATE(NG_HOOK_NODE(hook)); 704878ed226SJulian Elischer struct mbuf *m = NULL; 705878ed226SJulian Elischer int error = 0; 706878ed226SJulian Elischer 707878ed226SJulian Elischer /* Detach mbuf, discard item and process data */ 708878ed226SJulian Elischer NGI_GET_M(item, m); 709878ed226SJulian Elischer NG_FREE_ITEM(item); 710878ed226SJulian Elischer 711878ed226SJulian Elischer if (hook == l2cap->hci) 712878ed226SJulian Elischer error = ng_l2cap_lp_receive(l2cap, m); 713878ed226SJulian Elischer else if (hook == l2cap->l2c) 714878ed226SJulian Elischer error = ng_l2cap_l2ca_write_req(l2cap, m); 715878ed226SJulian Elischer else { 716878ed226SJulian Elischer NG_FREE_M(m); 717878ed226SJulian Elischer error = EINVAL; 718878ed226SJulian Elischer } 719878ed226SJulian Elischer 720878ed226SJulian Elischer return (error); 721878ed226SJulian Elischer } /* ng_l2cap_rcvdata */ 722878ed226SJulian Elischer 723878ed226SJulian Elischer /* 724878ed226SJulian Elischer * Clean all connections, channels and commands for the L2CAP node 725878ed226SJulian Elischer */ 726878ed226SJulian Elischer 727878ed226SJulian Elischer static void 728878ed226SJulian Elischer ng_l2cap_cleanup(ng_l2cap_p l2cap) 729878ed226SJulian Elischer { 730878ed226SJulian Elischer ng_l2cap_con_p con = NULL; 731878ed226SJulian Elischer 732878ed226SJulian Elischer /* Clean up connection and channels */ 733878ed226SJulian Elischer while (!LIST_EMPTY(&l2cap->con_list)) { 734878ed226SJulian Elischer con = LIST_FIRST(&l2cap->con_list); 735878ed226SJulian Elischer 736f2bb1caeSJulian Elischer if (con->flags & NG_L2CAP_CON_LP_TIMO) 737878ed226SJulian Elischer ng_l2cap_lp_untimeout(con); 738f2bb1caeSJulian Elischer else if (con->flags & NG_L2CAP_CON_AUTO_DISCON_TIMO) 739f2bb1caeSJulian Elischer ng_l2cap_discon_untimeout(con); 740878ed226SJulian Elischer 741878ed226SJulian Elischer /* Connection terminated by local host */ 742f2bb1caeSJulian Elischer ng_l2cap_con_fail(con, 0x16); 743878ed226SJulian Elischer } 744878ed226SJulian Elischer } /* ng_l2cap_cleanup */ 745878ed226SJulian Elischer 746878ed226SJulian Elischer /* 747878ed226SJulian Elischer * Destroy all channels that use specified upstream hook 748878ed226SJulian Elischer */ 749878ed226SJulian Elischer 750878ed226SJulian Elischer static void 751878ed226SJulian Elischer ng_l2cap_destroy_channels(ng_l2cap_p l2cap) 752878ed226SJulian Elischer { 753878ed226SJulian Elischer while (!LIST_EMPTY(&l2cap->chan_list)) 754878ed226SJulian Elischer ng_l2cap_free_chan(LIST_FIRST(&l2cap->chan_list)); 755878ed226SJulian Elischer } /* ng_l2cap_destroy_channels_by_hook */ 756878ed226SJulian Elischer 757