OpenBSD-4.6/sys/dev/bluetooth/bthidev.c
/* $OpenBSD: bthidev.c,v 1.5 2008/11/24 08:49:22 uwe Exp $ */
/* $NetBSD: bthidev.c,v 1.16 2008/08/06 15:01:23 plunky Exp $ */
/*-
* Copyright (c) 2006 Itronix Inc.
* All rights reserved.
*
* Written by Iain Hibbert for Itronix Inc.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of Itronix Inc. may not be used to endorse
* or promote products derived from this software without specific
* prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
* DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
* (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
* LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
* ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
#include <sys/param.h>
#include <sys/conf.h>
#include <sys/device.h>
#include <sys/fcntl.h>
#include <sys/kernel.h>
#include <sys/queue.h>
#include <sys/malloc.h>
#include <sys/mbuf.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <netbt/bluetooth.h>
#include <netbt/l2cap.h>
#include <dev/usb/hid.h>
#include <dev/bluetooth/btdev.h>
#include <dev/bluetooth/bthid.h>
#include <dev/bluetooth/bthidev.h>
#define MAX_DESCRIPTOR_LEN 1024 /* sanity check */
/* bthidev softc */
struct bthidev_softc {
struct btdev sc_btdev; /* base device */
uint16_t sc_state;
uint16_t sc_flags;
bdaddr_t sc_laddr; /* local address */
bdaddr_t sc_raddr; /* remote address */
int sc_mode; /* link mode */
void *sc_desc; /* HID descriptor */
int sc_dlen; /* descriptor length */
uint16_t sc_ctlpsm; /* control PSM */
struct l2cap_channel *sc_ctl; /* control channel */
struct l2cap_channel *sc_ctl_l; /* control listen */
uint16_t sc_intpsm; /* interrupt PSM */
struct l2cap_channel *sc_int; /* interrupt channel */
struct l2cap_channel *sc_int_l; /* interrupt listen */
LIST_HEAD(,bthidev) sc_list; /* child list */
struct timeout sc_reconnect;
int sc_attempts; /* connection attempts */
};
/* sc_flags */
#define BTHID_RECONNECT (1 << 0) /* reconnect on link loss */
#define BTHID_CONNECTING (1 << 1) /* we are connecting */
/* device state */
#define BTHID_CLOSED 0
#define BTHID_WAIT_CTL 1
#define BTHID_WAIT_INT 2
#define BTHID_OPEN 3
#define BTHID_RETRY_INTERVAL 5 /* seconds between connection attempts */
/* bthidev internals */
void bthidev_timeout(void *);
int bthidev_listen(struct bthidev_softc *);
int bthidev_connect(struct bthidev_softc *);
int bthidev_output(struct bthidev *, uint8_t *, int);
void bthidev_null(struct bthidev *, uint8_t *, int);
/* autoconf(9) glue */
int bthidev_match(struct device *, void *, void *);
void bthidev_attach(struct device *, struct device *, void *);
int bthidev_detach(struct device *, int);
int bthidev_print(void *, const char *);
int bthidevsubmatch(struct device *parent, void *, void *);
struct cfdriver bthidev_cd = {
NULL, "bthidev", DV_DULL
};
const struct cfattach bthidev_ca = {
sizeof(struct bthidev_softc),
bthidev_match,
bthidev_attach,
bthidev_detach,
};
/* bluetooth(9) protocol methods for L2CAP */
void bthidev_connecting(void *);
void bthidev_ctl_connected(void *);
void bthidev_int_connected(void *);
void bthidev_ctl_disconnected(void *, int);
void bthidev_int_disconnected(void *, int);
void *bthidev_ctl_newconn(void *, struct sockaddr_bt *,
struct sockaddr_bt *);
void *bthidev_int_newconn(void *, struct sockaddr_bt *,
struct sockaddr_bt *);
void bthidev_complete(void *, int);
void bthidev_linkmode(void *, int);
void bthidev_input(void *, struct mbuf *);
const struct btproto bthidev_ctl_proto = {
bthidev_connecting,
bthidev_ctl_connected,
bthidev_ctl_disconnected,
bthidev_ctl_newconn,
bthidev_complete,
bthidev_linkmode,
bthidev_input,
};
const struct btproto bthidev_int_proto = {
bthidev_connecting,
bthidev_int_connected,
bthidev_int_disconnected,
bthidev_int_newconn,
bthidev_complete,
bthidev_linkmode,
bthidev_input,
};
/*****************************************************************************
*
* bthidev autoconf(9) routines
*/
int
bthidev_match(struct device *self, void *match, void *aux)
{
struct btdev_attach_args *bda = (struct btdev_attach_args *)aux;
if (bda->bd_type != BTDEV_HID)
return 0;
return 1;
}
void
bthidev_attach(struct device *parent, struct device *self, void *aux)
{
struct bthidev_softc *sc = (struct bthidev_softc *)self;
struct btdev_attach_args *bda = (struct btdev_attach_args *)aux;
struct bthidev_attach_args bha;
struct bthidev *hidev;
struct hid_data *d;
struct hid_item h;
int maxid, rep;
/*
* Init softc
*/
LIST_INIT(&sc->sc_list);
timeout_set(&sc->sc_reconnect, bthidev_timeout, sc);
sc->sc_state = BTHID_CLOSED;
sc->sc_flags = BTHID_CONNECTING;
sc->sc_ctlpsm = L2CAP_PSM_HID_CNTL;
sc->sc_intpsm = L2CAP_PSM_HID_INTR;
sc->sc_mode = 0;
/*
* copy in our configuration info
*/
bdaddr_copy(&sc->sc_laddr, &bda->bd_laddr);
bdaddr_copy(&sc->sc_raddr, &bda->bd_raddr);
if (bda->bd_mode != BTDEV_MODE_NONE) {
if (bda->bd_mode == BTDEV_MODE_AUTH) {
sc->sc_mode = L2CAP_LM_AUTH;
printf(" auth");
} else if (bda->bd_mode == BTDEV_MODE_ENCRYPT) {
sc->sc_mode = L2CAP_LM_ENCRYPT;
printf(" encrypt");
} else if (bda->bd_mode == BTDEV_MODE_SECURE) {
sc->sc_mode = L2CAP_LM_SECURE;
printf(" secure");
} else {
printf(" unknown link-mode: %d\n", bda->bd_mode);
return;
}
}
if (!L2CAP_PSM_INVALID(bda->bd_hid.hid_ctl))
sc->sc_ctlpsm = bda->bd_hid.hid_ctl;
if (!L2CAP_PSM_INVALID(bda->bd_hid.hid_int))
sc->sc_intpsm = bda->bd_hid.hid_int;
if (bda->bd_hid.hid_flags & BTHID_INITIATE)
sc->sc_flags |= BTHID_RECONNECT;
if (bda->bd_hid.hid_desc == NULL ||
bda->bd_hid.hid_dlen == 0 ||
bda->bd_hid.hid_dlen > MAX_DESCRIPTOR_LEN) {
printf(": no descriptor\n");
return;
}
sc->sc_dlen = bda->bd_hid.hid_dlen;
sc->sc_desc = malloc(bda->bd_hid.hid_dlen, M_BTHIDEV, M_WAITOK);
if (sc->sc_desc == NULL) {
printf(": no memory\n");
return;
}
if (copyin(bda->bd_hid.hid_desc, sc->sc_desc, bda->bd_hid.hid_dlen)) {
free(sc->sc_desc, M_BTHIDEV);
printf(": no descriptor");
return;
}
/*
* Parse the descriptor and attach child devices, one per report.
*/
maxid = -1;
h.report_ID = 0;
d = hid_start_parse(sc->sc_desc, sc->sc_dlen, hid_none);
while (hid_get_item(d, &h)) {
if (h.report_ID > maxid)
maxid = h.report_ID;
}
hid_end_parse(d);
if (maxid < 0) {
printf(": no reports found\n");
return;
}
printf("\n");
for (rep = 0 ; rep <= maxid ; rep++) {
if (hid_report_size(sc->sc_desc, sc->sc_dlen, hid_feature, rep) == 0
&& hid_report_size(sc->sc_desc, sc->sc_dlen, hid_input, rep) == 0
&& hid_report_size(sc->sc_desc, sc->sc_dlen, hid_output, rep) == 0)
continue;
bha.ba_desc = sc->sc_desc;
bha.ba_dlen = sc->sc_dlen;
bha.ba_input = bthidev_null;
bha.ba_feature = bthidev_null;
bha.ba_output = bthidev_output;
bha.ba_id = rep;
hidev = (struct bthidev *)config_found_sm(self, &bha,
bthidev_print, bthidevsubmatch);
if (hidev != NULL) {
hidev->sc_parent = &sc->sc_btdev;
hidev->sc_id = rep;
hidev->sc_input = bha.ba_input;
hidev->sc_feature = bha.ba_feature;
LIST_INSERT_HEAD(&sc->sc_list, hidev, sc_next);
}
}
/*
* start bluetooth connections
*/
mutex_enter(&bt_lock);
if ((sc->sc_flags & BTHID_RECONNECT) == 0)
bthidev_listen(sc);
if (sc->sc_flags & BTHID_CONNECTING)
bthidev_connect(sc);
mutex_exit(&bt_lock);
}
int
bthidev_detach(struct device *self, int flags)
{
struct bthidev_softc *sc = (struct bthidev_softc *)self;
struct bthidev *hidev;
mutex_enter(&bt_lock);
sc->sc_flags = 0; /* disable reconnecting */
/* release interrupt listen */
if (sc->sc_int_l != NULL) {
l2cap_detach(&sc->sc_int_l);
sc->sc_int_l = NULL;
}
/* release control listen */
if (sc->sc_ctl_l != NULL) {
l2cap_detach(&sc->sc_ctl_l);
sc->sc_ctl_l = NULL;
}
/* close interrupt channel */
if (sc->sc_int != NULL) {
l2cap_disconnect(sc->sc_int, 0);
l2cap_detach(&sc->sc_int);
sc->sc_int = NULL;
}
/* close control channel */
if (sc->sc_ctl != NULL) {
l2cap_disconnect(sc->sc_ctl, 0);
l2cap_detach(&sc->sc_ctl);
sc->sc_ctl = NULL;
}
/* remove timeout */
timeout_del(&sc->sc_reconnect);
mutex_exit(&bt_lock);
/* detach children */
while ((hidev = LIST_FIRST(&sc->sc_list)) != NULL) {
LIST_REMOVE(hidev, sc_next);
config_detach(&hidev->sc_dev, flags);
}
/* release descriptor */
if (sc->sc_desc != NULL) {
free(sc->sc_desc, M_BTHIDEV);
sc->sc_desc = NULL;
}
return 0;
}
/*
* bthidev config print
*/
int
bthidev_print(void *aux, const char *pnp)
{
struct bthidev_attach_args *ba = aux;
if (pnp != NULL)
printf("%s:", pnp);
if (ba->ba_id > 0)
printf(" reportid %d", ba->ba_id);
return UNCONF;
}
int
bthidevsubmatch(struct device *parent, void *match, void *aux)
{
struct bthidev_attach_args *ba = aux;
struct cfdata *cf = match;
if (cf->bthidevcf_reportid != BTHIDEV_UNK_REPORTID &&
cf->bthidevcf_reportid != ba->ba_id)
return (0);
return ((*cf->cf_attach->ca_match)(parent, cf, aux));
}
/*****************************************************************************
*
* bluetooth(4) HID attach/detach routines
*/
/*
* callouts are scheduled after connections have been lost, in order
* to clean up and reconnect.
*/
void
bthidev_timeout(void *arg)
{
struct bthidev_softc *sc = arg;
mutex_enter(&bt_lock);
switch (sc->sc_state) {
case BTHID_CLOSED:
if (sc->sc_int != NULL) {
l2cap_disconnect(sc->sc_int, 0);
break;
}
if (sc->sc_ctl != NULL) {
l2cap_disconnect(sc->sc_ctl, 0);
break;
}
if (sc->sc_flags & BTHID_RECONNECT) {
sc->sc_flags |= BTHID_CONNECTING;
bthidev_connect(sc);
break;
}
break;
case BTHID_WAIT_CTL:
break;
case BTHID_WAIT_INT:
break;
case BTHID_OPEN:
break;
default:
break;
}
mutex_exit(&bt_lock);
}
/*
* listen for our device
*/
int
bthidev_listen(struct bthidev_softc *sc)
{
struct sockaddr_bt sa;
int err;
memset(&sa, 0, sizeof(sa));
sa.bt_len = sizeof(sa);
sa.bt_family = AF_BLUETOOTH;
bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr);
/*
* Listen on control PSM
*/
err = l2cap_attach(&sc->sc_ctl_l, &bthidev_ctl_proto, sc);
if (err)
return err;
err = l2cap_setopt(sc->sc_ctl_l, SO_L2CAP_LM, &sc->sc_mode);
if (err)
return err;
sa.bt_psm = sc->sc_ctlpsm;
err = l2cap_bind(sc->sc_ctl_l, &sa);
if (err)
return err;
err = l2cap_listen(sc->sc_ctl_l);
if (err)
return err;
/*
* Listen on interrupt PSM
*/
err = l2cap_attach(&sc->sc_int_l, &bthidev_int_proto, sc);
if (err)
return err;
err = l2cap_setopt(sc->sc_int_l, SO_L2CAP_LM, &sc->sc_mode);
if (err)
return err;
sa.bt_psm = sc->sc_intpsm;
err = l2cap_bind(sc->sc_int_l, &sa);
if (err)
return err;
err = l2cap_listen(sc->sc_int_l);
if (err)
return err;
sc->sc_state = BTHID_WAIT_CTL;
return 0;
}
/*
* start connecting to our device
*/
int
bthidev_connect(struct bthidev_softc *sc)
{
struct sockaddr_bt sa;
int err;
if (sc->sc_attempts++ > 0)
printf("%s: connect (#%d)\n",
sc->sc_btdev.sc_dev.dv_xname, sc->sc_attempts);
memset(&sa, 0, sizeof(sa));
sa.bt_len = sizeof(sa);
sa.bt_family = AF_BLUETOOTH;
err = l2cap_attach(&sc->sc_ctl, &bthidev_ctl_proto, sc);
if (err) {
printf("%s: l2cap_attach failed (%d)\n",
sc->sc_btdev.sc_dev.dv_xname, err);
return err;
}
err = l2cap_setopt(sc->sc_ctl, SO_L2CAP_LM, &sc->sc_mode);
if (err)
return err;
bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr);
err = l2cap_bind(sc->sc_ctl, &sa);
if (err) {
printf("%s: l2cap_bind failed (%d)\n",
sc->sc_btdev.sc_dev.dv_xname, err);
return err;
}
sa.bt_psm = sc->sc_ctlpsm;
bdaddr_copy(&sa.bt_bdaddr, &sc->sc_raddr);
err = l2cap_connect(sc->sc_ctl, &sa);
if (err) {
printf("%s: l2cap_connect failed (%d)\n",
sc->sc_btdev.sc_dev.dv_xname, err);
return err;
}
sc->sc_state = BTHID_WAIT_CTL;
return 0;
}
/*****************************************************************************
*
* bluetooth(9) callback methods for L2CAP
*
* All these are called from Bluetooth Protocol code, in a soft
* interrupt context at IPL_SOFTNET.
*/
void
bthidev_connecting(void *arg)
{
/* don't care */
}
void
bthidev_ctl_connected(void *arg)
{
struct sockaddr_bt sa;
struct bthidev_softc *sc = arg;
int err;
if (sc->sc_state != BTHID_WAIT_CTL)
return;
KASSERT(sc->sc_ctl != NULL);
KASSERT(sc->sc_int == NULL);
if (sc->sc_flags & BTHID_CONNECTING) {
/* initiate connect on interrupt PSM */
err = l2cap_attach(&sc->sc_int, &bthidev_int_proto, sc);
if (err)
goto fail;
err = l2cap_setopt(sc->sc_int, SO_L2CAP_LM, &sc->sc_mode);
if (err)
goto fail;
memset(&sa, 0, sizeof(sa));
sa.bt_len = sizeof(sa);
sa.bt_family = AF_BLUETOOTH;
bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr);
err = l2cap_bind(sc->sc_int, &sa);
if (err)
goto fail;
sa.bt_psm = sc->sc_intpsm;
bdaddr_copy(&sa.bt_bdaddr, &sc->sc_raddr);
err = l2cap_connect(sc->sc_int, &sa);
if (err)
goto fail;
}
sc->sc_state = BTHID_WAIT_INT;
return;
fail:
l2cap_detach(&sc->sc_ctl);
sc->sc_ctl = NULL;
printf("%s: connect failed (%d)\n",
sc->sc_btdev.sc_dev.dv_xname, err);
}
void
bthidev_int_connected(void *arg)
{
struct bthidev_softc *sc = arg;
if (sc->sc_state != BTHID_WAIT_INT)
return;
KASSERT(sc->sc_ctl != NULL);
KASSERT(sc->sc_int != NULL);
sc->sc_attempts = 0;
sc->sc_flags &= ~BTHID_CONNECTING;
sc->sc_state = BTHID_OPEN;
printf("%s: connected\n", sc->sc_btdev.sc_dev.dv_xname);
}
/*
* Disconnected
*
* Depending on our state, this could mean several things, but essentially
* we are lost. If both channels are closed, and we are marked to reconnect,
* schedule another try otherwise just give up. They will contact us.
*/
void
bthidev_ctl_disconnected(void *arg, int err)
{
struct bthidev_softc *sc = arg;
if (sc->sc_ctl != NULL) {
l2cap_detach(&sc->sc_ctl);
sc->sc_ctl = NULL;
}
sc->sc_state = BTHID_CLOSED;
if (sc->sc_int == NULL) {
printf("%s: disconnected\n", sc->sc_btdev.sc_dev.dv_xname);
sc->sc_flags &= ~BTHID_CONNECTING;
if (sc->sc_flags & BTHID_RECONNECT)
timeout_add(&sc->sc_reconnect,
BTHID_RETRY_INTERVAL * hz);
else
sc->sc_state = BTHID_WAIT_CTL;
} else {
/*
* The interrupt channel should have been closed first,
* but its potentially unsafe to detach that from here.
* Give them a second to do the right thing or let the
* callout handle it.
*/
timeout_add_sec(&sc->sc_reconnect, 1);
}
}
void
bthidev_int_disconnected(void *arg, int err)
{
struct bthidev_softc *sc = arg;
if (sc->sc_int != NULL) {
l2cap_detach(&sc->sc_int);
sc->sc_int = NULL;
}
sc->sc_state = BTHID_CLOSED;
if (sc->sc_ctl == NULL) {
printf("%s: disconnected\n", sc->sc_btdev.sc_dev.dv_xname);
sc->sc_flags &= ~BTHID_CONNECTING;
if (sc->sc_flags & BTHID_RECONNECT)
timeout_add(&sc->sc_reconnect,
BTHID_RETRY_INTERVAL * hz);
else
sc->sc_state = BTHID_WAIT_CTL;
} else {
/*
* The control channel should be closing also, allow
* them a chance to do that before we force it.
*/
timeout_add_sec(&sc->sc_reconnect, 1);
}
}
/*
* New Connections
*
* We give a new L2CAP handle back if this matches the BDADDR we are
* listening for and we are in the right state. bthidev_connected will
* be called when the connection is open, so nothing else to do here
*/
void *
bthidev_ctl_newconn(void *arg, struct sockaddr_bt *laddr,
struct sockaddr_bt *raddr)
{
struct bthidev_softc *sc = arg;
if (bdaddr_same(&raddr->bt_bdaddr, &sc->sc_raddr) == 0
|| (sc->sc_flags & BTHID_CONNECTING)
|| sc->sc_state != BTHID_WAIT_CTL
|| sc->sc_ctl != NULL
|| sc->sc_int != NULL)
return NULL;
l2cap_attach(&sc->sc_ctl, &bthidev_ctl_proto, sc);
return sc->sc_ctl;
}
void *
bthidev_int_newconn(void *arg, struct sockaddr_bt *laddr,
struct sockaddr_bt *raddr)
{
struct bthidev_softc *sc = arg;
if (bdaddr_same(&raddr->bt_bdaddr, &sc->sc_raddr) == 0
|| (sc->sc_flags & BTHID_CONNECTING)
|| sc->sc_state != BTHID_WAIT_INT
|| sc->sc_ctl == NULL
|| sc->sc_int != NULL)
return NULL;
l2cap_attach(&sc->sc_int, &bthidev_int_proto, sc);
return sc->sc_int;
}
void
bthidev_complete(void *arg, int count)
{
/* dont care */
}
void
bthidev_linkmode(void *arg, int new)
{
struct bthidev_softc *sc = arg;
if ((sc->sc_mode & L2CAP_LM_AUTH) && !(new & L2CAP_LM_AUTH))
printf("%s: auth failed\n", sc->sc_btdev.sc_dev.dv_xname);
else if ((sc->sc_mode & L2CAP_LM_ENCRYPT) && !(new & L2CAP_LM_ENCRYPT))
printf("%s: encrypt off\n", sc->sc_btdev.sc_dev.dv_xname);
else if ((sc->sc_mode & L2CAP_LM_SECURE) && !(new & L2CAP_LM_SECURE))
printf("%s: insecure\n", sc->sc_btdev.sc_dev.dv_xname);
else
return;
if (sc->sc_int != NULL)
l2cap_disconnect(sc->sc_int, 0);
if (sc->sc_ctl != NULL)
l2cap_disconnect(sc->sc_ctl, 0);
}
/*
* Receive reports from the protocol stack.
*/
void
bthidev_input(void *arg, struct mbuf *m)
{
struct bthidev_softc *sc = arg;
struct bthidev *hidev;
uint8_t *data;
int len;
if (sc->sc_state != BTHID_OPEN)
goto release;
if (m->m_pkthdr.len > m->m_len)
printf("%s: truncating HID report\n",
sc->sc_btdev.sc_dev.dv_xname);
len = m->m_len;
data = mtod(m, uint8_t *);
if (BTHID_TYPE(data[0]) == BTHID_DATA) {
/*
* data[0] == type / parameter
* data[1] == id
* data[2..len] == report
*/
if (len < 3)
goto release;
LIST_FOREACH(hidev, &sc->sc_list, sc_next) {
if (data[1] == hidev->sc_id) {
switch (BTHID_DATA_PARAM(data[0])) {
case BTHID_DATA_INPUT:
(*hidev->sc_input)(hidev, data + 2, len - 2);
break;
case BTHID_DATA_FEATURE:
(*hidev->sc_feature)(hidev, data + 2, len - 2);
break;
default:
break;
}
goto release;
}
}
printf("%s: report id %d, len = %d ignored\n",
sc->sc_btdev.sc_dev.dv_xname, data[1], len - 2);
goto release;
}
if (BTHID_TYPE(data[0]) == BTHID_CONTROL) {
if (len < 1)
goto release;
if (BTHID_DATA_PARAM(data[0]) == BTHID_CONTROL_UNPLUG) {
printf("%s: unplugged\n",
sc->sc_btdev.sc_dev.dv_xname);
/* close interrupt channel */
if (sc->sc_int != NULL) {
l2cap_disconnect(sc->sc_int, 0);
l2cap_detach(&sc->sc_int);
sc->sc_int = NULL;
}
/* close control channel */
if (sc->sc_ctl != NULL) {
l2cap_disconnect(sc->sc_ctl, 0);
l2cap_detach(&sc->sc_ctl);
sc->sc_ctl = NULL;
}
}
goto release;
}
release:
m_freem(m);
}
/*****************************************************************************
*
* IO routines
*/
void
bthidev_null(struct bthidev *hidev, uint8_t *report, int len)
{
/*
* empty routine just in case the device
* provided no method to handle this report
*/
}
int
bthidev_output(struct bthidev *hidev, uint8_t *report, int rlen)
{
struct bthidev_softc *sc = (struct bthidev_softc *)hidev->sc_parent;
struct mbuf *m;
int err;
if (sc == NULL || sc->sc_state != BTHID_OPEN)
return ENOTCONN;
KASSERT(sc->sc_ctl != NULL);
KASSERT(sc->sc_int != NULL);
if (rlen == 0 || report == NULL)
return 0;
if (rlen > MHLEN - 2) {
printf("%s: output report too long (%d)!\n",
sc->sc_btdev.sc_dev.dv_xname, rlen);
return EMSGSIZE;
}
m = m_gethdr(M_DONTWAIT, MT_DATA);
if (m == NULL)
return ENOMEM;
/*
* data[0] = type / parameter
* data[1] = id
* data[2..N] = report
*/
mtod(m, uint8_t *)[0] = (uint8_t)((BTHID_DATA << 4) | BTHID_DATA_OUTPUT);
mtod(m, uint8_t *)[1] = hidev->sc_id;
memcpy(mtod(m, uint8_t *) + 2, report, rlen);
m->m_pkthdr.len = m->m_len = rlen + 2;
mutex_enter(&bt_lock);
err = l2cap_send(sc->sc_int, m);
mutex_exit(&bt_lock);
return err;
}