Annotation of sys/netbt/l2cap_lower.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: l2cap_lower.c,v 1.1 2007/05/30 03:42:53 uwe Exp $ */
! 2: /* $NetBSD: l2cap_lower.c,v 1.6 2007/04/21 06:15:23 plunky Exp $ */
! 3:
! 4: /*-
! 5: * Copyright (c) 2005 Iain Hibbert.
! 6: * Copyright (c) 2006 Itronix Inc.
! 7: * All rights reserved.
! 8: *
! 9: * Redistribution and use in source and binary forms, with or without
! 10: * modification, are permitted provided that the following conditions
! 11: * are met:
! 12: * 1. Redistributions of source code must retain the above copyright
! 13: * notice, this list of conditions and the following disclaimer.
! 14: * 2. Redistributions in binary form must reproduce the above copyright
! 15: * notice, this list of conditions and the following disclaimer in the
! 16: * documentation and/or other materials provided with the distribution.
! 17: * 3. The name of Itronix Inc. may not be used to endorse
! 18: * or promote products derived from this software without specific
! 19: * prior written permission.
! 20: *
! 21: * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
! 22: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
! 23: * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
! 24: * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
! 25: * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
! 26: * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
! 27: * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
! 28: * ON ANY THEORY OF LIABILITY, WHETHER IN
! 29: * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
! 30: * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
! 31: * POSSIBILITY OF SUCH DAMAGE.
! 32: */
! 33:
! 34: #include <sys/cdefs.h>
! 35:
! 36: #include <sys/param.h>
! 37: #include <sys/kernel.h>
! 38: #include <sys/malloc.h>
! 39: #include <sys/mbuf.h>
! 40: #include <sys/proc.h>
! 41: #include <sys/queue.h>
! 42: #include <sys/systm.h>
! 43:
! 44: #include <netbt/bluetooth.h>
! 45: #include <netbt/hci.h>
! 46: #include <netbt/l2cap.h>
! 47:
! 48: /****************************************************************************
! 49: *
! 50: * L2CAP Channel Lower Layer interface
! 51: */
! 52:
! 53: /*
! 54: * L2CAP channel is disconnected, could be:
! 55: *
! 56: * HCI layer received "Disconnect Complete" event for ACL link
! 57: * some Request timed out
! 58: * Config failed
! 59: * Other end reported invalid CID
! 60: * Normal disconnection
! 61: * Change link mode failed
! 62: */
! 63: void
! 64: l2cap_close(struct l2cap_channel *chan, int err)
! 65: {
! 66: struct l2cap_pdu *pdu;
! 67: struct l2cap_req *req, *n;
! 68:
! 69: if (chan->lc_state == L2CAP_CLOSED)
! 70: return;
! 71:
! 72: /*
! 73: * Since any potential PDU could be half sent we just let it go,
! 74: * but disassociate ourselves from it as links deal with ownerless
! 75: * PDU's in any case. We could try harder to flush unsent packets
! 76: * but maybe its better to leave them in the queue?
! 77: */
! 78: TAILQ_FOREACH(pdu, &chan->lc_link->hl_txq, lp_next) {
! 79: if (pdu->lp_chan == chan)
! 80: pdu->lp_chan = NULL;
! 81: }
! 82:
! 83: /*
! 84: * and clear any outstanding requests..
! 85: */
! 86: req = TAILQ_FIRST(&chan->lc_link->hl_reqs);
! 87: while (req != NULL) {
! 88: n = TAILQ_NEXT(req, lr_next);
! 89: if (req->lr_chan == chan)
! 90: l2cap_request_free(req);
! 91:
! 92: req = n;
! 93: }
! 94:
! 95: chan->lc_pending = 0;
! 96: chan->lc_state = L2CAP_CLOSED;
! 97: hci_acl_close(chan->lc_link, err);
! 98: chan->lc_link = NULL;
! 99:
! 100: (*chan->lc_proto->disconnected)(chan->lc_upper, err);
! 101: }
! 102:
! 103: /*
! 104: * Process incoming L2CAP frame from ACL link. We take off the B-Frame
! 105: * header (which is present in all packets), verify the data length
! 106: * and distribute the rest of the frame to the relevant channel
! 107: * handler.
! 108: */
! 109: void
! 110: l2cap_recv_frame(struct mbuf *m, struct hci_link *link)
! 111: {
! 112: struct l2cap_channel *chan;
! 113: l2cap_hdr_t hdr;
! 114:
! 115: m_copydata(m, 0, sizeof(hdr), (caddr_t)&hdr);
! 116: m_adj(m, sizeof(hdr));
! 117:
! 118: hdr.length = letoh16(hdr.length);
! 119: hdr.dcid = letoh16(hdr.dcid);
! 120:
! 121: DPRINTFN(5, "(%s) received packet (%d bytes)\n",
! 122: link->hl_unit->hci_devname, hdr.length);
! 123:
! 124: if (hdr.length != m->m_pkthdr.len)
! 125: goto failed;
! 126:
! 127: if (hdr.dcid == L2CAP_SIGNAL_CID) {
! 128: l2cap_recv_signal(m, link);
! 129: return;
! 130: }
! 131:
! 132: if (hdr.dcid == L2CAP_CLT_CID) {
! 133: m_freem(m); /* TODO */
! 134: return;
! 135: }
! 136:
! 137: chan = l2cap_cid_lookup(hdr.dcid);
! 138: if (chan != NULL && chan->lc_link == link
! 139: && chan->lc_state == L2CAP_OPEN) {
! 140: (*chan->lc_proto->input)(chan->lc_upper, m);
! 141: return;
! 142: }
! 143:
! 144: DPRINTF("(%s) dropping %d L2CAP data bytes for unknown CID #%d\n",
! 145: link->hl_unit->hci_devname, hdr.length, hdr.dcid);
! 146:
! 147: failed:
! 148: m_freem(m);
! 149: }
! 150:
! 151: /*
! 152: * Start another L2CAP packet on its way. This is called from l2cap_send
! 153: * (when no PDU is pending) and hci_acl_start (when PDU has been placed on
! 154: * device queue). Thus we can have more than one PDU waiting at the device
! 155: * if space is available but no single channel will hog the link.
! 156: */
! 157: int
! 158: l2cap_start(struct l2cap_channel *chan)
! 159: {
! 160: struct mbuf *m;
! 161: int err = 0;
! 162:
! 163: if (chan->lc_state != L2CAP_OPEN)
! 164: return 0;
! 165:
! 166: if (IF_IS_EMPTY(&chan->lc_txq)) {
! 167: DPRINTFN(5, "no data, pending = %d\n", chan->lc_pending);
! 168: /*
! 169: * If we are just waiting for the queue to flush
! 170: * and it has, we may disconnect..
! 171: */
! 172: if (chan->lc_flags & L2CAP_SHUTDOWN
! 173: && chan->lc_pending == 0) {
! 174: chan->lc_state = L2CAP_WAIT_DISCONNECT;
! 175: err = l2cap_send_disconnect_req(chan);
! 176: if (err)
! 177: l2cap_close(chan, err);
! 178: }
! 179:
! 180: return err;
! 181: }
! 182:
! 183: /*
! 184: * We could check QoS/RFC mode here and optionally not send
! 185: * the packet if we are not ready for any reason
! 186: *
! 187: * Also to support flush timeout then we might want to start
! 188: * the timer going? (would need to keep some kind of record
! 189: * of packets sent, possibly change it so that we allocate
! 190: * the l2cap_pdu and fragment the packet, then hand it down
! 191: * and get it back when its completed). Hm.
! 192: */
! 193:
! 194: IF_DEQUEUE(&chan->lc_txq, m);
! 195:
! 196: KASSERT(chan->lc_link != NULL);
! 197: KASSERT(m != NULL);
! 198:
! 199: DPRINTFN(5, "CID #%d sending packet (%d bytes)\n",
! 200: chan->lc_lcid, m->m_pkthdr.len);
! 201:
! 202: chan->lc_pending++;
! 203: return hci_acl_send(m, chan->lc_link, chan);
! 204: }
CVSweb