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