bthidev.c revision 1.1.2.4
1 1.1.2.4 yamt /* $NetBSD: bthidev.c,v 1.1.2.4 2007/09/03 14:33:30 yamt Exp $ */ 2 1.1.2.2 yamt 3 1.1.2.2 yamt /*- 4 1.1.2.2 yamt * Copyright (c) 2006 Itronix Inc. 5 1.1.2.2 yamt * All rights reserved. 6 1.1.2.2 yamt * 7 1.1.2.2 yamt * Written by Iain Hibbert for Itronix Inc. 8 1.1.2.2 yamt * 9 1.1.2.2 yamt * Redistribution and use in source and binary forms, with or without 10 1.1.2.2 yamt * modification, are permitted provided that the following conditions 11 1.1.2.2 yamt * are met: 12 1.1.2.2 yamt * 1. Redistributions of source code must retain the above copyright 13 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer. 14 1.1.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 15 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer in the 16 1.1.2.2 yamt * documentation and/or other materials provided with the distribution. 17 1.1.2.2 yamt * 3. The name of Itronix Inc. may not be used to endorse 18 1.1.2.2 yamt * or promote products derived from this software without specific 19 1.1.2.2 yamt * prior written permission. 20 1.1.2.2 yamt * 21 1.1.2.2 yamt * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 22 1.1.2.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 23 1.1.2.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 24 1.1.2.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 25 1.1.2.2 yamt * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 26 1.1.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 27 1.1.2.2 yamt * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 28 1.1.2.2 yamt * ON ANY THEORY OF LIABILITY, WHETHER IN 29 1.1.2.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 30 1.1.2.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 31 1.1.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 32 1.1.2.2 yamt */ 33 1.1.2.2 yamt 34 1.1.2.2 yamt #include <sys/cdefs.h> 35 1.1.2.4 yamt __KERNEL_RCSID(0, "$NetBSD: bthidev.c,v 1.1.2.4 2007/09/03 14:33:30 yamt Exp $"); 36 1.1.2.2 yamt 37 1.1.2.2 yamt #include <sys/param.h> 38 1.1.2.2 yamt #include <sys/conf.h> 39 1.1.2.2 yamt #include <sys/device.h> 40 1.1.2.2 yamt #include <sys/fcntl.h> 41 1.1.2.2 yamt #include <sys/kernel.h> 42 1.1.2.2 yamt #include <sys/queue.h> 43 1.1.2.2 yamt #include <sys/malloc.h> 44 1.1.2.2 yamt #include <sys/mbuf.h> 45 1.1.2.2 yamt #include <sys/proc.h> 46 1.1.2.2 yamt #include <sys/systm.h> 47 1.1.2.2 yamt 48 1.1.2.3 yamt #include <prop/proplib.h> 49 1.1.2.3 yamt 50 1.1.2.2 yamt #include <netbt/bluetooth.h> 51 1.1.2.2 yamt #include <netbt/l2cap.h> 52 1.1.2.2 yamt 53 1.1.2.2 yamt #include <dev/usb/hid.h> 54 1.1.2.2 yamt #include <dev/bluetooth/btdev.h> 55 1.1.2.2 yamt #include <dev/bluetooth/bthid.h> 56 1.1.2.2 yamt #include <dev/bluetooth/bthidev.h> 57 1.1.2.2 yamt 58 1.1.2.2 yamt #include "locators.h" 59 1.1.2.2 yamt 60 1.1.2.2 yamt /***************************************************************************** 61 1.1.2.2 yamt * 62 1.1.2.2 yamt * Bluetooth HID device 63 1.1.2.2 yamt */ 64 1.1.2.2 yamt 65 1.1.2.2 yamt #define MAX_DESCRIPTOR_LEN 1024 /* sanity check */ 66 1.1.2.2 yamt 67 1.1.2.2 yamt /* bthidev softc */ 68 1.1.2.2 yamt struct bthidev_softc { 69 1.1.2.3 yamt struct btdev sc_btdev; 70 1.1.2.2 yamt uint16_t sc_state; 71 1.1.2.2 yamt uint16_t sc_flags; 72 1.1.2.2 yamt 73 1.1.2.2 yamt bdaddr_t sc_laddr; /* local address */ 74 1.1.2.2 yamt bdaddr_t sc_raddr; /* remote address */ 75 1.1.2.4 yamt int sc_mode; /* link mode */ 76 1.1.2.2 yamt 77 1.1.2.2 yamt uint16_t sc_ctlpsm; /* control PSM */ 78 1.1.2.2 yamt struct l2cap_channel *sc_ctl; /* control channel */ 79 1.1.2.2 yamt struct l2cap_channel *sc_ctl_l; /* control listen */ 80 1.1.2.2 yamt 81 1.1.2.2 yamt uint16_t sc_intpsm; /* interrupt PSM */ 82 1.1.2.2 yamt struct l2cap_channel *sc_int; /* interrupt channel */ 83 1.1.2.2 yamt struct l2cap_channel *sc_int_l; /* interrupt listen */ 84 1.1.2.2 yamt 85 1.1.2.2 yamt LIST_HEAD(,bthidev) sc_list; /* child list */ 86 1.1.2.2 yamt 87 1.1.2.2 yamt struct callout sc_reconnect; 88 1.1.2.2 yamt int sc_attempts; /* connection attempts */ 89 1.1.2.2 yamt }; 90 1.1.2.2 yamt 91 1.1.2.3 yamt /* sc_flags */ 92 1.1.2.3 yamt #define BTHID_RECONNECT (1 << 0) /* reconnect on link loss */ 93 1.1.2.3 yamt #define BTHID_CONNECTING (1 << 1) /* we are connecting */ 94 1.1.2.3 yamt 95 1.1.2.2 yamt /* device state */ 96 1.1.2.2 yamt #define BTHID_CLOSED 0 97 1.1.2.2 yamt #define BTHID_WAIT_CTL 1 98 1.1.2.2 yamt #define BTHID_WAIT_INT 2 99 1.1.2.2 yamt #define BTHID_OPEN 3 100 1.1.2.2 yamt #define BTHID_DETACHING 4 101 1.1.2.2 yamt 102 1.1.2.2 yamt #define BTHID_RETRY_INTERVAL 5 /* seconds between connection attempts */ 103 1.1.2.2 yamt 104 1.1.2.2 yamt /* bthidev internals */ 105 1.1.2.2 yamt static void bthidev_timeout(void *); 106 1.1.2.2 yamt static int bthidev_listen(struct bthidev_softc *); 107 1.1.2.2 yamt static int bthidev_connect(struct bthidev_softc *); 108 1.1.2.2 yamt static int bthidev_output(struct bthidev *, uint8_t *, int); 109 1.1.2.2 yamt static void bthidev_null(struct bthidev *, uint8_t *, int); 110 1.1.2.2 yamt 111 1.1.2.2 yamt /* autoconf(9) glue */ 112 1.1.2.2 yamt static int bthidev_match(struct device *, struct cfdata *, void *); 113 1.1.2.2 yamt static void bthidev_attach(struct device *, struct device *, void *); 114 1.1.2.2 yamt static int bthidev_detach(struct device *, int); 115 1.1.2.2 yamt static int bthidev_print(void *, const char *); 116 1.1.2.2 yamt 117 1.1.2.2 yamt CFATTACH_DECL(bthidev, sizeof(struct bthidev_softc), 118 1.1.2.2 yamt bthidev_match, bthidev_attach, bthidev_detach, NULL); 119 1.1.2.2 yamt 120 1.1.2.2 yamt /* bluetooth(9) protocol methods for L2CAP */ 121 1.1.2.2 yamt static void bthidev_connecting(void *); 122 1.1.2.2 yamt static void bthidev_ctl_connected(void *); 123 1.1.2.2 yamt static void bthidev_int_connected(void *); 124 1.1.2.2 yamt static void bthidev_ctl_disconnected(void *, int); 125 1.1.2.2 yamt static void bthidev_int_disconnected(void *, int); 126 1.1.2.2 yamt static void *bthidev_ctl_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *); 127 1.1.2.2 yamt static void *bthidev_int_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *); 128 1.1.2.2 yamt static void bthidev_complete(void *, int); 129 1.1.2.4 yamt static void bthidev_linkmode(void *, int); 130 1.1.2.2 yamt static void bthidev_input(void *, struct mbuf *); 131 1.1.2.2 yamt 132 1.1.2.2 yamt static const struct btproto bthidev_ctl_proto = { 133 1.1.2.2 yamt bthidev_connecting, 134 1.1.2.2 yamt bthidev_ctl_connected, 135 1.1.2.2 yamt bthidev_ctl_disconnected, 136 1.1.2.2 yamt bthidev_ctl_newconn, 137 1.1.2.2 yamt bthidev_complete, 138 1.1.2.4 yamt bthidev_linkmode, 139 1.1.2.2 yamt bthidev_input, 140 1.1.2.2 yamt }; 141 1.1.2.2 yamt 142 1.1.2.2 yamt static const struct btproto bthidev_int_proto = { 143 1.1.2.2 yamt bthidev_connecting, 144 1.1.2.2 yamt bthidev_int_connected, 145 1.1.2.2 yamt bthidev_int_disconnected, 146 1.1.2.2 yamt bthidev_int_newconn, 147 1.1.2.2 yamt bthidev_complete, 148 1.1.2.4 yamt bthidev_linkmode, 149 1.1.2.2 yamt bthidev_input, 150 1.1.2.2 yamt }; 151 1.1.2.2 yamt 152 1.1.2.2 yamt /***************************************************************************** 153 1.1.2.2 yamt * 154 1.1.2.2 yamt * bthidev autoconf(9) routines 155 1.1.2.2 yamt */ 156 1.1.2.2 yamt 157 1.1.2.2 yamt static int 158 1.1.2.3 yamt bthidev_match(struct device *self, struct cfdata *cfdata, 159 1.1.2.3 yamt void *aux) 160 1.1.2.2 yamt { 161 1.1.2.3 yamt prop_dictionary_t dict = aux; 162 1.1.2.3 yamt prop_object_t obj; 163 1.1.2.2 yamt 164 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTDEVservice); 165 1.1.2.3 yamt if (prop_string_equals_cstring(obj, "HID")) 166 1.1.2.3 yamt return 1; 167 1.1.2.2 yamt 168 1.1.2.3 yamt return 0; 169 1.1.2.2 yamt } 170 1.1.2.2 yamt 171 1.1.2.2 yamt static void 172 1.1.2.2 yamt bthidev_attach(struct device *parent, struct device *self, void *aux) 173 1.1.2.2 yamt { 174 1.1.2.2 yamt struct bthidev_softc *sc = (struct bthidev_softc *)self; 175 1.1.2.3 yamt prop_dictionary_t dict = aux; 176 1.1.2.3 yamt prop_object_t obj; 177 1.1.2.2 yamt struct bthidev_attach_args bha; 178 1.1.2.2 yamt struct bthidev *dev; 179 1.1.2.2 yamt struct hid_data *d; 180 1.1.2.2 yamt struct hid_item h; 181 1.1.2.3 yamt const void *desc; 182 1.1.2.2 yamt int locs[BTHIDBUSCF_NLOCS]; 183 1.1.2.3 yamt int maxid, rep, s, dlen; 184 1.1.2.2 yamt 185 1.1.2.2 yamt /* 186 1.1.2.2 yamt * Init softc 187 1.1.2.2 yamt */ 188 1.1.2.2 yamt LIST_INIT(&sc->sc_list); 189 1.1.2.4 yamt callout_init(&sc->sc_reconnect, 0); 190 1.1.2.2 yamt callout_setfunc(&sc->sc_reconnect, bthidev_timeout, sc); 191 1.1.2.2 yamt sc->sc_state = BTHID_CLOSED; 192 1.1.2.3 yamt sc->sc_flags = BTHID_CONNECTING; 193 1.1.2.3 yamt sc->sc_ctlpsm = L2CAP_PSM_HID_CNTL; 194 1.1.2.3 yamt sc->sc_intpsm = L2CAP_PSM_HID_INTR; 195 1.1.2.2 yamt 196 1.1.2.2 yamt /* 197 1.1.2.3 yamt * extract config from proplist 198 1.1.2.2 yamt */ 199 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTDEVladdr); 200 1.1.2.3 yamt bdaddr_copy(&sc->sc_laddr, prop_data_data_nocopy(obj)); 201 1.1.2.2 yamt 202 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTDEVraddr); 203 1.1.2.3 yamt bdaddr_copy(&sc->sc_raddr, prop_data_data_nocopy(obj)); 204 1.1.2.2 yamt 205 1.1.2.4 yamt obj = prop_dictionary_get(dict, BTDEVmode); 206 1.1.2.4 yamt if (prop_object_type(obj) == PROP_TYPE_STRING) { 207 1.1.2.4 yamt if (prop_string_equals_cstring(obj, BTDEVauth)) 208 1.1.2.4 yamt sc->sc_mode = L2CAP_LM_AUTH; 209 1.1.2.4 yamt else if (prop_string_equals_cstring(obj, BTDEVencrypt)) 210 1.1.2.4 yamt sc->sc_mode = L2CAP_LM_ENCRYPT; 211 1.1.2.4 yamt else if (prop_string_equals_cstring(obj, BTDEVsecure)) 212 1.1.2.4 yamt sc->sc_mode = L2CAP_LM_SECURE; 213 1.1.2.4 yamt else { 214 1.1.2.4 yamt aprint_error(" unknown %s\n", BTDEVmode); 215 1.1.2.4 yamt return; 216 1.1.2.4 yamt } 217 1.1.2.4 yamt 218 1.1.2.4 yamt aprint_verbose(" %s %s", BTDEVmode, 219 1.1.2.4 yamt prop_string_cstring_nocopy(obj)); 220 1.1.2.4 yamt } 221 1.1.2.4 yamt 222 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTHIDEVcontrolpsm); 223 1.1.2.3 yamt if (prop_object_type(obj) == PROP_TYPE_NUMBER) { 224 1.1.2.3 yamt sc->sc_ctlpsm = prop_number_integer_value(obj); 225 1.1.2.3 yamt if (L2CAP_PSM_INVALID(sc->sc_ctlpsm)) { 226 1.1.2.3 yamt aprint_error(" invalid %s\n", BTHIDEVcontrolpsm); 227 1.1.2.3 yamt return; 228 1.1.2.3 yamt } 229 1.1.2.3 yamt } 230 1.1.2.3 yamt 231 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTHIDEVinterruptpsm); 232 1.1.2.3 yamt if (prop_object_type(obj) == PROP_TYPE_NUMBER) { 233 1.1.2.3 yamt sc->sc_intpsm = prop_number_integer_value(obj); 234 1.1.2.3 yamt if (L2CAP_PSM_INVALID(sc->sc_intpsm)) { 235 1.1.2.3 yamt aprint_error(" invalid %s\n", BTHIDEVinterruptpsm); 236 1.1.2.3 yamt return; 237 1.1.2.3 yamt } 238 1.1.2.3 yamt } 239 1.1.2.3 yamt 240 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTHIDEVdescriptor); 241 1.1.2.3 yamt if (prop_object_type(obj) == PROP_TYPE_DATA) { 242 1.1.2.3 yamt dlen = prop_data_size(obj); 243 1.1.2.3 yamt desc = prop_data_data_nocopy(obj); 244 1.1.2.3 yamt } else { 245 1.1.2.3 yamt aprint_error(" no %s\n", BTHIDEVdescriptor); 246 1.1.2.2 yamt return; 247 1.1.2.2 yamt } 248 1.1.2.3 yamt 249 1.1.2.3 yamt obj = prop_dictionary_get(dict, BTHIDEVreconnect); 250 1.1.2.3 yamt if (prop_object_type(obj) == PROP_TYPE_BOOL 251 1.1.2.3 yamt && !prop_bool_true(obj)) 252 1.1.2.3 yamt sc->sc_flags |= BTHID_RECONNECT; 253 1.1.2.2 yamt 254 1.1.2.2 yamt /* 255 1.1.2.2 yamt * Parse the descriptor and attach child devices, one per report. 256 1.1.2.2 yamt */ 257 1.1.2.2 yamt maxid = -1; 258 1.1.2.2 yamt h.report_ID = 0; 259 1.1.2.3 yamt d = hid_start_parse(desc, dlen, hid_none); 260 1.1.2.2 yamt while (hid_get_item(d, &h)) { 261 1.1.2.2 yamt if (h.report_ID > maxid) 262 1.1.2.2 yamt maxid = h.report_ID; 263 1.1.2.2 yamt } 264 1.1.2.2 yamt hid_end_parse(d); 265 1.1.2.2 yamt 266 1.1.2.2 yamt if (maxid < 0) { 267 1.1.2.2 yamt aprint_error(" no reports found\n"); 268 1.1.2.2 yamt return; 269 1.1.2.2 yamt } 270 1.1.2.2 yamt 271 1.1.2.2 yamt aprint_normal("\n"); 272 1.1.2.2 yamt 273 1.1.2.2 yamt for (rep = 0 ; rep <= maxid ; rep++) { 274 1.1.2.3 yamt if (hid_report_size(desc, dlen, hid_feature, rep) == 0 275 1.1.2.3 yamt && hid_report_size(desc, dlen, hid_input, rep) == 0 276 1.1.2.3 yamt && hid_report_size(desc, dlen, hid_output, rep) == 0) 277 1.1.2.2 yamt continue; 278 1.1.2.2 yamt 279 1.1.2.3 yamt bha.ba_desc = desc; 280 1.1.2.3 yamt bha.ba_dlen = dlen; 281 1.1.2.2 yamt bha.ba_input = bthidev_null; 282 1.1.2.2 yamt bha.ba_feature = bthidev_null; 283 1.1.2.2 yamt bha.ba_output = bthidev_output; 284 1.1.2.2 yamt bha.ba_id = rep; 285 1.1.2.2 yamt 286 1.1.2.2 yamt locs[BTHIDBUSCF_REPORTID] = rep; 287 1.1.2.2 yamt 288 1.1.2.2 yamt dev = (struct bthidev *)config_found_sm_loc((struct device *)sc, "bthidbus", 289 1.1.2.2 yamt locs, &bha, bthidev_print, config_stdsubmatch); 290 1.1.2.2 yamt if (dev != NULL) { 291 1.1.2.3 yamt dev->sc_parent = (struct device *)sc; 292 1.1.2.2 yamt dev->sc_id = rep; 293 1.1.2.2 yamt dev->sc_input = bha.ba_input; 294 1.1.2.2 yamt dev->sc_feature = bha.ba_feature; 295 1.1.2.2 yamt LIST_INSERT_HEAD(&sc->sc_list, dev, sc_next); 296 1.1.2.2 yamt } 297 1.1.2.2 yamt } 298 1.1.2.2 yamt 299 1.1.2.2 yamt /* 300 1.1.2.2 yamt * start bluetooth connections 301 1.1.2.2 yamt */ 302 1.1.2.2 yamt s = splsoftnet(); 303 1.1.2.3 yamt if ((sc->sc_flags & BTHID_RECONNECT) == 0) 304 1.1.2.2 yamt bthidev_listen(sc); 305 1.1.2.2 yamt 306 1.1.2.3 yamt if (sc->sc_flags & BTHID_CONNECTING) 307 1.1.2.2 yamt bthidev_connect(sc); 308 1.1.2.2 yamt splx(s); 309 1.1.2.2 yamt } 310 1.1.2.2 yamt 311 1.1.2.2 yamt static int 312 1.1.2.2 yamt bthidev_detach(struct device *self, int flags) 313 1.1.2.2 yamt { 314 1.1.2.2 yamt struct bthidev_softc *sc = (struct bthidev_softc *)self; 315 1.1.2.2 yamt struct bthidev *dev; 316 1.1.2.2 yamt int s; 317 1.1.2.2 yamt 318 1.1.2.2 yamt s = splsoftnet(); 319 1.1.2.2 yamt sc->sc_flags = 0; /* disable reconnecting */ 320 1.1.2.2 yamt 321 1.1.2.2 yamt /* release interrupt listen */ 322 1.1.2.2 yamt if (sc->sc_int_l != NULL) { 323 1.1.2.2 yamt l2cap_detach(&sc->sc_int_l); 324 1.1.2.2 yamt sc->sc_int_l = NULL; 325 1.1.2.2 yamt } 326 1.1.2.2 yamt 327 1.1.2.2 yamt /* release control listen */ 328 1.1.2.2 yamt if (sc->sc_ctl_l != NULL) { 329 1.1.2.2 yamt l2cap_detach(&sc->sc_ctl_l); 330 1.1.2.2 yamt sc->sc_ctl_l = NULL; 331 1.1.2.2 yamt } 332 1.1.2.2 yamt 333 1.1.2.2 yamt /* close interrupt channel */ 334 1.1.2.2 yamt if (sc->sc_int != NULL) { 335 1.1.2.2 yamt l2cap_disconnect(sc->sc_int, 0); 336 1.1.2.2 yamt l2cap_detach(&sc->sc_int); 337 1.1.2.2 yamt sc->sc_int = NULL; 338 1.1.2.2 yamt } 339 1.1.2.2 yamt 340 1.1.2.2 yamt /* close control channel */ 341 1.1.2.2 yamt if (sc->sc_ctl != NULL) { 342 1.1.2.2 yamt l2cap_disconnect(sc->sc_ctl, 0); 343 1.1.2.2 yamt l2cap_detach(&sc->sc_ctl); 344 1.1.2.2 yamt sc->sc_ctl = NULL; 345 1.1.2.2 yamt } 346 1.1.2.2 yamt 347 1.1.2.2 yamt /* remove callout */ 348 1.1.2.2 yamt sc->sc_state = BTHID_DETACHING; 349 1.1.2.2 yamt callout_stop(&sc->sc_reconnect); 350 1.1.2.2 yamt if (callout_invoking(&sc->sc_reconnect)) 351 1.1.2.2 yamt tsleep(sc, PWAIT, "bthidetach", 0); 352 1.1.2.2 yamt 353 1.1.2.2 yamt splx(s); 354 1.1.2.2 yamt 355 1.1.2.2 yamt /* detach children */ 356 1.1.2.2 yamt while ((dev = LIST_FIRST(&sc->sc_list)) != NULL) { 357 1.1.2.2 yamt LIST_REMOVE(dev, sc_next); 358 1.1.2.3 yamt config_detach((struct device *)dev, flags); 359 1.1.2.2 yamt } 360 1.1.2.2 yamt 361 1.1.2.2 yamt return 0; 362 1.1.2.2 yamt } 363 1.1.2.2 yamt 364 1.1.2.2 yamt /* 365 1.1.2.2 yamt * bthidev config print 366 1.1.2.2 yamt */ 367 1.1.2.2 yamt static int 368 1.1.2.2 yamt bthidev_print(void *aux, const char *pnp) 369 1.1.2.2 yamt { 370 1.1.2.2 yamt struct bthidev_attach_args *ba = aux; 371 1.1.2.2 yamt 372 1.1.2.2 yamt if (pnp != NULL) 373 1.1.2.2 yamt aprint_normal("%s:", pnp); 374 1.1.2.2 yamt 375 1.1.2.2 yamt if (ba->ba_id > 0) 376 1.1.2.2 yamt aprint_normal(" reportid %d", ba->ba_id); 377 1.1.2.2 yamt 378 1.1.2.2 yamt return UNCONF; 379 1.1.2.2 yamt } 380 1.1.2.2 yamt 381 1.1.2.2 yamt /***************************************************************************** 382 1.1.2.2 yamt * 383 1.1.2.2 yamt * bluetooth(4) HID attach/detach routines 384 1.1.2.2 yamt */ 385 1.1.2.2 yamt 386 1.1.2.2 yamt /* 387 1.1.2.3 yamt * callouts are scheduled after connections have been lost, in order 388 1.1.2.3 yamt * to clean up and reconnect. 389 1.1.2.2 yamt */ 390 1.1.2.2 yamt static void 391 1.1.2.2 yamt bthidev_timeout(void *arg) 392 1.1.2.2 yamt { 393 1.1.2.2 yamt struct bthidev_softc *sc = arg; 394 1.1.2.3 yamt int s; 395 1.1.2.2 yamt 396 1.1.2.2 yamt s = splsoftnet(); 397 1.1.2.2 yamt callout_ack(&sc->sc_reconnect); 398 1.1.2.2 yamt 399 1.1.2.2 yamt switch (sc->sc_state) { 400 1.1.2.2 yamt case BTHID_CLOSED: 401 1.1.2.3 yamt if (sc->sc_int != NULL) { 402 1.1.2.3 yamt l2cap_disconnect(sc->sc_int, 0); 403 1.1.2.3 yamt break; 404 1.1.2.3 yamt } 405 1.1.2.3 yamt 406 1.1.2.3 yamt if (sc->sc_ctl != NULL) { 407 1.1.2.3 yamt l2cap_disconnect(sc->sc_ctl, 0); 408 1.1.2.3 yamt break; 409 1.1.2.3 yamt } 410 1.1.2.3 yamt 411 1.1.2.3 yamt if (sc->sc_flags & BTHID_RECONNECT) { 412 1.1.2.3 yamt sc->sc_flags |= BTHID_CONNECTING; 413 1.1.2.3 yamt bthidev_connect(sc); 414 1.1.2.3 yamt break; 415 1.1.2.3 yamt } 416 1.1.2.3 yamt 417 1.1.2.2 yamt break; 418 1.1.2.2 yamt 419 1.1.2.2 yamt case BTHID_WAIT_CTL: 420 1.1.2.2 yamt break; 421 1.1.2.2 yamt 422 1.1.2.2 yamt case BTHID_WAIT_INT: 423 1.1.2.2 yamt break; 424 1.1.2.2 yamt 425 1.1.2.2 yamt case BTHID_OPEN: 426 1.1.2.2 yamt break; 427 1.1.2.2 yamt 428 1.1.2.2 yamt case BTHID_DETACHING: 429 1.1.2.2 yamt wakeup(sc); 430 1.1.2.2 yamt break; 431 1.1.2.2 yamt 432 1.1.2.2 yamt default: 433 1.1.2.2 yamt break; 434 1.1.2.2 yamt } 435 1.1.2.2 yamt splx(s); 436 1.1.2.2 yamt } 437 1.1.2.2 yamt 438 1.1.2.2 yamt /* 439 1.1.2.2 yamt * listen for our device 440 1.1.2.2 yamt */ 441 1.1.2.2 yamt static int 442 1.1.2.2 yamt bthidev_listen(struct bthidev_softc *sc) 443 1.1.2.2 yamt { 444 1.1.2.2 yamt struct sockaddr_bt sa; 445 1.1.2.2 yamt int err; 446 1.1.2.2 yamt 447 1.1.2.2 yamt memset(&sa, 0, sizeof(sa)); 448 1.1.2.2 yamt sa.bt_len = sizeof(sa); 449 1.1.2.2 yamt sa.bt_family = AF_BLUETOOTH; 450 1.1.2.2 yamt bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr); 451 1.1.2.2 yamt 452 1.1.2.2 yamt /* 453 1.1.2.2 yamt * Listen on control PSM 454 1.1.2.2 yamt */ 455 1.1.2.2 yamt err = l2cap_attach(&sc->sc_ctl_l, &bthidev_ctl_proto, sc); 456 1.1.2.2 yamt if (err) 457 1.1.2.2 yamt return err; 458 1.1.2.2 yamt 459 1.1.2.4 yamt err = l2cap_setopt(sc->sc_ctl_l, SO_L2CAP_LM, &sc->sc_mode); 460 1.1.2.4 yamt if (err) 461 1.1.2.4 yamt return err; 462 1.1.2.4 yamt 463 1.1.2.2 yamt sa.bt_psm = sc->sc_ctlpsm; 464 1.1.2.2 yamt err = l2cap_bind(sc->sc_ctl_l, &sa); 465 1.1.2.2 yamt if (err) 466 1.1.2.2 yamt return err; 467 1.1.2.2 yamt 468 1.1.2.2 yamt err = l2cap_listen(sc->sc_ctl_l); 469 1.1.2.2 yamt if (err) 470 1.1.2.2 yamt return err; 471 1.1.2.2 yamt 472 1.1.2.2 yamt /* 473 1.1.2.2 yamt * Listen on interrupt PSM 474 1.1.2.2 yamt */ 475 1.1.2.2 yamt err = l2cap_attach(&sc->sc_int_l, &bthidev_int_proto, sc); 476 1.1.2.2 yamt if (err) 477 1.1.2.2 yamt return err; 478 1.1.2.2 yamt 479 1.1.2.4 yamt err = l2cap_setopt(sc->sc_int_l, SO_L2CAP_LM, &sc->sc_mode); 480 1.1.2.4 yamt if (err) 481 1.1.2.4 yamt return err; 482 1.1.2.4 yamt 483 1.1.2.2 yamt sa.bt_psm = sc->sc_intpsm; 484 1.1.2.2 yamt err = l2cap_bind(sc->sc_int_l, &sa); 485 1.1.2.2 yamt if (err) 486 1.1.2.2 yamt return err; 487 1.1.2.2 yamt 488 1.1.2.2 yamt err = l2cap_listen(sc->sc_int_l); 489 1.1.2.2 yamt if (err) 490 1.1.2.2 yamt return err; 491 1.1.2.2 yamt 492 1.1.2.2 yamt sc->sc_state = BTHID_WAIT_CTL; 493 1.1.2.2 yamt return 0; 494 1.1.2.2 yamt } 495 1.1.2.2 yamt 496 1.1.2.2 yamt /* 497 1.1.2.2 yamt * start connecting to our device 498 1.1.2.2 yamt */ 499 1.1.2.2 yamt static int 500 1.1.2.2 yamt bthidev_connect(struct bthidev_softc *sc) 501 1.1.2.2 yamt { 502 1.1.2.2 yamt struct sockaddr_bt sa; 503 1.1.2.2 yamt int err; 504 1.1.2.2 yamt 505 1.1.2.2 yamt if (sc->sc_attempts++ > 0) 506 1.1.2.3 yamt printf("%s: connect (#%d)\n", 507 1.1.2.3 yamt device_xname((struct device *)sc), sc->sc_attempts); 508 1.1.2.2 yamt 509 1.1.2.2 yamt memset(&sa, 0, sizeof(sa)); 510 1.1.2.2 yamt sa.bt_len = sizeof(sa); 511 1.1.2.2 yamt sa.bt_family = AF_BLUETOOTH; 512 1.1.2.2 yamt 513 1.1.2.2 yamt err = l2cap_attach(&sc->sc_ctl, &bthidev_ctl_proto, sc); 514 1.1.2.2 yamt if (err) { 515 1.1.2.3 yamt printf("%s: l2cap_attach failed (%d)\n", 516 1.1.2.3 yamt device_xname((struct device *)sc), err); 517 1.1.2.2 yamt return err; 518 1.1.2.2 yamt } 519 1.1.2.2 yamt 520 1.1.2.4 yamt err = l2cap_setopt(sc->sc_ctl, SO_L2CAP_LM, &sc->sc_mode); 521 1.1.2.4 yamt if (err) 522 1.1.2.4 yamt return err; 523 1.1.2.4 yamt 524 1.1.2.2 yamt bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr); 525 1.1.2.2 yamt err = l2cap_bind(sc->sc_ctl, &sa); 526 1.1.2.2 yamt if (err) { 527 1.1.2.3 yamt printf("%s: l2cap_bind failed (%d)\n", 528 1.1.2.3 yamt device_xname((struct device *)sc), err); 529 1.1.2.2 yamt return err; 530 1.1.2.2 yamt } 531 1.1.2.2 yamt 532 1.1.2.2 yamt sa.bt_psm = sc->sc_ctlpsm; 533 1.1.2.2 yamt bdaddr_copy(&sa.bt_bdaddr, &sc->sc_raddr); 534 1.1.2.2 yamt err = l2cap_connect(sc->sc_ctl, &sa); 535 1.1.2.2 yamt if (err) { 536 1.1.2.3 yamt printf("%s: l2cap_connect failed (%d)\n", 537 1.1.2.3 yamt device_xname((struct device *)sc), err); 538 1.1.2.2 yamt return err; 539 1.1.2.2 yamt } 540 1.1.2.2 yamt 541 1.1.2.2 yamt sc->sc_state = BTHID_WAIT_CTL; 542 1.1.2.2 yamt return 0; 543 1.1.2.2 yamt } 544 1.1.2.2 yamt 545 1.1.2.2 yamt /***************************************************************************** 546 1.1.2.2 yamt * 547 1.1.2.2 yamt * bluetooth(9) callback methods for L2CAP 548 1.1.2.2 yamt * 549 1.1.2.2 yamt * All these are called from Bluetooth Protocol code, in a soft 550 1.1.2.2 yamt * interrupt context at IPL_SOFTNET. 551 1.1.2.2 yamt */ 552 1.1.2.2 yamt 553 1.1.2.2 yamt static void 554 1.1.2.2 yamt bthidev_connecting(void *arg) 555 1.1.2.2 yamt { 556 1.1.2.2 yamt 557 1.1.2.2 yamt /* dont care */ 558 1.1.2.2 yamt } 559 1.1.2.2 yamt 560 1.1.2.2 yamt static void 561 1.1.2.2 yamt bthidev_ctl_connected(void *arg) 562 1.1.2.2 yamt { 563 1.1.2.2 yamt struct sockaddr_bt sa; 564 1.1.2.2 yamt struct bthidev_softc *sc = arg; 565 1.1.2.2 yamt int err; 566 1.1.2.2 yamt 567 1.1.2.2 yamt if (sc->sc_state != BTHID_WAIT_CTL) 568 1.1.2.2 yamt return; 569 1.1.2.2 yamt 570 1.1.2.2 yamt KASSERT(sc->sc_ctl != NULL); 571 1.1.2.2 yamt KASSERT(sc->sc_int == NULL); 572 1.1.2.2 yamt 573 1.1.2.3 yamt if (sc->sc_flags & BTHID_CONNECTING) { 574 1.1.2.2 yamt /* initiate connect on interrupt PSM */ 575 1.1.2.2 yamt err = l2cap_attach(&sc->sc_int, &bthidev_int_proto, sc); 576 1.1.2.2 yamt if (err) 577 1.1.2.2 yamt goto fail; 578 1.1.2.2 yamt 579 1.1.2.4 yamt err = l2cap_setopt(sc->sc_int, SO_L2CAP_LM, &sc->sc_mode); 580 1.1.2.4 yamt if (err) 581 1.1.2.4 yamt goto fail; 582 1.1.2.4 yamt 583 1.1.2.2 yamt memset(&sa, 0, sizeof(sa)); 584 1.1.2.2 yamt sa.bt_len = sizeof(sa); 585 1.1.2.2 yamt sa.bt_family = AF_BLUETOOTH; 586 1.1.2.2 yamt bdaddr_copy(&sa.bt_bdaddr, &sc->sc_laddr); 587 1.1.2.2 yamt 588 1.1.2.2 yamt err = l2cap_bind(sc->sc_int, &sa); 589 1.1.2.2 yamt if (err) 590 1.1.2.2 yamt goto fail; 591 1.1.2.2 yamt 592 1.1.2.2 yamt sa.bt_psm = sc->sc_intpsm; 593 1.1.2.2 yamt bdaddr_copy(&sa.bt_bdaddr, &sc->sc_raddr); 594 1.1.2.2 yamt err = l2cap_connect(sc->sc_int, &sa); 595 1.1.2.2 yamt if (err) 596 1.1.2.2 yamt goto fail; 597 1.1.2.2 yamt } 598 1.1.2.2 yamt 599 1.1.2.2 yamt sc->sc_state = BTHID_WAIT_INT; 600 1.1.2.2 yamt return; 601 1.1.2.2 yamt 602 1.1.2.2 yamt fail: 603 1.1.2.2 yamt l2cap_detach(&sc->sc_ctl); 604 1.1.2.2 yamt sc->sc_ctl = NULL; 605 1.1.2.3 yamt 606 1.1.2.3 yamt printf("%s: connect failed (%d)\n", 607 1.1.2.3 yamt device_xname((struct device *)sc), err); 608 1.1.2.2 yamt } 609 1.1.2.2 yamt 610 1.1.2.2 yamt static void 611 1.1.2.2 yamt bthidev_int_connected(void *arg) 612 1.1.2.2 yamt { 613 1.1.2.2 yamt struct bthidev_softc *sc = arg; 614 1.1.2.2 yamt 615 1.1.2.2 yamt if (sc->sc_state != BTHID_WAIT_INT) 616 1.1.2.2 yamt return; 617 1.1.2.2 yamt 618 1.1.2.2 yamt KASSERT(sc->sc_ctl != NULL); 619 1.1.2.2 yamt KASSERT(sc->sc_int != NULL); 620 1.1.2.2 yamt 621 1.1.2.2 yamt sc->sc_attempts = 0; 622 1.1.2.3 yamt sc->sc_flags &= ~BTHID_CONNECTING; 623 1.1.2.2 yamt sc->sc_state = BTHID_OPEN; 624 1.1.2.2 yamt 625 1.1.2.3 yamt printf("%s: connected\n", device_xname((struct device *)sc)); 626 1.1.2.2 yamt } 627 1.1.2.2 yamt 628 1.1.2.2 yamt /* 629 1.1.2.2 yamt * Disconnected 630 1.1.2.2 yamt * 631 1.1.2.2 yamt * Depending on our state, this could mean several things, but essentially 632 1.1.2.3 yamt * we are lost. If both channels are closed, and we are marked to reconnect, 633 1.1.2.3 yamt * schedule another try otherwise just give up. They will contact us. 634 1.1.2.2 yamt */ 635 1.1.2.2 yamt static void 636 1.1.2.2 yamt bthidev_ctl_disconnected(void *arg, int err) 637 1.1.2.2 yamt { 638 1.1.2.2 yamt struct bthidev_softc *sc = arg; 639 1.1.2.2 yamt 640 1.1.2.2 yamt if (sc->sc_ctl != NULL) { 641 1.1.2.2 yamt l2cap_detach(&sc->sc_ctl); 642 1.1.2.2 yamt sc->sc_ctl = NULL; 643 1.1.2.2 yamt } 644 1.1.2.2 yamt 645 1.1.2.2 yamt sc->sc_state = BTHID_CLOSED; 646 1.1.2.2 yamt 647 1.1.2.2 yamt if (sc->sc_int == NULL) { 648 1.1.2.3 yamt printf("%s: disconnected\n", 649 1.1.2.3 yamt device_xname((struct device *)sc)); 650 1.1.2.3 yamt sc->sc_flags &= ~BTHID_CONNECTING; 651 1.1.2.2 yamt 652 1.1.2.3 yamt if (sc->sc_flags & BTHID_RECONNECT) 653 1.1.2.2 yamt callout_schedule(&sc->sc_reconnect, 654 1.1.2.2 yamt BTHID_RETRY_INTERVAL * hz); 655 1.1.2.2 yamt else 656 1.1.2.2 yamt sc->sc_state = BTHID_WAIT_CTL; 657 1.1.2.3 yamt } else { 658 1.1.2.3 yamt /* 659 1.1.2.3 yamt * The interrupt channel should have been closed first, 660 1.1.2.3 yamt * but its potentially unsafe to detach that from here. 661 1.1.2.3 yamt * Give them a second to do the right thing or let the 662 1.1.2.3 yamt * callout handle it. 663 1.1.2.3 yamt */ 664 1.1.2.3 yamt callout_schedule(&sc->sc_reconnect, hz); 665 1.1.2.2 yamt } 666 1.1.2.2 yamt } 667 1.1.2.2 yamt 668 1.1.2.2 yamt static void 669 1.1.2.2 yamt bthidev_int_disconnected(void *arg, int err) 670 1.1.2.2 yamt { 671 1.1.2.2 yamt struct bthidev_softc *sc = arg; 672 1.1.2.2 yamt 673 1.1.2.2 yamt if (sc->sc_int != NULL) { 674 1.1.2.2 yamt l2cap_detach(&sc->sc_int); 675 1.1.2.2 yamt sc->sc_int = NULL; 676 1.1.2.2 yamt } 677 1.1.2.2 yamt 678 1.1.2.2 yamt sc->sc_state = BTHID_CLOSED; 679 1.1.2.2 yamt 680 1.1.2.2 yamt if (sc->sc_ctl == NULL) { 681 1.1.2.3 yamt printf("%s: disconnected\n", 682 1.1.2.3 yamt device_xname((struct device *)sc)); 683 1.1.2.3 yamt sc->sc_flags &= ~BTHID_CONNECTING; 684 1.1.2.2 yamt 685 1.1.2.3 yamt if (sc->sc_flags & BTHID_RECONNECT) 686 1.1.2.2 yamt callout_schedule(&sc->sc_reconnect, 687 1.1.2.2 yamt BTHID_RETRY_INTERVAL * hz); 688 1.1.2.2 yamt else 689 1.1.2.2 yamt sc->sc_state = BTHID_WAIT_CTL; 690 1.1.2.3 yamt } else { 691 1.1.2.3 yamt /* 692 1.1.2.3 yamt * The control channel should be closing also, allow 693 1.1.2.3 yamt * them a chance to do that before we force it. 694 1.1.2.3 yamt */ 695 1.1.2.3 yamt callout_schedule(&sc->sc_reconnect, hz); 696 1.1.2.2 yamt } 697 1.1.2.2 yamt } 698 1.1.2.2 yamt 699 1.1.2.2 yamt /* 700 1.1.2.2 yamt * New Connections 701 1.1.2.2 yamt * 702 1.1.2.2 yamt * We give a new L2CAP handle back if this matches the BDADDR we are 703 1.1.2.2 yamt * listening for and we are in the right state. bthidev_connected will 704 1.1.2.2 yamt * be called when the connection is open, so nothing else to do here 705 1.1.2.2 yamt */ 706 1.1.2.2 yamt static void * 707 1.1.2.3 yamt bthidev_ctl_newconn(void *arg, struct sockaddr_bt *laddr, 708 1.1.2.3 yamt struct sockaddr_bt *raddr) 709 1.1.2.2 yamt { 710 1.1.2.2 yamt struct bthidev_softc *sc = arg; 711 1.1.2.2 yamt 712 1.1.2.2 yamt if (bdaddr_same(&raddr->bt_bdaddr, &sc->sc_raddr) == 0 713 1.1.2.3 yamt || (sc->sc_flags & BTHID_CONNECTING) 714 1.1.2.2 yamt || sc->sc_state != BTHID_WAIT_CTL 715 1.1.2.2 yamt || sc->sc_ctl != NULL 716 1.1.2.2 yamt || sc->sc_int != NULL) 717 1.1.2.2 yamt return NULL; 718 1.1.2.2 yamt 719 1.1.2.2 yamt l2cap_attach(&sc->sc_ctl, &bthidev_ctl_proto, sc); 720 1.1.2.2 yamt return sc->sc_ctl; 721 1.1.2.2 yamt } 722 1.1.2.2 yamt 723 1.1.2.2 yamt static void * 724 1.1.2.3 yamt bthidev_int_newconn(void *arg, struct sockaddr_bt *laddr, 725 1.1.2.3 yamt struct sockaddr_bt *raddr) 726 1.1.2.2 yamt { 727 1.1.2.2 yamt struct bthidev_softc *sc = arg; 728 1.1.2.2 yamt 729 1.1.2.2 yamt if (bdaddr_same(&raddr->bt_bdaddr, &sc->sc_raddr) == 0 730 1.1.2.3 yamt || (sc->sc_flags & BTHID_CONNECTING) 731 1.1.2.2 yamt || sc->sc_state != BTHID_WAIT_INT 732 1.1.2.2 yamt || sc->sc_ctl == NULL 733 1.1.2.2 yamt || sc->sc_int != NULL) 734 1.1.2.2 yamt return NULL; 735 1.1.2.2 yamt 736 1.1.2.2 yamt l2cap_attach(&sc->sc_int, &bthidev_int_proto, sc); 737 1.1.2.2 yamt return sc->sc_int; 738 1.1.2.2 yamt } 739 1.1.2.2 yamt 740 1.1.2.2 yamt static void 741 1.1.2.2 yamt bthidev_complete(void *arg, int count) 742 1.1.2.2 yamt { 743 1.1.2.2 yamt 744 1.1.2.2 yamt /* dont care */ 745 1.1.2.2 yamt } 746 1.1.2.2 yamt 747 1.1.2.4 yamt static void 748 1.1.2.4 yamt bthidev_linkmode(void *arg, int new) 749 1.1.2.4 yamt { 750 1.1.2.4 yamt struct bthidev_softc *sc = arg; 751 1.1.2.4 yamt 752 1.1.2.4 yamt if ((sc->sc_mode & L2CAP_LM_AUTH) && !(new & L2CAP_LM_AUTH)) 753 1.1.2.4 yamt printf("%s: auth failed\n", device_xname((struct device *)sc)); 754 1.1.2.4 yamt else if ((sc->sc_mode & L2CAP_LM_ENCRYPT) && !(new & L2CAP_LM_ENCRYPT)) 755 1.1.2.4 yamt printf("%s: encrypt off\n", device_xname((struct device *)sc)); 756 1.1.2.4 yamt else if ((sc->sc_mode & L2CAP_LM_SECURE) && !(new & L2CAP_LM_SECURE)) 757 1.1.2.4 yamt printf("%s: insecure\n", device_xname((struct device *)sc)); 758 1.1.2.4 yamt else 759 1.1.2.4 yamt return; 760 1.1.2.4 yamt 761 1.1.2.4 yamt if (sc->sc_int != NULL) 762 1.1.2.4 yamt l2cap_disconnect(sc->sc_int, 0); 763 1.1.2.4 yamt 764 1.1.2.4 yamt if (sc->sc_ctl != NULL) 765 1.1.2.4 yamt l2cap_disconnect(sc->sc_ctl, 0); 766 1.1.2.4 yamt } 767 1.1.2.4 yamt 768 1.1.2.2 yamt /* 769 1.1.2.2 yamt * Receive reports from the protocol stack. 770 1.1.2.2 yamt */ 771 1.1.2.2 yamt static void 772 1.1.2.2 yamt bthidev_input(void *arg, struct mbuf *m) 773 1.1.2.2 yamt { 774 1.1.2.2 yamt struct bthidev_softc *sc = arg; 775 1.1.2.2 yamt struct bthidev *dev; 776 1.1.2.2 yamt uint8_t *data; 777 1.1.2.2 yamt int len; 778 1.1.2.2 yamt 779 1.1.2.2 yamt if (sc->sc_state != BTHID_OPEN) 780 1.1.2.2 yamt goto release; 781 1.1.2.2 yamt 782 1.1.2.2 yamt if (m->m_pkthdr.len > m->m_len) 783 1.1.2.3 yamt printf("%s: truncating HID report\n", 784 1.1.2.3 yamt device_xname((struct device *)sc)); 785 1.1.2.2 yamt 786 1.1.2.2 yamt len = m->m_len; 787 1.1.2.2 yamt data = mtod(m, uint8_t *); 788 1.1.2.2 yamt 789 1.1.2.2 yamt if (BTHID_TYPE(data[0]) == BTHID_DATA) { 790 1.1.2.2 yamt /* 791 1.1.2.2 yamt * data[0] == type / parameter 792 1.1.2.2 yamt * data[1] == id 793 1.1.2.2 yamt * data[2..len] == report 794 1.1.2.2 yamt */ 795 1.1.2.2 yamt if (len < 3) 796 1.1.2.2 yamt goto release; 797 1.1.2.2 yamt 798 1.1.2.2 yamt LIST_FOREACH(dev, &sc->sc_list, sc_next) { 799 1.1.2.2 yamt if (data[1] == dev->sc_id) { 800 1.1.2.2 yamt switch (BTHID_DATA_PARAM(data[0])) { 801 1.1.2.2 yamt case BTHID_DATA_INPUT: 802 1.1.2.2 yamt (*dev->sc_input)(dev, data + 2, len - 2); 803 1.1.2.2 yamt break; 804 1.1.2.2 yamt 805 1.1.2.2 yamt case BTHID_DATA_FEATURE: 806 1.1.2.2 yamt (*dev->sc_feature)(dev, data + 2, len - 2); 807 1.1.2.2 yamt break; 808 1.1.2.2 yamt 809 1.1.2.2 yamt default: 810 1.1.2.2 yamt break; 811 1.1.2.2 yamt } 812 1.1.2.2 yamt 813 1.1.2.2 yamt goto release; 814 1.1.2.2 yamt } 815 1.1.2.2 yamt } 816 1.1.2.2 yamt printf("%s: report id %d, len = %d ignored\n", 817 1.1.2.3 yamt device_xname((struct device *)sc), data[1], len - 2); 818 1.1.2.2 yamt 819 1.1.2.2 yamt goto release; 820 1.1.2.2 yamt } 821 1.1.2.2 yamt 822 1.1.2.2 yamt if (BTHID_TYPE(data[0]) == BTHID_CONTROL) { 823 1.1.2.2 yamt if (len < 1) 824 1.1.2.2 yamt goto release; 825 1.1.2.2 yamt 826 1.1.2.2 yamt if (BTHID_DATA_PARAM(data[0]) == BTHID_CONTROL_UNPLUG) { 827 1.1.2.3 yamt printf("%s: unplugged\n", 828 1.1.2.3 yamt device_xname((struct device *)sc)); 829 1.1.2.2 yamt 830 1.1.2.2 yamt /* close interrupt channel */ 831 1.1.2.2 yamt if (sc->sc_int != NULL) { 832 1.1.2.2 yamt l2cap_disconnect(sc->sc_int, 0); 833 1.1.2.2 yamt l2cap_detach(&sc->sc_int); 834 1.1.2.2 yamt sc->sc_int = NULL; 835 1.1.2.2 yamt } 836 1.1.2.2 yamt 837 1.1.2.2 yamt /* close control channel */ 838 1.1.2.2 yamt if (sc->sc_ctl != NULL) { 839 1.1.2.2 yamt l2cap_disconnect(sc->sc_ctl, 0); 840 1.1.2.2 yamt l2cap_detach(&sc->sc_ctl); 841 1.1.2.2 yamt sc->sc_ctl = NULL; 842 1.1.2.2 yamt } 843 1.1.2.2 yamt } 844 1.1.2.2 yamt 845 1.1.2.2 yamt goto release; 846 1.1.2.2 yamt } 847 1.1.2.2 yamt 848 1.1.2.2 yamt release: 849 1.1.2.2 yamt m_freem(m); 850 1.1.2.2 yamt } 851 1.1.2.2 yamt 852 1.1.2.2 yamt /***************************************************************************** 853 1.1.2.2 yamt * 854 1.1.2.2 yamt * IO routines 855 1.1.2.2 yamt */ 856 1.1.2.2 yamt 857 1.1.2.2 yamt static void 858 1.1.2.3 yamt bthidev_null(struct bthidev *dev, uint8_t *report, 859 1.1.2.3 yamt int len) 860 1.1.2.2 yamt { 861 1.1.2.2 yamt 862 1.1.2.2 yamt /* 863 1.1.2.2 yamt * empty routine just in case the device 864 1.1.2.2 yamt * provided no method to handle this report 865 1.1.2.2 yamt */ 866 1.1.2.2 yamt } 867 1.1.2.2 yamt 868 1.1.2.2 yamt static int 869 1.1.2.2 yamt bthidev_output(struct bthidev *dev, uint8_t *report, int rlen) 870 1.1.2.2 yamt { 871 1.1.2.2 yamt struct bthidev_softc *sc = (struct bthidev_softc *)dev->sc_parent; 872 1.1.2.2 yamt struct mbuf *m; 873 1.1.2.2 yamt int s, err; 874 1.1.2.2 yamt 875 1.1.2.2 yamt if (sc == NULL || sc->sc_state != BTHID_OPEN) 876 1.1.2.2 yamt return ENOTCONN; 877 1.1.2.2 yamt 878 1.1.2.2 yamt KASSERT(sc->sc_ctl != NULL); 879 1.1.2.2 yamt KASSERT(sc->sc_int != NULL); 880 1.1.2.2 yamt 881 1.1.2.2 yamt if (rlen == 0 || report == NULL) 882 1.1.2.2 yamt return 0; 883 1.1.2.2 yamt 884 1.1.2.2 yamt if (rlen > MHLEN - 2) { 885 1.1.2.2 yamt printf("%s: output report too long (%d)!\n", 886 1.1.2.3 yamt device_xname((struct device *)sc), rlen); 887 1.1.2.2 yamt 888 1.1.2.2 yamt return EMSGSIZE; 889 1.1.2.2 yamt } 890 1.1.2.2 yamt 891 1.1.2.2 yamt m = m_gethdr(M_DONTWAIT, MT_DATA); 892 1.1.2.2 yamt if (m == NULL) 893 1.1.2.2 yamt return ENOMEM; 894 1.1.2.2 yamt 895 1.1.2.2 yamt /* 896 1.1.2.2 yamt * data[0] = type / parameter 897 1.1.2.2 yamt * data[1] = id 898 1.1.2.2 yamt * data[2..N] = report 899 1.1.2.2 yamt */ 900 1.1.2.2 yamt mtod(m, uint8_t *)[0] = (uint8_t)((BTHID_DATA << 4) | BTHID_DATA_OUTPUT); 901 1.1.2.2 yamt mtod(m, uint8_t *)[1] = dev->sc_id; 902 1.1.2.2 yamt memcpy(mtod(m, uint8_t *) + 2, report, rlen); 903 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = rlen + 2; 904 1.1.2.2 yamt 905 1.1.2.2 yamt s = splsoftnet(); 906 1.1.2.2 yamt err = l2cap_send(sc->sc_int, m); 907 1.1.2.2 yamt splx(s); 908 1.1.2.2 yamt 909 1.1.2.2 yamt return err; 910 1.1.2.2 yamt } 911
Indexes created Wed Oct 01 19:09:53 GMT 2025