btuart.c revision 1.1.2.6
1 1.1.2.6 yamt /* $NetBSD: btuart.c,v 1.1.2.6 2007/12/07 17:29:40 yamt Exp $ */ 2 1.1.2.2 yamt /* 3 1.1.2.2 yamt * Copyright (c) 2006, 2007 KIYOHARA Takashi 4 1.1.2.2 yamt * All rights reserved. 5 1.1.2.2 yamt * 6 1.1.2.2 yamt * Redistribution and use in source and binary forms, with or without 7 1.1.2.2 yamt * modification, are permitted provided that the following conditions 8 1.1.2.2 yamt * are met: 9 1.1.2.2 yamt * 1. Redistributions of source code must retain the above copyright 10 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer. 11 1.1.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 12 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer in the 13 1.1.2.2 yamt * documentation and/or other materials provided with the distribution. 14 1.1.2.2 yamt * 15 1.1.2.2 yamt * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.1.2.2 yamt * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED 17 1.1.2.2 yamt * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE 18 1.1.2.2 yamt * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, 19 1.1.2.2 yamt * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 20 1.1.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 21 1.1.2.2 yamt * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 1.1.2.2 yamt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, 23 1.1.2.2 yamt * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 24 1.1.2.2 yamt * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 1.1.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 26 1.1.2.2 yamt */ 27 1.1.2.2 yamt 28 1.1.2.2 yamt #include <sys/cdefs.h> 29 1.1.2.6 yamt __KERNEL_RCSID(0, "$NetBSD: btuart.c,v 1.1.2.6 2007/12/07 17:29:40 yamt Exp $"); 30 1.1.2.2 yamt 31 1.1.2.2 yamt #include <sys/types.h> 32 1.1.2.2 yamt #include <sys/param.h> 33 1.1.2.2 yamt #include <sys/device.h> 34 1.1.2.2 yamt #include <sys/errno.h> 35 1.1.2.2 yamt 36 1.1.2.2 yamt #include <sys/conf.h> 37 1.1.2.2 yamt #include <sys/fcntl.h> 38 1.1.2.2 yamt #include <sys/kauth.h> 39 1.1.2.2 yamt #include <sys/kernel.h> 40 1.1.2.2 yamt #include <sys/malloc.h> 41 1.1.2.2 yamt #include <sys/mbuf.h> 42 1.1.2.2 yamt #include <sys/proc.h> 43 1.1.2.2 yamt #include <sys/syslimits.h> 44 1.1.2.2 yamt #include <sys/systm.h> 45 1.1.2.2 yamt #include <sys/tty.h> 46 1.1.2.2 yamt 47 1.1.2.4 yamt #include <sys/bus.h> 48 1.1.2.4 yamt #include <sys/intr.h> 49 1.1.2.2 yamt 50 1.1.2.2 yamt #include <netbt/bluetooth.h> 51 1.1.2.2 yamt #include <netbt/hci.h> 52 1.1.2.2 yamt 53 1.1.2.2 yamt #include <dev/bluetooth/btuart.h> 54 1.1.2.2 yamt #include <dev/firmload.h> 55 1.1.2.2 yamt 56 1.1.2.2 yamt #include "ioconf.h" 57 1.1.2.2 yamt 58 1.1.2.2 yamt #ifdef BTUART_DEBUG 59 1.1.2.2 yamt int btuart_debug = 1; 60 1.1.2.2 yamt #endif 61 1.1.2.2 yamt 62 1.1.2.2 yamt struct btuart_softc; 63 1.1.2.2 yamt struct bth4hci { 64 1.1.2.2 yamt int type; 65 1.1.2.2 yamt int init_baud; 66 1.1.2.2 yamt #define FLOW_CTL 1 67 1.1.2.2 yamt int flags; 68 1.1.2.2 yamt int (*init)(struct btuart_softc *); 69 1.1.2.2 yamt }; 70 1.1.2.2 yamt 71 1.1.2.2 yamt struct btuart_softc { 72 1.1.2.5 yamt device_t sc_dev; 73 1.1.2.6 yamt int sc_flags; 74 1.1.2.2 yamt 75 1.1.2.2 yamt struct tty *sc_tp; 76 1.1.2.6 yamt struct hci_unit *sc_unit; /* Bluetooth HCI Unit */ 77 1.1.2.6 yamt struct bt_stats sc_stats; 78 1.1.2.2 yamt 79 1.1.2.2 yamt struct bth4hci sc_bth4hci; 80 1.1.2.2 yamt int sc_baud; 81 1.1.2.2 yamt 82 1.1.2.2 yamt int sc_state; /* receive state */ 83 1.1.2.2 yamt #define BTUART_RECV_PKT_TYPE 0 /* packet type */ 84 1.1.2.2 yamt #define BTUART_RECV_ACL_HDR 1 /* acl header */ 85 1.1.2.2 yamt #define BTUART_RECV_SCO_HDR 2 /* sco header */ 86 1.1.2.2 yamt #define BTUART_RECV_EVENT_HDR 3 /* event header */ 87 1.1.2.2 yamt #define BTUART_RECV_ACL_DATA 4 /* acl packet data */ 88 1.1.2.2 yamt #define BTUART_RECV_SCO_DATA 5 /* sco packet data */ 89 1.1.2.2 yamt #define BTUART_RECV_EVENT_DATA 6 /* event packet data */ 90 1.1.2.2 yamt int sc_want; /* how much we want */ 91 1.1.2.2 yamt struct mbuf *sc_rxp; /* incoming packet */ 92 1.1.2.2 yamt struct mbuf *sc_txp; /* outgoing packet */ 93 1.1.2.2 yamt 94 1.1.2.6 yamt MBUFQ_HEAD() sc_cmdq; 95 1.1.2.6 yamt MBUFQ_HEAD() sc_aclq; 96 1.1.2.6 yamt MBUFQ_HEAD() sc_scoq; 97 1.1.2.6 yamt 98 1.1.2.6 yamt bool (*sc_input_acl)(struct hci_unit *, struct mbuf *); 99 1.1.2.6 yamt bool (*sc_input_sco)(struct hci_unit *, struct mbuf *); 100 1.1.2.6 yamt bool (*sc_input_event)(struct hci_unit *, struct mbuf *); 101 1.1.2.2 yamt }; 102 1.1.2.2 yamt 103 1.1.2.6 yamt /* sc_flags */ 104 1.1.2.6 yamt #define BTUART_XMIT (1 << 0) /* transmit is active */ 105 1.1.2.6 yamt #define BTUART_ENABLED (1 << 1) /* device is enabled */ 106 1.1.2.6 yamt 107 1.1.2.2 yamt void btuartattach(int); 108 1.1.2.5 yamt static int btuart_match(device_t, struct cfdata *, void *); 109 1.1.2.5 yamt static void btuart_attach(device_t, device_t, void *); 110 1.1.2.5 yamt static int btuart_detach(device_t, int); 111 1.1.2.2 yamt 112 1.1.2.2 yamt static int bth4_waitresp(struct btuart_softc *, struct mbuf **, uint16_t); 113 1.1.2.2 yamt static int bth4_firmload(struct btuart_softc *, char *, 114 1.1.2.2 yamt int (*)(struct btuart_softc *, int, char *)); 115 1.1.2.2 yamt static int init_ericsson(struct btuart_softc *); 116 1.1.2.2 yamt static int init_digi(struct btuart_softc *); 117 1.1.2.2 yamt static int init_texas(struct btuart_softc *); 118 1.1.2.2 yamt static int init_csr(struct btuart_softc *); 119 1.1.2.2 yamt static int init_swave(struct btuart_softc *); 120 1.1.2.2 yamt static int init_st(struct btuart_softc *); 121 1.1.2.2 yamt static int firmload_stlc2500(struct btuart_softc *, int, char *); 122 1.1.2.2 yamt static int init_stlc2500(struct btuart_softc *); 123 1.1.2.6 yamt static int init_bgb2xx(struct btuart_softc *); 124 1.1.2.2 yamt static int init_bcm2035(struct btuart_softc *); 125 1.1.2.2 yamt static int bth4init(struct btuart_softc *); 126 1.1.2.6 yamt static bool bth4init_input(struct hci_unit *, struct mbuf *); 127 1.1.2.2 yamt 128 1.1.2.2 yamt static int bth4open(dev_t, struct tty *); 129 1.1.2.2 yamt static int bth4close(struct tty *, int); 130 1.1.2.3 yamt static int bth4ioctl(struct tty *, u_long, void *, int, struct lwp *); 131 1.1.2.2 yamt static int bth4input(int, struct tty *); 132 1.1.2.2 yamt static int bth4start(struct tty *); 133 1.1.2.6 yamt static void bth4_start(struct btuart_softc *); 134 1.1.2.2 yamt 135 1.1.2.5 yamt static int bth4_enable(device_t); 136 1.1.2.5 yamt static void bth4_disable(device_t); 137 1.1.2.6 yamt static void bth4_output_cmd(device_t, struct mbuf *); 138 1.1.2.6 yamt static void bth4_output_acl(device_t, struct mbuf *); 139 1.1.2.6 yamt static void bth4_output_sco(device_t, struct mbuf *); 140 1.1.2.6 yamt static void bth4_stats(device_t, struct bt_stats *, int); 141 1.1.2.2 yamt 142 1.1.2.2 yamt /* 143 1.1.2.2 yamt * It doesn't need to be exported, as only btuartattach() uses it, 144 1.1.2.2 yamt * but there's no "official" way to make it static. 145 1.1.2.2 yamt */ 146 1.1.2.5 yamt CFATTACH_DECL_NEW(btuart, sizeof(struct btuart_softc), 147 1.1.2.2 yamt btuart_match, btuart_attach, btuart_detach, NULL); 148 1.1.2.2 yamt 149 1.1.2.2 yamt static struct linesw bth4_disc = { 150 1.1.2.2 yamt .l_name = "btuart", 151 1.1.2.2 yamt .l_open = bth4open, 152 1.1.2.2 yamt .l_close = bth4close, 153 1.1.2.2 yamt .l_read = ttyerrio, 154 1.1.2.2 yamt .l_write = ttyerrio, 155 1.1.2.2 yamt .l_ioctl = bth4ioctl, 156 1.1.2.2 yamt .l_rint = bth4input, 157 1.1.2.2 yamt .l_start = bth4start, 158 1.1.2.2 yamt .l_modem = ttymodem, 159 1.1.2.2 yamt .l_poll = ttyerrpoll 160 1.1.2.2 yamt }; 161 1.1.2.2 yamt 162 1.1.2.6 yamt static const struct hci_if btuart_hci = { 163 1.1.2.6 yamt .enable = bth4_enable, 164 1.1.2.6 yamt .disable = bth4_disable, 165 1.1.2.6 yamt .output_cmd = bth4_output_cmd, 166 1.1.2.6 yamt .output_acl = bth4_output_acl, 167 1.1.2.6 yamt .output_sco = bth4_output_sco, 168 1.1.2.6 yamt .get_stats = bth4_stats, 169 1.1.2.6 yamt .ipl = IPL_TTY, 170 1.1.2.6 yamt }; 171 1.1.2.6 yamt 172 1.1.2.2 yamt static struct bth4hci bth4hci[] = { 173 1.1.2.2 yamt { BTUART_HCITYPE_ANY, B0, FLOW_CTL, NULL }, 174 1.1.2.2 yamt { BTUART_HCITYPE_ERICSSON, B57600, FLOW_CTL, init_ericsson }, 175 1.1.2.2 yamt { BTUART_HCITYPE_DIGI, B9600, FLOW_CTL, init_digi }, 176 1.1.2.2 yamt { BTUART_HCITYPE_TEXAS, B115200, FLOW_CTL, init_texas }, 177 1.1.2.2 yamt { BTUART_HCITYPE_CSR, B115200, FLOW_CTL, init_csr }, 178 1.1.2.2 yamt { BTUART_HCITYPE_SWAVE, B115200, FLOW_CTL, init_swave }, 179 1.1.2.2 yamt { BTUART_HCITYPE_ST, B57600, FLOW_CTL, init_st }, 180 1.1.2.2 yamt { BTUART_HCITYPE_STLC2500, B115200, FLOW_CTL, init_stlc2500 }, 181 1.1.2.6 yamt { BTUART_HCITYPE_BGB2XX, B115200, FLOW_CTL, init_bgb2xx }, 182 1.1.2.2 yamt { BTUART_HCITYPE_BCM2035, B115200, 0, init_bcm2035 }, 183 1.1.2.2 yamt 184 1.1.2.2 yamt { -1, B0, 0, NULL } 185 1.1.2.2 yamt }; 186 1.1.2.2 yamt 187 1.1.2.2 yamt 188 1.1.2.2 yamt /* ARGSUSED */ 189 1.1.2.2 yamt void 190 1.1.2.2 yamt btuartattach(int num __unused) 191 1.1.2.2 yamt { 192 1.1.2.2 yamt int error; 193 1.1.2.2 yamt 194 1.1.2.2 yamt error = ttyldisc_attach(&bth4_disc); 195 1.1.2.2 yamt if (error) { 196 1.1.2.2 yamt aprint_error("%s: unable to register line discipline, " 197 1.1.2.2 yamt "error = %d\n", btuart_cd.cd_name, error); 198 1.1.2.2 yamt return; 199 1.1.2.2 yamt } 200 1.1.2.2 yamt 201 1.1.2.2 yamt error = config_cfattach_attach(btuart_cd.cd_name, &btuart_ca); 202 1.1.2.2 yamt if (error) { 203 1.1.2.2 yamt aprint_error("%s: unable to register cfattach, error = %d\n", 204 1.1.2.2 yamt btuart_cd.cd_name, error); 205 1.1.2.2 yamt config_cfdriver_detach(&btuart_cd); 206 1.1.2.2 yamt (void) ttyldisc_detach(&bth4_disc); 207 1.1.2.2 yamt } 208 1.1.2.2 yamt } 209 1.1.2.2 yamt 210 1.1.2.2 yamt /* 211 1.1.2.2 yamt * Autoconf match routine. 212 1.1.2.2 yamt * 213 1.1.2.2 yamt * XXX: unused: config_attach_pseudo(9) does not call ca_match. 214 1.1.2.2 yamt */ 215 1.1.2.2 yamt /* ARGSUSED */ 216 1.1.2.2 yamt static int 217 1.1.2.6 yamt btuart_match(device_t self __unused, struct cfdata *cfdata __unused, 218 1.1.2.6 yamt void *arg __unused) 219 1.1.2.2 yamt { 220 1.1.2.2 yamt 221 1.1.2.2 yamt /* pseudo-device; always present */ 222 1.1.2.2 yamt return 1; 223 1.1.2.2 yamt } 224 1.1.2.2 yamt 225 1.1.2.2 yamt /* 226 1.1.2.2 yamt * Autoconf attach routine. Called by config_attach_pseudo(9) when we 227 1.1.2.2 yamt * open the line discipline. 228 1.1.2.2 yamt */ 229 1.1.2.2 yamt /* ARGSUSED */ 230 1.1.2.2 yamt static void 231 1.1.2.6 yamt btuart_attach(device_t parent __unused, device_t self, void *aux __unused) 232 1.1.2.2 yamt { 233 1.1.2.2 yamt struct btuart_softc *sc = device_private(self); 234 1.1.2.2 yamt int i; 235 1.1.2.2 yamt 236 1.1.2.5 yamt sc->sc_dev = self; 237 1.1.2.5 yamt 238 1.1.2.6 yamt MBUFQ_INIT(&sc->sc_cmdq); 239 1.1.2.6 yamt MBUFQ_INIT(&sc->sc_aclq); 240 1.1.2.6 yamt MBUFQ_INIT(&sc->sc_scoq); 241 1.1.2.6 yamt 242 1.1.2.2 yamt aprint_normal("\n"); 243 1.1.2.2 yamt aprint_naive("\n"); 244 1.1.2.2 yamt 245 1.1.2.2 yamt sc->sc_input_acl = bth4init_input; 246 1.1.2.2 yamt sc->sc_input_sco = bth4init_input; 247 1.1.2.2 yamt sc->sc_input_event = bth4init_input; 248 1.1.2.2 yamt 249 1.1.2.2 yamt /* Copy default type */ 250 1.1.2.2 yamt for (i = 0; bth4hci[i].type != BTUART_HCITYPE_ANY; i++); 251 1.1.2.2 yamt memcpy(&sc->sc_bth4hci, &bth4hci[i], sizeof(struct bth4hci)); 252 1.1.2.2 yamt 253 1.1.2.2 yamt /* Attach Bluetooth unit */ 254 1.1.2.6 yamt sc->sc_unit = hci_attach(&btuart_hci, self, 0); 255 1.1.2.2 yamt } 256 1.1.2.2 yamt 257 1.1.2.2 yamt /* 258 1.1.2.2 yamt * Autoconf detach routine. Called when we close the line discipline. 259 1.1.2.2 yamt */ 260 1.1.2.2 yamt static int 261 1.1.2.5 yamt btuart_detach(device_t self, int flags __unused) 262 1.1.2.2 yamt { 263 1.1.2.2 yamt struct btuart_softc *sc = device_private(self); 264 1.1.2.2 yamt 265 1.1.2.6 yamt if (sc->sc_unit) { 266 1.1.2.6 yamt hci_detach(sc->sc_unit); 267 1.1.2.6 yamt sc->sc_unit = NULL; 268 1.1.2.6 yamt } 269 1.1.2.2 yamt 270 1.1.2.2 yamt return 0; 271 1.1.2.2 yamt } 272 1.1.2.2 yamt 273 1.1.2.2 yamt 274 1.1.2.2 yamt static int 275 1.1.2.2 yamt bth4_waitresp(struct btuart_softc *sc, struct mbuf **mp, uint16_t opcode) 276 1.1.2.2 yamt { 277 1.1.2.2 yamt hci_event_hdr_t *e; 278 1.1.2.6 yamt struct hci_unit *unit = sc->sc_unit; 279 1.1.2.2 yamt int status = 0, rv; 280 1.1.2.2 yamt 281 1.1.2.2 yamt *mp = NULL; 282 1.1.2.2 yamt while (1 /* CONSTCOND */) { 283 1.1.2.2 yamt if ((rv = 284 1.1.2.2 yamt tsleep(&unit->hci_eventq, PCATCH, "bth4init", 0)) != 0) 285 1.1.2.2 yamt return rv; 286 1.1.2.2 yamt 287 1.1.2.2 yamt MBUFQ_DEQUEUE(&unit->hci_eventq, *mp); 288 1.1.2.2 yamt unit->hci_eventqlen--; 289 1.1.2.2 yamt KASSERT(*mp != NULL); 290 1.1.2.2 yamt 291 1.1.2.2 yamt e = mtod(*mp, hci_event_hdr_t *); 292 1.1.2.2 yamt if (e->event == HCI_EVENT_COMMAND_COMPL) { 293 1.1.2.2 yamt hci_command_compl_ep *ep; 294 1.1.2.2 yamt 295 1.1.2.2 yamt ep = (hci_command_compl_ep *)(e + 1); 296 1.1.2.2 yamt if (ep->opcode == opcode) { 297 1.1.2.2 yamt status = *(char *)(ep + 1); 298 1.1.2.2 yamt break; 299 1.1.2.2 yamt } 300 1.1.2.2 yamt } else if (e->event == HCI_EVENT_COMMAND_STATUS) { 301 1.1.2.2 yamt hci_command_status_ep *ep; 302 1.1.2.2 yamt 303 1.1.2.2 yamt ep = (hci_command_status_ep *)(e + 1); 304 1.1.2.2 yamt if (ep->opcode == opcode) { 305 1.1.2.2 yamt status = ep->status; 306 1.1.2.2 yamt break; 307 1.1.2.2 yamt } 308 1.1.2.2 yamt } else if (e->event == HCI_EVENT_VENDOR) 309 1.1.2.2 yamt break; 310 1.1.2.2 yamt } 311 1.1.2.2 yamt 312 1.1.2.2 yamt return status; 313 1.1.2.2 yamt } 314 1.1.2.2 yamt 315 1.1.2.2 yamt static int 316 1.1.2.2 yamt bth4_firmload(struct btuart_softc *sc, char *filename, 317 1.1.2.2 yamt int (*func_firmload)(struct btuart_softc *, int, char *)) 318 1.1.2.2 yamt { 319 1.1.2.5 yamt const cfdriver_t cd = device_cfdriver(sc->sc_dev); 320 1.1.2.2 yamt firmware_handle_t fh = NULL; 321 1.1.2.2 yamt int error, size; 322 1.1.2.2 yamt char *buf; 323 1.1.2.2 yamt 324 1.1.2.2 yamt if ((error = firmware_open(cd->cd_name, filename, &fh)) != 0) { 325 1.1.2.6 yamt aprint_error_dev(sc->sc_dev, "firmware_open failed: %s\n", 326 1.1.2.6 yamt filename); 327 1.1.2.2 yamt return error; 328 1.1.2.2 yamt } 329 1.1.2.2 yamt size = firmware_get_size(fh); 330 1.1.2.2 yamt if ((buf = firmware_malloc(size)) != NULL) { 331 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, "firmware_malloc failed\n"); 332 1.1.2.2 yamt firmware_close(fh); 333 1.1.2.2 yamt return ENOMEM; 334 1.1.2.2 yamt } 335 1.1.2.2 yamt 336 1.1.2.2 yamt if ((error = firmware_read(fh, 0, buf, size)) != 0) 337 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, "firmware_read failed\n"); 338 1.1.2.2 yamt if (error == 0) 339 1.1.2.2 yamt error = (*func_firmload)(sc, size, buf); 340 1.1.2.2 yamt 341 1.1.2.2 yamt firmware_close(fh); 342 1.1.2.2 yamt firmware_free(buf, size); 343 1.1.2.2 yamt 344 1.1.2.2 yamt return error; 345 1.1.2.2 yamt } 346 1.1.2.2 yamt 347 1.1.2.2 yamt /* 348 1.1.2.2 yamt * LSI initialize functions. 349 1.1.2.2 yamt */ 350 1.1.2.2 yamt static int 351 1.1.2.2 yamt init_ericsson(struct btuart_softc *sc) 352 1.1.2.2 yamt { 353 1.1.2.2 yamt struct mbuf *m; 354 1.1.2.2 yamt hci_cmd_hdr_t *p; 355 1.1.2.2 yamt int i, error = 0; 356 1.1.2.2 yamt const uint16_t opcode = htole16(HCI_CMD_ERICSSON_SET_UART_BAUD_RATE); 357 1.1.2.2 yamt static struct { 358 1.1.2.2 yamt int baud; 359 1.1.2.2 yamt uint8_t param; 360 1.1.2.2 yamt } ericsson_baudtbl[] = { 361 1.1.2.2 yamt { B460800, 0x00 }, 362 1.1.2.2 yamt { B230400, 0x01 }, 363 1.1.2.2 yamt { B115200, 0x02 }, 364 1.1.2.2 yamt { B57600, 0x03 }, 365 1.1.2.2 yamt { B28800, 0x04 }, 366 1.1.2.2 yamt { B14400, 0x05 }, 367 1.1.2.2 yamt { B7200, 0x06 }, 368 1.1.2.2 yamt #if defined(B3600) 369 1.1.2.2 yamt { B3600, 0x07 }, 370 1.1.2.2 yamt #endif 371 1.1.2.2 yamt { B1800, 0x08 }, 372 1.1.2.2 yamt #if defined(B900) 373 1.1.2.2 yamt { B900, 0x09 }, 374 1.1.2.2 yamt #endif 375 1.1.2.2 yamt #if defined(B153600) 376 1.1.2.2 yamt { B153600, 0x10 }, 377 1.1.2.2 yamt #endif 378 1.1.2.2 yamt { B76800, 0x11 }, 379 1.1.2.2 yamt { B38400, 0x12 }, 380 1.1.2.2 yamt { B19200, 0x13 }, 381 1.1.2.2 yamt { B9600, 0x14 }, 382 1.1.2.2 yamt { B4800, 0x15 }, 383 1.1.2.2 yamt { B2400, 0x16 }, 384 1.1.2.2 yamt { B1200, 0x17 }, 385 1.1.2.2 yamt { B600, 0x18 }, 386 1.1.2.2 yamt { B300, 0x19 }, 387 1.1.2.2 yamt { B921600, 0x20 }, 388 1.1.2.6 yamt { 200000, 0x25 }, 389 1.1.2.6 yamt { 300000, 0x27 }, 390 1.1.2.6 yamt { 400000, 0x2b }, 391 1.1.2.2 yamt { B0, 0xff } 392 1.1.2.2 yamt }; 393 1.1.2.2 yamt 394 1.1.2.2 yamt for (i = 0; ericsson_baudtbl[i].baud != sc->sc_baud; i++) 395 1.1.2.2 yamt if (ericsson_baudtbl[i].baud == B0) 396 1.1.2.2 yamt return EINVAL; 397 1.1.2.2 yamt 398 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 399 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 400 1.1.2.2 yamt p->type = HCI_CMD_PKT; 401 1.1.2.2 yamt p->opcode = opcode; 402 1.1.2.2 yamt p->length = sizeof(ericsson_baudtbl[0].param); 403 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 404 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, 405 1.1.2.2 yamt &ericsson_baudtbl[i].param); 406 1.1.2.2 yamt 407 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 408 1.1.2.2 yamt 409 1.1.2.2 yamt #if 0 410 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 411 1.1.2.2 yamt if (m != NULL) { 412 1.1.2.2 yamt if (error != 0) { 413 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 414 1.1.2.5 yamt "EricssonSetUARTBaudRate failed: Status 0x%02x\n", 415 1.1.2.5 yamt error); 416 1.1.2.2 yamt error = EFAULT; 417 1.1.2.2 yamt } 418 1.1.2.2 yamt m_freem(m); 419 1.1.2.2 yamt } 420 1.1.2.2 yamt #else 421 1.1.2.2 yamt /* 422 1.1.2.2 yamt * XXXX: We cannot correctly receive this response perhaps. Wait 423 1.1.2.2 yamt * until the transmission of the data of 5 bytes * 10 bit is completed. 424 1.1.2.2 yamt * 1000000usec * 10bit * 5byte / baud 425 1.1.2.2 yamt */ 426 1.1.2.2 yamt delay(50000000 / sc->sc_bth4hci.init_baud); 427 1.1.2.2 yamt #endif 428 1.1.2.2 yamt return error; 429 1.1.2.2 yamt } 430 1.1.2.2 yamt 431 1.1.2.2 yamt static int 432 1.1.2.2 yamt init_digi(struct btuart_softc *sc) 433 1.1.2.2 yamt { 434 1.1.2.2 yamt struct mbuf *m; 435 1.1.2.2 yamt hci_cmd_hdr_t *p; 436 1.1.2.2 yamt uint8_t param; 437 1.1.2.2 yamt 438 1.1.2.2 yamt /* XXXX */ 439 1.1.2.2 yamt switch (sc->sc_baud) { 440 1.1.2.2 yamt case B57600: 441 1.1.2.2 yamt param = 0x08; 442 1.1.2.2 yamt break; 443 1.1.2.2 yamt 444 1.1.2.2 yamt case B115200: 445 1.1.2.2 yamt param = 0x09; 446 1.1.2.2 yamt break; 447 1.1.2.2 yamt 448 1.1.2.2 yamt default: 449 1.1.2.2 yamt return EINVAL; 450 1.1.2.2 yamt } 451 1.1.2.2 yamt 452 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 453 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 454 1.1.2.2 yamt p->type = HCI_CMD_PKT; 455 1.1.2.2 yamt #define HCI_CMD_DIGIANSWER_SET_UART_BAUD_RATE 0xfc07 /* XXXX */ 456 1.1.2.2 yamt p->opcode = htole16(HCI_CMD_DIGIANSWER_SET_UART_BAUD_RATE); 457 1.1.2.2 yamt p->length = sizeof(param); 458 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 459 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, ¶m); 460 1.1.2.2 yamt 461 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 462 1.1.2.2 yamt 463 1.1.2.2 yamt /* 464 1.1.2.2 yamt * XXXX 465 1.1.2.2 yamt * Wait until the transmission of the data of 5 bytes * 10 bit is 466 1.1.2.2 yamt * completed. 467 1.1.2.2 yamt * 1000000usec * 10bit * 5byte / baud 468 1.1.2.2 yamt */ 469 1.1.2.2 yamt delay(50000000 / sc->sc_bth4hci.init_baud); 470 1.1.2.2 yamt return 0; 471 1.1.2.2 yamt } 472 1.1.2.2 yamt 473 1.1.2.2 yamt static int 474 1.1.2.2 yamt init_texas(struct btuart_softc *sc) 475 1.1.2.2 yamt { 476 1.1.2.2 yamt 477 1.1.2.2 yamt /* XXXX: Should we obtain the version of LMP? */ 478 1.1.2.2 yamt return 0; 479 1.1.2.2 yamt } 480 1.1.2.2 yamt 481 1.1.2.2 yamt static int 482 1.1.2.2 yamt init_csr(struct btuart_softc *sc) 483 1.1.2.2 yamt { 484 1.1.2.2 yamt struct mbuf *m; 485 1.1.2.2 yamt hci_cmd_hdr_t *p; 486 1.1.2.2 yamt int error; 487 1.1.2.2 yamt const uint16_t opcode = htole16(HCI_CMD_CSR_EXTN); 488 1.1.2.2 yamt struct { 489 1.1.2.2 yamt uint8_t last :1; 490 1.1.2.2 yamt uint8_t first :1; 491 1.1.2.2 yamt #define CSR_BCCMD_CHANID_BCCMD 2 492 1.1.2.2 yamt #define CSR_BCCMD_CHANID_HQ 3 493 1.1.2.2 yamt #define CSR_BCCMD_CHANID_DEVMGRLIB 4 494 1.1.2.2 yamt #define CSR_BCCMD_CHANID_L2CAPLIB 8 495 1.1.2.2 yamt #define CSR_BCCMD_CHANID_RFCOMMLIB 9 496 1.1.2.2 yamt #define CSR_BCCMD_CHANID_SDPLIB 10 497 1.1.2.2 yamt #define CSR_BCCMD_CHANID_DFU 12 498 1.1.2.2 yamt #define CSR_BCCMD_CHANID_VM 13 499 1.1.2.2 yamt #define CSR_BCCMD_CHANID_LMDEBUG 20 500 1.1.2.2 yamt uint8_t chanid :6; 501 1.1.2.2 yamt 502 1.1.2.2 yamt struct { 503 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_TYPE_GETREQ 0x0000 504 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_TYPE_GETRESP 0x0001 505 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_TYPE_SETREQ 0x0002 506 1.1.2.2 yamt uint16_t type; 507 1.1.2.2 yamt uint16_t length; 508 1.1.2.2 yamt uint16_t seqno; 509 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART 0x6802 510 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_STOPB 0x2000 511 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_PARENB 0x4000 512 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_VARID_CONFIG_UART_PARODD 0x8000 513 1.1.2.2 yamt uint16_t varid; 514 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_OK 0x0000 515 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_NO_SUCH_VARID 0x0001 516 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_TOO_BIG 0x0002 517 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_NO_VALUE 0x0003 518 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_BAD_REQ 0x0004 519 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_NO_ACCESS 0x0005 520 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_READ_ONLY 0x0006 521 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_WRITE_ONLY 0x0007 522 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_ERROR 0x0008 523 1.1.2.2 yamt #define CSR_BCCMD_MESSAGE_STATUS_PERMISION_DENIED 0x0009 524 1.1.2.2 yamt uint16_t status; 525 1.1.2.2 yamt uint16_t payload[4]; 526 1.1.2.2 yamt } message; 527 1.1.2.2 yamt } bccmd; 528 1.1.2.2 yamt 529 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 530 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 531 1.1.2.2 yamt p->type = HCI_CMD_PKT; 532 1.1.2.2 yamt p->opcode = opcode; 533 1.1.2.2 yamt p->length = sizeof(bccmd); 534 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 535 1.1.2.2 yamt 536 1.1.2.2 yamt /* setup BCSP command packet */ 537 1.1.2.2 yamt bccmd.last = 1; 538 1.1.2.2 yamt bccmd.first = 1; 539 1.1.2.2 yamt bccmd.chanid = CSR_BCCMD_CHANID_BCCMD; 540 1.1.2.2 yamt bccmd.message.type = htole16(CSR_BCCMD_MESSAGE_TYPE_SETREQ); 541 1.1.2.2 yamt bccmd.message.length = htole16(sizeof(bccmd.message) >> 1); 542 1.1.2.2 yamt bccmd.message.seqno = htole16(0); 543 1.1.2.2 yamt bccmd.message.varid = htole16(CSR_BCCMD_MESSAGE_VARID_CONFIG_UART); 544 1.1.2.2 yamt bccmd.message.status = htole16(CSR_BCCMD_MESSAGE_STATUS_OK); 545 1.1.2.2 yamt memset(bccmd.message.payload, 0, sizeof(bccmd.message.payload)); 546 1.1.2.2 yamt 547 1.1.2.2 yamt /* Value = (baud rate / 244.140625) | no parity | 1 stop bit. */ 548 1.1.2.2 yamt bccmd.message.payload[0] = htole16((sc->sc_baud * 64 + 7812) / 15625); 549 1.1.2.2 yamt 550 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &bccmd); 551 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 552 1.1.2.2 yamt 553 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 554 1.1.2.2 yamt if (m != NULL) { 555 1.1.2.2 yamt /* 556 1.1.2.2 yamt * XXXX: 557 1.1.2.2 yamt * We will have to check the HCI_EVENT_VENDOR packet. For 558 1.1.2.3 yamt * instance, it might be a different HCI_EVENT_VENDOR packet. 559 1.1.2.2 yamt */ 560 1.1.2.2 yamt if (error != 0) { 561 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 562 1.1.2.5 yamt "CSR set UART speed failed: Status 0x%02x\n", 563 1.1.2.5 yamt error); 564 1.1.2.2 yamt error = EFAULT; 565 1.1.2.2 yamt } 566 1.1.2.2 yamt m_freem(m); 567 1.1.2.2 yamt } 568 1.1.2.2 yamt 569 1.1.2.2 yamt return error; 570 1.1.2.2 yamt } 571 1.1.2.2 yamt 572 1.1.2.2 yamt static int 573 1.1.2.2 yamt init_swave(struct btuart_softc *sc) 574 1.1.2.2 yamt { 575 1.1.2.2 yamt struct mbuf *m; 576 1.1.2.2 yamt hci_cmd_hdr_t *p; 577 1.1.2.2 yamt hci_event_hdr_t *e; 578 1.1.2.2 yamt int i, error; 579 1.1.2.2 yamt #define HCI_CMD_SWAVE_SET_UART_BAUD_RATE 0xfc0b /* XXXX */ 580 1.1.2.2 yamt const uint16_t opcode = htole16(HCI_CMD_SWAVE_SET_UART_BAUD_RATE); 581 1.1.2.2 yamt char param[6], *resp; 582 1.1.2.2 yamt static struct { /* XXXX */ 583 1.1.2.2 yamt int baud; 584 1.1.2.2 yamt uint8_t param; 585 1.1.2.2 yamt } swave_baudtbl[] = { 586 1.1.2.2 yamt { B19200, 0x03 }, 587 1.1.2.2 yamt { B38400, 0x02 }, 588 1.1.2.2 yamt { B57600, 0x01 }, 589 1.1.2.2 yamt { B115200, 0x00 }, 590 1.1.2.2 yamt { B0, 0xff } 591 1.1.2.2 yamt }; 592 1.1.2.2 yamt 593 1.1.2.2 yamt for (i = 0; swave_baudtbl[i].baud != sc->sc_baud; i++) 594 1.1.2.2 yamt if (swave_baudtbl[i].baud == B0) 595 1.1.2.2 yamt return EINVAL; 596 1.1.2.2 yamt 597 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 598 1.1.2.2 yamt /* first send 'param access set' command. */ 599 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 600 1.1.2.2 yamt p->type = HCI_CMD_PKT; 601 1.1.2.2 yamt p->opcode = opcode; 602 1.1.2.2 yamt p->length = sizeof(param); 603 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 604 1.1.2.2 yamt 605 1.1.2.2 yamt /* XXXX */ 606 1.1.2.2 yamt param[0] = 0x01; /* param sub command */ 607 1.1.2.2 yamt param[1] = 0x11; /* HCI Tranport Params */ 608 1.1.2.2 yamt param[2] = 0x03; /* length of the parameter following */ 609 1.1.2.2 yamt param[3] = 0x01; /* HCI Transport flow control enable */ 610 1.1.2.2 yamt param[4] = 0x01; /* HCI Transport Type = UART */ 611 1.1.2.2 yamt param[5] = swave_baudtbl[i].param; 612 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, ¶m); 613 1.1.2.2 yamt 614 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 615 1.1.2.2 yamt 616 1.1.2.2 yamt while(1 /* CONSTCOND */) { 617 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 618 1.1.2.2 yamt if (error != 0) { 619 1.1.2.2 yamt if (m != NULL) 620 1.1.2.2 yamt m_freem(m); 621 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 622 1.1.2.5 yamt "swave set baud rate command failed: error 0x%02x\n", 623 1.1.2.5 yamt error); 624 1.1.2.2 yamt return error; 625 1.1.2.2 yamt } 626 1.1.2.2 yamt if (m != NULL) { 627 1.1.2.2 yamt e = mtod(m, hci_event_hdr_t *); 628 1.1.2.2 yamt resp = (char *)(e + 1); 629 1.1.2.2 yamt if (e->length == 7 && *resp == 0xb && 630 1.1.2.2 yamt memcmp(resp + 1, param, sizeof(param)) == 0) 631 1.1.2.2 yamt break; 632 1.1.2.2 yamt m_freem(m); 633 1.1.2.2 yamt } 634 1.1.2.2 yamt } 635 1.1.2.2 yamt 636 1.1.2.2 yamt /* send 'reset' command consecutively. */ 637 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 638 1.1.2.2 yamt p->type = HCI_CMD_PKT; 639 1.1.2.2 yamt p->opcode = htole16(HCI_CMD_RESET); 640 1.1.2.2 yamt p->length = 0; 641 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 642 1.1.2.2 yamt 643 1.1.2.2 yamt /* 644 1.1.2.2 yamt * XXXX 645 1.1.2.2 yamt * Wait until the transmission of the data of 4 bytes * 10 bit is 646 1.1.2.2 yamt * completed. 647 1.1.2.2 yamt * 1000000usec * 10bit * 4byte / baud 648 1.1.2.2 yamt */ 649 1.1.2.2 yamt delay(40000000 / sc->sc_bth4hci.init_baud); 650 1.1.2.2 yamt return 0; 651 1.1.2.2 yamt } 652 1.1.2.2 yamt 653 1.1.2.2 yamt static int 654 1.1.2.2 yamt init_st(struct btuart_softc *sc) 655 1.1.2.2 yamt { 656 1.1.2.2 yamt struct mbuf *m; 657 1.1.2.2 yamt hci_cmd_hdr_t *p; 658 1.1.2.2 yamt int i; 659 1.1.2.2 yamt static struct { /* XXXX */ 660 1.1.2.2 yamt int baud; 661 1.1.2.2 yamt uint8_t param; 662 1.1.2.2 yamt } st_baudtbl[] = { 663 1.1.2.2 yamt { B9600, 0x09 }, 664 1.1.2.2 yamt { B19200, 0x0b }, 665 1.1.2.2 yamt { B38400, 0x0d }, 666 1.1.2.2 yamt { B57600, 0x0e }, 667 1.1.2.2 yamt { B115200, 0x10 }, 668 1.1.2.2 yamt { B230400, 0x12 }, 669 1.1.2.2 yamt { B460800, 0x13 }, 670 1.1.2.2 yamt { B921600, 0x14 }, 671 1.1.2.2 yamt { B0, 0xff } 672 1.1.2.2 yamt }; 673 1.1.2.2 yamt 674 1.1.2.2 yamt for (i = 0; st_baudtbl[i].baud != sc->sc_baud; i++) 675 1.1.2.2 yamt if (st_baudtbl[i].baud == B0) 676 1.1.2.2 yamt return EINVAL; 677 1.1.2.2 yamt 678 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 679 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 680 1.1.2.2 yamt p->type = HCI_CMD_PKT; 681 1.1.2.2 yamt #define HCI_CMD_ST_SET_UART_BAUD_RATE 0xfc46 /* XXXX */ 682 1.1.2.2 yamt p->opcode = htole16(HCI_CMD_ST_SET_UART_BAUD_RATE); 683 1.1.2.2 yamt p->length = sizeof(st_baudtbl[0].param); 684 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 685 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, &st_baudtbl[i].param); 686 1.1.2.2 yamt 687 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 688 1.1.2.2 yamt 689 1.1.2.2 yamt /* 690 1.1.2.2 yamt * XXXX 691 1.1.2.2 yamt * Wait until the transmission of the data of 5 bytes * 10 bit is 692 1.1.2.2 yamt * completed. 693 1.1.2.2 yamt * 1000000usec * 10bit * 5byte / baud 694 1.1.2.2 yamt */ 695 1.1.2.2 yamt delay(50000000 / sc->sc_bth4hci.init_baud); 696 1.1.2.2 yamt return 0; 697 1.1.2.2 yamt } 698 1.1.2.2 yamt 699 1.1.2.2 yamt static int 700 1.1.2.2 yamt firmload_stlc2500(struct btuart_softc *sc, int size, char *buf) 701 1.1.2.2 yamt { 702 1.1.2.2 yamt struct mbuf *m; 703 1.1.2.2 yamt hci_cmd_hdr_t *p; 704 1.1.2.2 yamt int error, offset, n; 705 1.1.2.2 yamt uint16_t opcode = htole16(0xfc2e); /* XXXX */ 706 1.1.2.2 yamt uint8_t seq; 707 1.1.2.2 yamt 708 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 709 1.1.2.2 yamt seq = 0; 710 1.1.2.2 yamt offset = 0; 711 1.1.2.2 yamt error = 0; 712 1.1.2.2 yamt while (offset < size) { 713 1.1.2.2 yamt n = size - offset < 254 ? size - offset : 254; 714 1.1.2.2 yamt 715 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 716 1.1.2.2 yamt p->type = HCI_CMD_PKT; 717 1.1.2.2 yamt p->opcode = opcode; 718 1.1.2.2 yamt p->length = n; 719 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 720 1.1.2.2 yamt *(char *)(p + 1) = seq; 721 1.1.2.2 yamt m_copyback(m, 722 1.1.2.2 yamt sizeof(hci_cmd_hdr_t) + 1, p->length, buf + offset); 723 1.1.2.2 yamt 724 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 725 1.1.2.2 yamt 726 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 727 1.1.2.2 yamt if (m != NULL) { 728 1.1.2.2 yamt if (error != 0) { 729 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 730 1.1.2.5 yamt "stlc2500 firmware load failed: Status 0x%02x\n", 731 1.1.2.5 yamt error); 732 1.1.2.2 yamt error = EFAULT; 733 1.1.2.2 yamt break; 734 1.1.2.2 yamt } 735 1.1.2.2 yamt } 736 1.1.2.2 yamt 737 1.1.2.2 yamt seq++; 738 1.1.2.2 yamt offset += n; 739 1.1.2.2 yamt } 740 1.1.2.2 yamt m_freem(m); 741 1.1.2.2 yamt 742 1.1.2.2 yamt return error; 743 1.1.2.2 yamt } 744 1.1.2.2 yamt 745 1.1.2.2 yamt static int 746 1.1.2.2 yamt init_stlc2500(struct btuart_softc *sc) 747 1.1.2.2 yamt { 748 1.1.2.2 yamt struct mbuf *m; 749 1.1.2.2 yamt hci_cmd_hdr_t *p; 750 1.1.2.2 yamt hci_event_hdr_t *e; 751 1.1.2.2 yamt hci_read_local_ver_rp *lv; 752 1.1.2.2 yamt int error, revision, i; 753 1.1.2.2 yamt uint16_t opcode; 754 1.1.2.2 yamt char filename[NAME_MAX], param[8]; 755 1.1.2.2 yamt static const char filenametmpl[] = "STLC2500_R%d_%02d%s"; 756 1.1.2.2 yamt const char *suffix[] = { ".ptc", ".ssf", NULL }; 757 1.1.2.2 yamt 758 1.1.2.6 yamt /* STLC2500 has an ericsson core */ 759 1.1.2.6 yamt error = init_ericsson(sc); 760 1.1.2.6 yamt if (error != 0) 761 1.1.2.6 yamt return error; 762 1.1.2.6 yamt 763 1.1.2.6 yamt if (sc->sc_bth4hci.init_baud != 0 && 764 1.1.2.6 yamt sc->sc_bth4hci.init_baud != sc->sc_baud) { 765 1.1.2.6 yamt struct tty *tp = sc->sc_tp; 766 1.1.2.6 yamt struct termios t; 767 1.1.2.6 yamt 768 1.1.2.6 yamt t.c_ispeed = 0; 769 1.1.2.6 yamt t.c_ospeed = sc->sc_baud; 770 1.1.2.6 yamt t.c_cflag = tp->t_cflag; 771 1.1.2.6 yamt error = (*tp->t_param)(tp, &t); 772 1.1.2.6 yamt if (error != 0) 773 1.1.2.6 yamt return error; 774 1.1.2.6 yamt } 775 1.1.2.6 yamt 776 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 777 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 778 1.1.2.6 yamt #define HCI_CMD_ERICSSON_READ_REVISION_INFORMATION 0xfc0f /* XXXX */ 779 1.1.2.6 yamt opcode = htole16(HCI_CMD_ERICSSON_READ_REVISION_INFORMATION); 780 1.1.2.6 yamt p->type = HCI_CMD_PKT; 781 1.1.2.6 yamt p->opcode = opcode; 782 1.1.2.6 yamt p->length = 0; 783 1.1.2.6 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 784 1.1.2.6 yamt 785 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 786 1.1.2.6 yamt 787 1.1.2.6 yamt error = bth4_waitresp(sc, &m, opcode); 788 1.1.2.6 yamt if (m != NULL) { 789 1.1.2.6 yamt if (error != 0) { 790 1.1.2.6 yamt aprint_error_dev(sc->sc_dev, 791 1.1.2.6 yamt "HCI_Ericsson_Read_Reversion_Information failed:" 792 1.1.2.6 yamt " Status 0x%02x\n", error); 793 1.1.2.6 yamt error = EFAULT; 794 1.1.2.6 yamt m_freem(m); 795 1.1.2.6 yamt } 796 1.1.2.6 yamt } 797 1.1.2.6 yamt if (error != 0) 798 1.1.2.6 yamt return error; 799 1.1.2.6 yamt 800 1.1.2.6 yamt p = mtod(m, hci_cmd_hdr_t *); 801 1.1.2.2 yamt opcode = htole16(HCI_CMD_READ_LOCAL_VER); 802 1.1.2.2 yamt p->type = HCI_CMD_PKT; 803 1.1.2.2 yamt p->opcode = opcode; 804 1.1.2.2 yamt p->length = 0; 805 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 806 1.1.2.2 yamt 807 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 808 1.1.2.2 yamt 809 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 810 1.1.2.2 yamt if (m != NULL) { 811 1.1.2.2 yamt if (error != 0) { 812 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 813 1.1.2.5 yamt "HCI_Read_Local_Version_Information failed:" 814 1.1.2.5 yamt " Status 0x%02x\n", error); 815 1.1.2.2 yamt error = EFAULT; 816 1.1.2.2 yamt m_freem(m); 817 1.1.2.2 yamt } 818 1.1.2.2 yamt } 819 1.1.2.2 yamt if (error != 0) 820 1.1.2.2 yamt return error; 821 1.1.2.2 yamt 822 1.1.2.2 yamt e = mtod(m, hci_event_hdr_t *); 823 1.1.2.2 yamt lv = (hci_read_local_ver_rp *)(e + 1); 824 1.1.2.2 yamt revision = le16toh(lv->hci_revision); 825 1.1.2.2 yamt for (i = 0; suffix[i] != NULL; i++) { 826 1.1.2.2 yamt /* send firmware */ 827 1.1.2.2 yamt snprintf(filename, sizeof(filename), filenametmpl, 828 1.1.2.2 yamt (uint8_t)(revision >> 8), (uint8_t)revision, suffix[i]); 829 1.1.2.2 yamt bth4_firmload(sc, filename, firmload_stlc2500); 830 1.1.2.6 yamt } 831 1.1.2.2 yamt 832 1.1.2.6 yamt /* 833 1.1.2.6 yamt * XXXX: 834 1.1.2.6 yamt * We do not know the beginning point of this character string. 835 1.1.2.6 yamt * Because it doesn't know the event of this packet. 836 1.1.2.6 yamt * 837 1.1.2.6 yamt * aprint_error_dev(sc->sc_dev, "%s\n", ???); 838 1.1.2.6 yamt */ 839 1.1.2.2 yamt 840 1.1.2.6 yamt p = mtod(m, hci_cmd_hdr_t *); 841 1.1.2.6 yamt #define HCI_CMD_ST_STORE_IN_NVDS 0xfc22 /* XXXX */ 842 1.1.2.6 yamt opcode = htole16(HCI_CMD_ST_STORE_IN_NVDS); 843 1.1.2.6 yamt p->type = HCI_CMD_PKT; 844 1.1.2.6 yamt p->opcode = opcode; 845 1.1.2.6 yamt p->length = sizeof(param); 846 1.1.2.6 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 847 1.1.2.2 yamt 848 1.1.2.6 yamt /* XXXX */ 849 1.1.2.6 yamt param[0] = 0xfe; 850 1.1.2.6 yamt param[1] = 0x06; 851 1.1.2.6 yamt param[2] = 0xba; 852 1.1.2.6 yamt param[3] = 0xab; 853 1.1.2.6 yamt param[4] = 0x00; 854 1.1.2.6 yamt param[5] = 0xe1; 855 1.1.2.6 yamt param[6] = 0x80; 856 1.1.2.6 yamt param[7] = 0x00; 857 1.1.2.6 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, param); 858 1.1.2.6 yamt 859 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 860 1.1.2.6 yamt 861 1.1.2.6 yamt error = bth4_waitresp(sc, &m, opcode); 862 1.1.2.6 yamt if (m != NULL) { 863 1.1.2.6 yamt if (error != 0) { 864 1.1.2.6 yamt aprint_error_dev(sc->sc_dev, 865 1.1.2.6 yamt "failed: opcode 0xfc0f Status 0x%02x\n", error); 866 1.1.2.6 yamt error = EFAULT; 867 1.1.2.6 yamt m_freem(m); 868 1.1.2.2 yamt } 869 1.1.2.2 yamt } 870 1.1.2.6 yamt if (error != 0) 871 1.1.2.6 yamt return error; 872 1.1.2.2 yamt 873 1.1.2.6 yamt opcode = htole16(HCI_CMD_RESET); 874 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 875 1.1.2.2 yamt p->type = HCI_CMD_PKT; 876 1.1.2.2 yamt p->opcode = opcode; 877 1.1.2.2 yamt p->length = 0; 878 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 879 1.1.2.2 yamt 880 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 881 1.1.2.2 yamt 882 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 883 1.1.2.2 yamt if (m != NULL) { 884 1.1.2.2 yamt if (error != 0) { 885 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 886 1.1.2.6 yamt "HCI_Reset failed: Status 0x%02x\n", error); 887 1.1.2.2 yamt error = EFAULT; 888 1.1.2.2 yamt m_freem(m); 889 1.1.2.2 yamt } 890 1.1.2.2 yamt } 891 1.1.2.2 yamt 892 1.1.2.6 yamt return error; 893 1.1.2.6 yamt } 894 1.1.2.6 yamt 895 1.1.2.6 yamt static int 896 1.1.2.6 yamt init_bgb2xx(struct btuart_softc *sc) 897 1.1.2.6 yamt { 898 1.1.2.6 yamt struct mbuf *m; 899 1.1.2.6 yamt hci_cmd_hdr_t *p; 900 1.1.2.6 yamt int error; 901 1.1.2.6 yamt uint16_t opcode; 902 1.1.2.6 yamt char param[8]; 903 1.1.2.6 yamt 904 1.1.2.6 yamt m = m_gethdr(M_WAIT, MT_DATA); 905 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 906 1.1.2.6 yamt opcode = htole16(HCI_CMD_ST_STORE_IN_NVDS); 907 1.1.2.2 yamt p->type = HCI_CMD_PKT; 908 1.1.2.2 yamt p->opcode = opcode; 909 1.1.2.2 yamt p->length = sizeof(param); 910 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 911 1.1.2.2 yamt 912 1.1.2.2 yamt /* XXXX */ 913 1.1.2.2 yamt param[0] = 0xfe; 914 1.1.2.2 yamt param[1] = 0x06; 915 1.1.2.6 yamt param[2] = 0xbd; 916 1.1.2.6 yamt param[3] = 0xb2; 917 1.1.2.6 yamt param[4] = 0x10; 918 1.1.2.6 yamt param[5] = 0x00; 919 1.1.2.6 yamt param[6] = 0xab; 920 1.1.2.6 yamt param[7] = 0xba; 921 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, param); 922 1.1.2.2 yamt 923 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 924 1.1.2.2 yamt 925 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 926 1.1.2.2 yamt if (m != NULL) { 927 1.1.2.2 yamt if (error != 0) { 928 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 929 1.1.2.5 yamt "failed: opcode 0xfc0f Status 0x%02x\n", error); 930 1.1.2.2 yamt error = EFAULT; 931 1.1.2.2 yamt m_freem(m); 932 1.1.2.2 yamt } 933 1.1.2.2 yamt } 934 1.1.2.2 yamt if (error != 0) 935 1.1.2.2 yamt return error; 936 1.1.2.2 yamt 937 1.1.2.2 yamt opcode = htole16(HCI_CMD_RESET); 938 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 939 1.1.2.2 yamt p->type = HCI_CMD_PKT; 940 1.1.2.2 yamt p->opcode = opcode; 941 1.1.2.2 yamt p->length = 0; 942 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 943 1.1.2.2 yamt 944 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 945 1.1.2.2 yamt 946 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 947 1.1.2.2 yamt if (m != NULL) { 948 1.1.2.2 yamt if (error != 0) { 949 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 950 1.1.2.5 yamt "HCI_Reset failed: Status 0x%02x\n", error); 951 1.1.2.2 yamt error = EFAULT; 952 1.1.2.2 yamt m_freem(m); 953 1.1.2.2 yamt } 954 1.1.2.2 yamt } 955 1.1.2.2 yamt 956 1.1.2.2 yamt return error; 957 1.1.2.2 yamt } 958 1.1.2.2 yamt 959 1.1.2.2 yamt static int 960 1.1.2.2 yamt init_bcm2035(struct btuart_softc *sc) 961 1.1.2.2 yamt { 962 1.1.2.2 yamt struct mbuf *m; 963 1.1.2.2 yamt hci_cmd_hdr_t *p; 964 1.1.2.2 yamt int i, error; 965 1.1.2.2 yamt #define HCI_CMD_BCM2035_SET_UART_BAUD_RATE 0xfc18 /* XXXX */ 966 1.1.2.2 yamt const uint16_t opcode = htole16(HCI_CMD_BCM2035_SET_UART_BAUD_RATE); 967 1.1.2.2 yamt static struct { /* XXXX */ 968 1.1.2.2 yamt int baud; 969 1.1.2.2 yamt uint16_t param; 970 1.1.2.2 yamt } bcm2035_baudtbl[] = { 971 1.1.2.2 yamt { B57600, 0xe600 }, 972 1.1.2.2 yamt { B230400, 0xfa22 }, 973 1.1.2.2 yamt { B460800, 0xfd11 }, 974 1.1.2.2 yamt { B921600, 0xff65 }, 975 1.1.2.2 yamt { B0, 0xffff } 976 1.1.2.2 yamt }; 977 1.1.2.2 yamt 978 1.1.2.2 yamt for (i = 0; bcm2035_baudtbl[i].baud != sc->sc_baud; i++) 979 1.1.2.2 yamt if (bcm2035_baudtbl[i].baud == -1) 980 1.1.2.2 yamt return EINVAL; 981 1.1.2.2 yamt 982 1.1.2.2 yamt m = m_gethdr(M_WAIT, MT_DATA); 983 1.1.2.2 yamt 984 1.1.2.2 yamt /* 985 1.1.2.2 yamt * XXXX: Should we send some commands? 986 1.1.2.6 yamt * HCI_CMD_RESET and Set BD_ADDR and 987 1.1.2.6 yamt * HCI_CMD_READ_LOCAL_VER and HCI_CMD_READ_LOCAL_COMMANDS 988 1.1.2.2 yamt */ 989 1.1.2.2 yamt 990 1.1.2.2 yamt p = mtod(m, hci_cmd_hdr_t *); 991 1.1.2.2 yamt p->type = HCI_CMD_PKT; 992 1.1.2.2 yamt p->opcode = opcode; 993 1.1.2.2 yamt p->length = sizeof(bcm2035_baudtbl[0].param); 994 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = sizeof(hci_cmd_hdr_t); 995 1.1.2.2 yamt m_copyback(m, sizeof(hci_cmd_hdr_t), p->length, 996 1.1.2.2 yamt &bcm2035_baudtbl[i].param); 997 1.1.2.2 yamt 998 1.1.2.6 yamt bth4_output_cmd(sc->sc_dev, m); 999 1.1.2.2 yamt 1000 1.1.2.2 yamt error = bth4_waitresp(sc, &m, opcode); 1001 1.1.2.2 yamt if (m != NULL) { 1002 1.1.2.2 yamt if (error != 0) { 1003 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 1004 1.1.2.5 yamt "bcm2035 set baud rate failed: Status 0x%02x\n", 1005 1.1.2.5 yamt error); 1006 1.1.2.2 yamt error = EFAULT; 1007 1.1.2.2 yamt } 1008 1.1.2.2 yamt m_freem(m); 1009 1.1.2.2 yamt } 1010 1.1.2.2 yamt 1011 1.1.2.2 yamt return error; 1012 1.1.2.2 yamt } 1013 1.1.2.2 yamt 1014 1.1.2.2 yamt static int 1015 1.1.2.2 yamt bth4init(struct btuart_softc *sc) 1016 1.1.2.2 yamt { 1017 1.1.2.2 yamt struct tty *tp = sc->sc_tp; 1018 1.1.2.2 yamt struct termios t; 1019 1.1.2.2 yamt int error = 0, s; 1020 1.1.2.2 yamt 1021 1.1.2.2 yamt sc->sc_baud = tp->t_ospeed; 1022 1.1.2.2 yamt t.c_cflag = tp->t_cflag; 1023 1.1.2.2 yamt t.c_ispeed = 0; 1024 1.1.2.2 yamt t.c_ospeed = tp->t_ospeed; 1025 1.1.2.2 yamt if ((tp->t_cflag & CRTSCTS) && !(sc->sc_bth4hci.flags & FLOW_CTL)) 1026 1.1.2.2 yamt t.c_cflag &= ~CRTSCTS; 1027 1.1.2.2 yamt if (sc->sc_bth4hci.init_baud != 0 && 1028 1.1.2.2 yamt tp->t_ospeed != sc->sc_bth4hci.init_baud) 1029 1.1.2.2 yamt t.c_ospeed = sc->sc_bth4hci.init_baud; 1030 1.1.2.2 yamt if (t.c_ospeed != tp->t_ospeed || t.c_cflag != tp->t_cflag) 1031 1.1.2.2 yamt error = (*tp->t_param)(tp, &t); 1032 1.1.2.2 yamt 1033 1.1.2.2 yamt if (error == 0 && sc->sc_bth4hci.init != NULL) 1034 1.1.2.2 yamt error = (*sc->sc_bth4hci.init)(sc); 1035 1.1.2.2 yamt 1036 1.1.2.2 yamt s = splserial(); 1037 1.1.2.2 yamt sc->sc_input_acl = hci_input_acl; 1038 1.1.2.2 yamt sc->sc_input_sco = hci_input_sco; 1039 1.1.2.2 yamt sc->sc_input_event = hci_input_event; 1040 1.1.2.2 yamt splx(s); 1041 1.1.2.2 yamt 1042 1.1.2.2 yamt if (sc->sc_bth4hci.init_baud != 0 && 1043 1.1.2.2 yamt sc->sc_bth4hci.init_baud != sc->sc_baud) { 1044 1.1.2.2 yamt t.c_ospeed = sc->sc_baud; 1045 1.1.2.2 yamt t.c_cflag = tp->t_cflag; 1046 1.1.2.2 yamt error = (*tp->t_param)(tp, &t); 1047 1.1.2.2 yamt } 1048 1.1.2.2 yamt 1049 1.1.2.2 yamt return error; 1050 1.1.2.2 yamt } 1051 1.1.2.2 yamt 1052 1.1.2.6 yamt static bool 1053 1.1.2.2 yamt bth4init_input(struct hci_unit *unit, struct mbuf *m) 1054 1.1.2.2 yamt { 1055 1.1.2.2 yamt int i; 1056 1.1.2.2 yamt uint8_t *rptr = mtod(m, uint8_t *); 1057 1.1.2.2 yamt const char *pktstr = NULL; 1058 1.1.2.2 yamt 1059 1.1.2.2 yamt switch (*rptr) { 1060 1.1.2.2 yamt case HCI_ACL_DATA_PKT: 1061 1.1.2.2 yamt pktstr = "acl data"; 1062 1.1.2.2 yamt break; 1063 1.1.2.2 yamt 1064 1.1.2.2 yamt case HCI_SCO_DATA_PKT: 1065 1.1.2.2 yamt pktstr = "sco data"; 1066 1.1.2.2 yamt break; 1067 1.1.2.2 yamt 1068 1.1.2.2 yamt case HCI_EVENT_PKT: 1069 1.1.2.2 yamt break; 1070 1.1.2.2 yamt 1071 1.1.2.2 yamt default: 1072 1.1.2.2 yamt pktstr = "unknown"; 1073 1.1.2.2 yamt break; 1074 1.1.2.2 yamt } 1075 1.1.2.2 yamt if (pktstr != NULL) 1076 1.1.2.5 yamt aprint_error_dev(unit->hci_dev, 1077 1.1.2.5 yamt "%s packet was received in initialization phase\n", pktstr); 1078 1.1.2.2 yamt if ( 1079 1.1.2.2 yamt #ifdef BTUART_DEBUG 1080 1.1.2.2 yamt btuart_debug || 1081 1.1.2.2 yamt #endif 1082 1.1.2.2 yamt pktstr != NULL) { 1083 1.1.2.5 yamt aprint_error_dev(unit->hci_dev, "%s:", __FUNCTION__); 1084 1.1.2.2 yamt for (i = 0; i < m->m_len; i++) 1085 1.1.2.5 yamt aprint_error(" %02x", *(rptr + i)); 1086 1.1.2.5 yamt aprint_error("\n"); 1087 1.1.2.2 yamt } 1088 1.1.2.2 yamt 1089 1.1.2.2 yamt if (*rptr == HCI_EVENT_PKT) 1090 1.1.2.2 yamt if (unit->hci_eventqlen <= hci_eventq_max) { 1091 1.1.2.2 yamt unit->hci_eventqlen++; 1092 1.1.2.2 yamt MBUFQ_ENQUEUE(&unit->hci_eventq, m); 1093 1.1.2.2 yamt m = NULL; 1094 1.1.2.2 yamt wakeup(&unit->hci_eventq); 1095 1.1.2.2 yamt } 1096 1.1.2.2 yamt 1097 1.1.2.2 yamt if (m != NULL) 1098 1.1.2.2 yamt m_freem(m); 1099 1.1.2.6 yamt 1100 1.1.2.6 yamt return true; 1101 1.1.2.2 yamt } 1102 1.1.2.2 yamt 1103 1.1.2.2 yamt 1104 1.1.2.2 yamt /* 1105 1.1.2.2 yamt * Line discipline functions. 1106 1.1.2.2 yamt */ 1107 1.1.2.2 yamt /* ARGSUSED */ 1108 1.1.2.2 yamt static int 1109 1.1.2.2 yamt bth4open(dev_t device __unused, struct tty *tp) 1110 1.1.2.2 yamt { 1111 1.1.2.2 yamt struct btuart_softc *sc; 1112 1.1.2.6 yamt device_t dev; 1113 1.1.2.2 yamt struct cfdata *cfdata; 1114 1.1.2.2 yamt struct lwp *l = curlwp; /* XXX */ 1115 1.1.2.2 yamt int error, unit, s; 1116 1.1.2.2 yamt static char name[] = "btuart"; 1117 1.1.2.2 yamt 1118 1.1.2.2 yamt if ((error = kauth_authorize_device_tty(l->l_cred, 1119 1.1.2.3 yamt KAUTH_GENERIC_ISSUSER, tp)) != 0) 1120 1.1.2.2 yamt return error; 1121 1.1.2.2 yamt 1122 1.1.2.2 yamt s = spltty(); 1123 1.1.2.2 yamt 1124 1.1.2.2 yamt if (tp->t_linesw == &bth4_disc) { 1125 1.1.2.2 yamt sc = (struct btuart_softc *)tp->t_sc; 1126 1.1.2.2 yamt if (sc != NULL) { 1127 1.1.2.2 yamt splx(s); 1128 1.1.2.2 yamt return EBUSY; 1129 1.1.2.2 yamt } 1130 1.1.2.2 yamt } 1131 1.1.2.2 yamt 1132 1.1.2.2 yamt KASSERT(tp->t_oproc != NULL); 1133 1.1.2.2 yamt 1134 1.1.2.2 yamt cfdata = malloc(sizeof(struct cfdata), M_DEVBUF, M_WAITOK); 1135 1.1.2.2 yamt for (unit = 0; unit < btuart_cd.cd_ndevs; unit++) 1136 1.1.2.2 yamt if (btuart_cd.cd_devs[unit] == NULL) 1137 1.1.2.2 yamt break; 1138 1.1.2.2 yamt cfdata->cf_name = name; 1139 1.1.2.2 yamt cfdata->cf_atname = name; 1140 1.1.2.2 yamt cfdata->cf_unit = unit; 1141 1.1.2.3 yamt cfdata->cf_fstate = FSTATE_STAR; 1142 1.1.2.2 yamt 1143 1.1.2.5 yamt aprint_normal("%s%d at tty major %d minor %d", 1144 1.1.2.2 yamt name, unit, major(tp->t_dev), minor(tp->t_dev)); 1145 1.1.2.6 yamt dev = config_attach_pseudo(cfdata); 1146 1.1.2.6 yamt if (dev == NULL) { 1147 1.1.2.2 yamt splx(s); 1148 1.1.2.2 yamt return EIO; 1149 1.1.2.2 yamt } 1150 1.1.2.6 yamt sc = device_private(dev); 1151 1.1.2.5 yamt mutex_spin_enter(&tty_lock); 1152 1.1.2.2 yamt tp->t_sc = sc; 1153 1.1.2.2 yamt sc->sc_tp = tp; 1154 1.1.2.2 yamt ttyflush(tp, FREAD | FWRITE); 1155 1.1.2.5 yamt mutex_spin_exit(&tty_lock); 1156 1.1.2.2 yamt 1157 1.1.2.2 yamt splx(s); 1158 1.1.2.2 yamt 1159 1.1.2.2 yamt return 0; 1160 1.1.2.2 yamt } 1161 1.1.2.2 yamt 1162 1.1.2.2 yamt /* ARGSUSED */ 1163 1.1.2.2 yamt static int 1164 1.1.2.2 yamt bth4close(struct tty *tp, int flag __unused) 1165 1.1.2.2 yamt { 1166 1.1.2.2 yamt struct btuart_softc *sc; 1167 1.1.2.2 yamt struct cfdata *cfdata; 1168 1.1.2.2 yamt int s, baud; 1169 1.1.2.2 yamt 1170 1.1.2.2 yamt sc = tp->t_sc; 1171 1.1.2.2 yamt 1172 1.1.2.2 yamt /* reset to initial speed */ 1173 1.1.2.2 yamt if (sc->sc_bth4hci.init != NULL) { 1174 1.1.2.2 yamt baud = sc->sc_baud; 1175 1.1.2.2 yamt sc->sc_baud = sc->sc_bth4hci.init_baud; 1176 1.1.2.2 yamt sc->sc_bth4hci.init_baud = baud; 1177 1.1.2.2 yamt s = splserial(); 1178 1.1.2.2 yamt sc->sc_input_acl = bth4init_input; 1179 1.1.2.2 yamt sc->sc_input_sco = bth4init_input; 1180 1.1.2.2 yamt sc->sc_input_event = bth4init_input; 1181 1.1.2.2 yamt splx(s); 1182 1.1.2.2 yamt if ((*sc->sc_bth4hci.init)(sc) != 0) 1183 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, "reset speed fail\n"); 1184 1.1.2.2 yamt } 1185 1.1.2.2 yamt 1186 1.1.2.2 yamt s = spltty(); 1187 1.1.2.5 yamt mutex_spin_enter(&tty_lock); 1188 1.1.2.2 yamt ttyflush(tp, FREAD | FWRITE); 1189 1.1.2.5 yamt mutex_spin_exit(&tty_lock); /* XXX */ 1190 1.1.2.2 yamt ttyldisc_release(tp->t_linesw); 1191 1.1.2.2 yamt tp->t_linesw = ttyldisc_default(); 1192 1.1.2.2 yamt if (sc != NULL) { 1193 1.1.2.2 yamt tp->t_sc = NULL; 1194 1.1.2.2 yamt if (sc->sc_tp == tp) { 1195 1.1.2.5 yamt cfdata = device_cfdata(sc->sc_dev); 1196 1.1.2.5 yamt config_detach(sc->sc_dev, 0); 1197 1.1.2.2 yamt free(cfdata, M_DEVBUF); 1198 1.1.2.2 yamt } 1199 1.1.2.2 yamt 1200 1.1.2.2 yamt } 1201 1.1.2.2 yamt splx(s); 1202 1.1.2.2 yamt return 0; 1203 1.1.2.2 yamt } 1204 1.1.2.2 yamt 1205 1.1.2.2 yamt /* ARGSUSED */ 1206 1.1.2.2 yamt static int 1207 1.1.2.3 yamt bth4ioctl(struct tty *tp, u_long cmd, void *data, 1208 1.1.2.2 yamt int flag __unused, struct lwp *l __unused) 1209 1.1.2.2 yamt { 1210 1.1.2.2 yamt struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc; 1211 1.1.2.2 yamt int error, i; 1212 1.1.2.2 yamt 1213 1.1.2.2 yamt if (sc == NULL || tp != sc->sc_tp) 1214 1.1.2.2 yamt return EPASSTHROUGH; 1215 1.1.2.2 yamt 1216 1.1.2.2 yamt error = 0; 1217 1.1.2.2 yamt switch (cmd) { 1218 1.1.2.2 yamt case BTUART_HCITYPE: 1219 1.1.2.2 yamt for (i = 0; bth4hci[i].type != -1; i++) 1220 1.1.2.2 yamt if (bth4hci[i].type == *(uint32_t *)data) 1221 1.1.2.2 yamt break; 1222 1.1.2.2 yamt if (bth4hci[i].type != -1) 1223 1.1.2.2 yamt memcpy(&sc->sc_bth4hci, &bth4hci[i], 1224 1.1.2.2 yamt sizeof(struct bth4hci)); 1225 1.1.2.2 yamt else 1226 1.1.2.2 yamt error = EINVAL; 1227 1.1.2.2 yamt break; 1228 1.1.2.2 yamt 1229 1.1.2.2 yamt case BTUART_INITSPEED: 1230 1.1.2.2 yamt sc->sc_bth4hci.init_baud = *(uint32_t *)data; 1231 1.1.2.2 yamt break; 1232 1.1.2.2 yamt 1233 1.1.2.2 yamt case BTUART_START: 1234 1.1.2.2 yamt error = bth4init(sc); 1235 1.1.2.2 yamt break; 1236 1.1.2.2 yamt 1237 1.1.2.2 yamt default: 1238 1.1.2.2 yamt error = EPASSTHROUGH; 1239 1.1.2.2 yamt break; 1240 1.1.2.2 yamt } 1241 1.1.2.2 yamt 1242 1.1.2.2 yamt return error; 1243 1.1.2.2 yamt } 1244 1.1.2.2 yamt 1245 1.1.2.2 yamt static int 1246 1.1.2.2 yamt bth4input(int c, struct tty *tp) 1247 1.1.2.2 yamt { 1248 1.1.2.2 yamt struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc; 1249 1.1.2.2 yamt struct mbuf *m = sc->sc_rxp; 1250 1.1.2.2 yamt int space = 0; 1251 1.1.2.2 yamt 1252 1.1.2.2 yamt c &= TTY_CHARMASK; 1253 1.1.2.2 yamt 1254 1.1.2.2 yamt /* If we already started a packet, find the trailing end of it. */ 1255 1.1.2.2 yamt if (m) { 1256 1.1.2.2 yamt while (m->m_next) 1257 1.1.2.2 yamt m = m->m_next; 1258 1.1.2.2 yamt 1259 1.1.2.2 yamt space = M_TRAILINGSPACE(m); 1260 1.1.2.2 yamt } 1261 1.1.2.2 yamt 1262 1.1.2.2 yamt if (space == 0) { 1263 1.1.2.2 yamt if (m == NULL) { 1264 1.1.2.2 yamt /* new packet */ 1265 1.1.2.2 yamt MGETHDR(m, M_DONTWAIT, MT_DATA); 1266 1.1.2.2 yamt if (m == NULL) { 1267 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 1268 1.1.2.5 yamt "out of memory\n"); 1269 1.1.2.6 yamt sc->sc_stats.err_rx++; 1270 1.1.2.2 yamt return 0; /* (lost sync) */ 1271 1.1.2.2 yamt } 1272 1.1.2.2 yamt 1273 1.1.2.2 yamt sc->sc_rxp = m; 1274 1.1.2.2 yamt m->m_pkthdr.len = m->m_len = 0; 1275 1.1.2.2 yamt space = MHLEN; 1276 1.1.2.2 yamt 1277 1.1.2.2 yamt sc->sc_state = BTUART_RECV_PKT_TYPE; 1278 1.1.2.2 yamt sc->sc_want = 1; 1279 1.1.2.2 yamt } else { 1280 1.1.2.2 yamt /* extend mbuf */ 1281 1.1.2.2 yamt MGET(m->m_next, M_DONTWAIT, MT_DATA); 1282 1.1.2.2 yamt if (m->m_next == NULL) { 1283 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 1284 1.1.2.5 yamt "out of memory\n"); 1285 1.1.2.6 yamt sc->sc_stats.err_rx++; 1286 1.1.2.2 yamt return 0; /* (lost sync) */ 1287 1.1.2.2 yamt } 1288 1.1.2.2 yamt 1289 1.1.2.2 yamt m = m->m_next; 1290 1.1.2.2 yamt m->m_len = 0; 1291 1.1.2.2 yamt space = MLEN; 1292 1.1.2.2 yamt 1293 1.1.2.2 yamt if (sc->sc_want > MINCLSIZE) { 1294 1.1.2.2 yamt MCLGET(m, M_DONTWAIT); 1295 1.1.2.2 yamt if (m->m_flags & M_EXT) 1296 1.1.2.2 yamt space = MCLBYTES; 1297 1.1.2.2 yamt } 1298 1.1.2.2 yamt } 1299 1.1.2.2 yamt } 1300 1.1.2.2 yamt 1301 1.1.2.2 yamt mtod(m, uint8_t *)[m->m_len++] = c; 1302 1.1.2.2 yamt sc->sc_rxp->m_pkthdr.len++; 1303 1.1.2.6 yamt sc->sc_stats.byte_rx++; 1304 1.1.2.2 yamt 1305 1.1.2.2 yamt sc->sc_want--; 1306 1.1.2.2 yamt if (sc->sc_want > 0) 1307 1.1.2.2 yamt return 0; /* want more */ 1308 1.1.2.2 yamt 1309 1.1.2.2 yamt switch (sc->sc_state) { 1310 1.1.2.2 yamt case BTUART_RECV_PKT_TYPE: /* Got packet type */ 1311 1.1.2.2 yamt 1312 1.1.2.2 yamt switch (c) { 1313 1.1.2.2 yamt case HCI_ACL_DATA_PKT: 1314 1.1.2.2 yamt sc->sc_state = BTUART_RECV_ACL_HDR; 1315 1.1.2.2 yamt sc->sc_want = sizeof(hci_acldata_hdr_t) - 1; 1316 1.1.2.2 yamt break; 1317 1.1.2.2 yamt 1318 1.1.2.2 yamt case HCI_SCO_DATA_PKT: 1319 1.1.2.2 yamt sc->sc_state = BTUART_RECV_SCO_HDR; 1320 1.1.2.2 yamt sc->sc_want = sizeof(hci_scodata_hdr_t) - 1; 1321 1.1.2.2 yamt break; 1322 1.1.2.2 yamt 1323 1.1.2.2 yamt case HCI_EVENT_PKT: 1324 1.1.2.2 yamt sc->sc_state = BTUART_RECV_EVENT_HDR; 1325 1.1.2.2 yamt sc->sc_want = sizeof(hci_event_hdr_t) - 1; 1326 1.1.2.2 yamt break; 1327 1.1.2.2 yamt 1328 1.1.2.2 yamt default: 1329 1.1.2.5 yamt aprint_error_dev(sc->sc_dev, 1330 1.1.2.5 yamt "Unknown packet type=%#x!\n", c); 1331 1.1.2.6 yamt sc->sc_stats.err_rx++; 1332 1.1.2.2 yamt m_freem(sc->sc_rxp); 1333 1.1.2.2 yamt sc->sc_rxp = NULL; 1334 1.1.2.2 yamt return 0; /* (lost sync) */ 1335 1.1.2.2 yamt } 1336 1.1.2.2 yamt 1337 1.1.2.2 yamt break; 1338 1.1.2.2 yamt 1339 1.1.2.2 yamt /* 1340 1.1.2.2 yamt * we assume (correctly of course :) that the packet headers all fit 1341 1.1.2.2 yamt * into a single pkthdr mbuf 1342 1.1.2.2 yamt */ 1343 1.1.2.2 yamt case BTUART_RECV_ACL_HDR: /* Got ACL Header */ 1344 1.1.2.2 yamt sc->sc_state = BTUART_RECV_ACL_DATA; 1345 1.1.2.2 yamt sc->sc_want = mtod(m, hci_acldata_hdr_t *)->length; 1346 1.1.2.2 yamt sc->sc_want = le16toh(sc->sc_want); 1347 1.1.2.2 yamt break; 1348 1.1.2.2 yamt 1349 1.1.2.2 yamt case BTUART_RECV_SCO_HDR: /* Got SCO Header */ 1350 1.1.2.2 yamt sc->sc_state = BTUART_RECV_SCO_DATA; 1351 1.1.2.2 yamt sc->sc_want = mtod(m, hci_scodata_hdr_t *)->length; 1352 1.1.2.2 yamt break; 1353 1.1.2.2 yamt 1354 1.1.2.2 yamt case BTUART_RECV_EVENT_HDR: /* Got Event Header */ 1355 1.1.2.2 yamt sc->sc_state = BTUART_RECV_EVENT_DATA; 1356 1.1.2.2 yamt sc->sc_want = mtod(m, hci_event_hdr_t *)->length; 1357 1.1.2.2 yamt break; 1358 1.1.2.2 yamt 1359 1.1.2.2 yamt case BTUART_RECV_ACL_DATA: /* ACL Packet Complete */ 1360 1.1.2.6 yamt if (!(*sc->sc_input_acl)(sc->sc_unit, sc->sc_rxp)) 1361 1.1.2.6 yamt sc->sc_stats.err_rx++; 1362 1.1.2.6 yamt 1363 1.1.2.6 yamt sc->sc_stats.acl_rx++; 1364 1.1.2.2 yamt sc->sc_rxp = m = NULL; 1365 1.1.2.2 yamt break; 1366 1.1.2.2 yamt 1367 1.1.2.2 yamt case BTUART_RECV_SCO_DATA: /* SCO Packet Complete */ 1368 1.1.2.6 yamt if (!(*sc->sc_input_sco)(sc->sc_unit, sc->sc_rxp)) 1369 1.1.2.6 yamt sc->sc_stats.err_rx++; 1370 1.1.2.6 yamt 1371 1.1.2.6 yamt sc->sc_stats.sco_rx++; 1372 1.1.2.2 yamt sc->sc_rxp = m = NULL; 1373 1.1.2.2 yamt break; 1374 1.1.2.2 yamt 1375 1.1.2.2 yamt case BTUART_RECV_EVENT_DATA: /* Event Packet Complete */ 1376 1.1.2.6 yamt if (!(*sc->sc_input_event)(sc->sc_unit, sc->sc_rxp)) 1377 1.1.2.6 yamt sc->sc_stats.err_rx++; 1378 1.1.2.6 yamt 1379 1.1.2.6 yamt sc->sc_stats.evt_rx++; 1380 1.1.2.2 yamt sc->sc_rxp = m = NULL; 1381 1.1.2.2 yamt break; 1382 1.1.2.2 yamt 1383 1.1.2.2 yamt default: 1384 1.1.2.2 yamt panic("%s: invalid state %d!\n", 1385 1.1.2.5 yamt device_xname(sc->sc_dev), sc->sc_state); 1386 1.1.2.2 yamt } 1387 1.1.2.2 yamt 1388 1.1.2.2 yamt return 0; 1389 1.1.2.2 yamt } 1390 1.1.2.2 yamt 1391 1.1.2.2 yamt static int 1392 1.1.2.2 yamt bth4start(struct tty *tp) 1393 1.1.2.2 yamt { 1394 1.1.2.2 yamt struct btuart_softc *sc = (struct btuart_softc *)tp->t_sc; 1395 1.1.2.2 yamt struct mbuf *m; 1396 1.1.2.2 yamt int count, rlen; 1397 1.1.2.2 yamt uint8_t *rptr; 1398 1.1.2.2 yamt 1399 1.1.2.2 yamt m = sc->sc_txp; 1400 1.1.2.2 yamt if (m == NULL) { 1401 1.1.2.6 yamt sc->sc_flags &= ~BTUART_XMIT; 1402 1.1.2.6 yamt bth4_start(sc); 1403 1.1.2.2 yamt return 0; 1404 1.1.2.2 yamt } 1405 1.1.2.2 yamt 1406 1.1.2.2 yamt count = 0; 1407 1.1.2.2 yamt rlen = 0; 1408 1.1.2.2 yamt rptr = mtod(m, uint8_t *); 1409 1.1.2.2 yamt 1410 1.1.2.2 yamt for(;;) { 1411 1.1.2.2 yamt if (rlen >= m->m_len) { 1412 1.1.2.2 yamt m = m->m_next; 1413 1.1.2.2 yamt if (m == NULL) { 1414 1.1.2.2 yamt m = sc->sc_txp; 1415 1.1.2.2 yamt sc->sc_txp = NULL; 1416 1.1.2.2 yamt 1417 1.1.2.2 yamt if (M_GETCTX(m, void *) == NULL) 1418 1.1.2.2 yamt m_freem(m); 1419 1.1.2.6 yamt else if (!hci_complete_sco(sc->sc_unit, m)) 1420 1.1.2.6 yamt sc->sc_stats.err_tx++; 1421 1.1.2.2 yamt 1422 1.1.2.2 yamt break; 1423 1.1.2.2 yamt } 1424 1.1.2.2 yamt 1425 1.1.2.2 yamt rlen = 0; 1426 1.1.2.2 yamt rptr = mtod(m, uint8_t *); 1427 1.1.2.2 yamt continue; 1428 1.1.2.2 yamt } 1429 1.1.2.2 yamt 1430 1.1.2.2 yamt if (putc(*rptr++, &tp->t_outq) < 0) { 1431 1.1.2.2 yamt m_adj(m, rlen); 1432 1.1.2.2 yamt break; 1433 1.1.2.2 yamt } 1434 1.1.2.2 yamt rlen++; 1435 1.1.2.2 yamt count++; 1436 1.1.2.2 yamt } 1437 1.1.2.2 yamt 1438 1.1.2.6 yamt sc->sc_stats.byte_tx += count; 1439 1.1.2.2 yamt 1440 1.1.2.2 yamt if (tp->t_outq.c_cc != 0) 1441 1.1.2.2 yamt (*tp->t_oproc)(tp); 1442 1.1.2.2 yamt 1443 1.1.2.2 yamt return 0; 1444 1.1.2.2 yamt } 1445 1.1.2.2 yamt 1446 1.1.2.2 yamt 1447 1.1.2.2 yamt /* 1448 1.1.2.2 yamt * HCI UART (H4) functions. 1449 1.1.2.2 yamt */ 1450 1.1.2.2 yamt static int 1451 1.1.2.5 yamt bth4_enable(device_t self) 1452 1.1.2.2 yamt { 1453 1.1.2.5 yamt struct btuart_softc *sc = device_private(self); 1454 1.1.2.6 yamt int s; 1455 1.1.2.2 yamt 1456 1.1.2.6 yamt if (sc->sc_flags & BTUART_ENABLED) 1457 1.1.2.2 yamt return 0; 1458 1.1.2.2 yamt 1459 1.1.2.6 yamt s = spltty(); 1460 1.1.2.6 yamt 1461 1.1.2.6 yamt sc->sc_flags |= BTUART_ENABLED; 1462 1.1.2.6 yamt sc->sc_flags &= ~BTUART_XMIT; 1463 1.1.2.6 yamt 1464 1.1.2.6 yamt splx(s); 1465 1.1.2.2 yamt 1466 1.1.2.2 yamt return 0; 1467 1.1.2.2 yamt } 1468 1.1.2.2 yamt 1469 1.1.2.2 yamt static void 1470 1.1.2.5 yamt bth4_disable(device_t self) 1471 1.1.2.2 yamt { 1472 1.1.2.5 yamt struct btuart_softc *sc = device_private(self); 1473 1.1.2.6 yamt int s; 1474 1.1.2.2 yamt 1475 1.1.2.6 yamt if ((sc->sc_flags & BTUART_ENABLED) == 0) 1476 1.1.2.2 yamt return; 1477 1.1.2.2 yamt 1478 1.1.2.6 yamt s = spltty(); 1479 1.1.2.6 yamt 1480 1.1.2.2 yamt if (sc->sc_rxp) { 1481 1.1.2.2 yamt m_freem(sc->sc_rxp); 1482 1.1.2.2 yamt sc->sc_rxp = NULL; 1483 1.1.2.2 yamt } 1484 1.1.2.2 yamt 1485 1.1.2.2 yamt if (sc->sc_txp) { 1486 1.1.2.2 yamt m_freem(sc->sc_txp); 1487 1.1.2.2 yamt sc->sc_txp = NULL; 1488 1.1.2.2 yamt } 1489 1.1.2.2 yamt 1490 1.1.2.6 yamt MBUFQ_DRAIN(&sc->sc_cmdq); 1491 1.1.2.6 yamt MBUFQ_DRAIN(&sc->sc_aclq); 1492 1.1.2.6 yamt MBUFQ_DRAIN(&sc->sc_scoq); 1493 1.1.2.6 yamt 1494 1.1.2.6 yamt sc->sc_flags &= ~BTUART_ENABLED; 1495 1.1.2.6 yamt 1496 1.1.2.6 yamt splx(s); 1497 1.1.2.2 yamt } 1498 1.1.2.2 yamt 1499 1.1.2.2 yamt static void 1500 1.1.2.6 yamt bth4_start(struct btuart_softc *sc) 1501 1.1.2.2 yamt { 1502 1.1.2.2 yamt struct mbuf *m; 1503 1.1.2.2 yamt 1504 1.1.2.6 yamt KASSERT((sc->sc_flags & BTUART_XMIT) == 0); 1505 1.1.2.2 yamt KASSERT(sc->sc_txp == NULL); 1506 1.1.2.2 yamt 1507 1.1.2.6 yamt if (MBUFQ_FIRST(&sc->sc_cmdq)) { 1508 1.1.2.6 yamt MBUFQ_DEQUEUE(&sc->sc_cmdq, m); 1509 1.1.2.6 yamt sc->sc_stats.cmd_tx++; 1510 1.1.2.2 yamt goto start; 1511 1.1.2.2 yamt } 1512 1.1.2.2 yamt 1513 1.1.2.6 yamt if (MBUFQ_FIRST(&sc->sc_scoq)) { 1514 1.1.2.6 yamt MBUFQ_DEQUEUE(&sc->sc_scoq, m); 1515 1.1.2.6 yamt sc->sc_stats.sco_tx++; 1516 1.1.2.2 yamt goto start; 1517 1.1.2.2 yamt } 1518 1.1.2.2 yamt 1519 1.1.2.6 yamt if (MBUFQ_FIRST(&sc->sc_aclq)) { 1520 1.1.2.6 yamt MBUFQ_DEQUEUE(&sc->sc_aclq, m); 1521 1.1.2.6 yamt sc->sc_stats.acl_tx++; 1522 1.1.2.2 yamt goto start; 1523 1.1.2.2 yamt } 1524 1.1.2.2 yamt 1525 1.1.2.2 yamt /* Nothing to send */ 1526 1.1.2.2 yamt return; 1527 1.1.2.2 yamt 1528 1.1.2.2 yamt start: 1529 1.1.2.2 yamt sc->sc_txp = m; 1530 1.1.2.6 yamt sc->sc_flags |= BTUART_XMIT; 1531 1.1.2.2 yamt bth4start(sc->sc_tp); 1532 1.1.2.2 yamt } 1533 1.1.2.6 yamt 1534 1.1.2.6 yamt static void 1535 1.1.2.6 yamt bth4_output_cmd(device_t self, struct mbuf *m) 1536 1.1.2.6 yamt { 1537 1.1.2.6 yamt struct btuart_softc *sc = device_private(self); 1538 1.1.2.6 yamt int s; 1539 1.1.2.6 yamt 1540 1.1.2.6 yamt KASSERT(sc->sc_flags & BTUART_ENABLED); 1541 1.1.2.6 yamt 1542 1.1.2.6 yamt M_SETCTX(m, NULL); 1543 1.1.2.6 yamt 1544 1.1.2.6 yamt s = spltty(); 1545 1.1.2.6 yamt MBUFQ_ENQUEUE(&sc->sc_cmdq, m); 1546 1.1.2.6 yamt if ((sc->sc_flags & BTUART_XMIT) == 0) 1547 1.1.2.6 yamt bth4_start(sc); 1548 1.1.2.6 yamt 1549 1.1.2.6 yamt splx(s); 1550 1.1.2.6 yamt } 1551 1.1.2.6 yamt 1552 1.1.2.6 yamt static void 1553 1.1.2.6 yamt bth4_output_acl(device_t self, struct mbuf *m) 1554 1.1.2.6 yamt { 1555 1.1.2.6 yamt struct btuart_softc *sc = device_private(self); 1556 1.1.2.6 yamt int s; 1557 1.1.2.6 yamt 1558 1.1.2.6 yamt KASSERT(sc->sc_flags & BTUART_ENABLED); 1559 1.1.2.6 yamt 1560 1.1.2.6 yamt M_SETCTX(m, NULL); 1561 1.1.2.6 yamt 1562 1.1.2.6 yamt s = spltty(); 1563 1.1.2.6 yamt MBUFQ_ENQUEUE(&sc->sc_aclq, m); 1564 1.1.2.6 yamt if ((sc->sc_flags & BTUART_XMIT) == 0) 1565 1.1.2.6 yamt bth4_start(sc); 1566 1.1.2.6 yamt 1567 1.1.2.6 yamt splx(s); 1568 1.1.2.6 yamt } 1569 1.1.2.6 yamt 1570 1.1.2.6 yamt static void 1571 1.1.2.6 yamt bth4_output_sco(device_t self, struct mbuf *m) 1572 1.1.2.6 yamt { 1573 1.1.2.6 yamt struct btuart_softc *sc = device_private(self); 1574 1.1.2.6 yamt int s; 1575 1.1.2.6 yamt 1576 1.1.2.6 yamt KASSERT(sc->sc_flags & BTUART_ENABLED); 1577 1.1.2.6 yamt 1578 1.1.2.6 yamt s = spltty(); 1579 1.1.2.6 yamt MBUFQ_ENQUEUE(&sc->sc_scoq, m); 1580 1.1.2.6 yamt if ((sc->sc_flags & BTUART_XMIT) == 0) 1581 1.1.2.6 yamt bth4_start(sc); 1582 1.1.2.6 yamt 1583 1.1.2.6 yamt splx(s); 1584 1.1.2.6 yamt } 1585 1.1.2.6 yamt 1586 1.1.2.6 yamt static void 1587 1.1.2.6 yamt bth4_stats(device_t self, struct bt_stats *dest, int flush) 1588 1.1.2.6 yamt { 1589 1.1.2.6 yamt struct btuart_softc *sc = device_private(self); 1590 1.1.2.6 yamt int s; 1591 1.1.2.6 yamt 1592 1.1.2.6 yamt s = spltty(); 1593 1.1.2.6 yamt 1594 1.1.2.6 yamt memcpy(dest, &sc->sc_stats, sizeof(struct bt_stats)); 1595 1.1.2.6 yamt 1596 1.1.2.6 yamt if (flush) 1597 1.1.2.6 yamt memset(&sc->sc_stats, 0, sizeof(struct bt_stats)); 1598 1.1.2.6 yamt 1599 1.1.2.6 yamt splx(s); 1600 1.1.2.6 yamt } 1601
Indexes created Wed Oct 01 18:09:54 GMT 2025