ubt.c revision 1.27 1 1.27 plunky /* $NetBSD: ubt.c,v 1.27 2007/11/10 23:12:22 plunky Exp $ */
2 1.1 augustss
3 1.14 gdamore /*-
4 1.14 gdamore * Copyright (c) 2006 Itronix Inc.
5 1.14 gdamore * All rights reserved.
6 1.14 gdamore *
7 1.14 gdamore * Written by Iain Hibbert for Itronix Inc.
8 1.14 gdamore *
9 1.14 gdamore * Redistribution and use in source and binary forms, with or without
10 1.14 gdamore * modification, are permitted provided that the following conditions
11 1.14 gdamore * are met:
12 1.14 gdamore * 1. Redistributions of source code must retain the above copyright
13 1.14 gdamore * notice, this list of conditions and the following disclaimer.
14 1.14 gdamore * 2. Redistributions in binary form must reproduce the above copyright
15 1.14 gdamore * notice, this list of conditions and the following disclaimer in the
16 1.14 gdamore * documentation and/or other materials provided with the distribution.
17 1.14 gdamore * 3. The name of Itronix Inc. may not be used to endorse
18 1.14 gdamore * or promote products derived from this software without specific
19 1.14 gdamore * prior written permission.
20 1.14 gdamore *
21 1.14 gdamore * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
22 1.14 gdamore * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
23 1.14 gdamore * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
24 1.14 gdamore * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
25 1.14 gdamore * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
26 1.14 gdamore * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
27 1.14 gdamore * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
28 1.14 gdamore * ON ANY THEORY OF LIABILITY, WHETHER IN
29 1.14 gdamore * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
30 1.14 gdamore * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
31 1.14 gdamore * POSSIBILITY OF SUCH DAMAGE.
32 1.14 gdamore */
33 1.1 augustss /*
34 1.5 dsainty * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc.
35 1.1 augustss * All rights reserved.
36 1.1 augustss *
37 1.1 augustss * This code is derived from software contributed to The NetBSD Foundation
38 1.5 dsainty * by Lennart Augustsson (lennart (at) augustsson.net) and
39 1.5 dsainty * David Sainty (David.Sainty (at) dtsp.co.nz).
40 1.1 augustss *
41 1.1 augustss * Redistribution and use in source and binary forms, with or without
42 1.1 augustss * modification, are permitted provided that the following conditions
43 1.1 augustss * are met:
44 1.1 augustss * 1. Redistributions of source code must retain the above copyright
45 1.1 augustss * notice, this list of conditions and the following disclaimer.
46 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
47 1.1 augustss * notice, this list of conditions and the following disclaimer in the
48 1.1 augustss * documentation and/or other materials provided with the distribution.
49 1.1 augustss * 3. All advertising materials mentioning features or use of this software
50 1.1 augustss * must display the following acknowledgement:
51 1.1 augustss * This product includes software developed by the NetBSD
52 1.1 augustss * Foundation, Inc. and its contributors.
53 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
54 1.1 augustss * contributors may be used to endorse or promote products derived
55 1.1 augustss * from this software without specific prior written permission.
56 1.1 augustss *
57 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
58 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
59 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
60 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
61 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
62 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
63 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
64 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
65 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
66 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
67 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
68 1.1 augustss */
69 1.14 gdamore /*
70 1.14 gdamore * This driver originally written by Lennart Augustsson and David Sainty,
71 1.14 gdamore * but was mostly rewritten for the NetBSD Bluetooth protocol stack by
72 1.14 gdamore * Iain Hibbert for Itronix, Inc using the FreeBSD ng_ubt.c driver as a
73 1.14 gdamore * reference.
74 1.14 gdamore */
75 1.1 augustss
76 1.1 augustss #include <sys/cdefs.h>
77 1.27 plunky __KERNEL_RCSID(0, "$NetBSD: ubt.c,v 1.27 2007/11/10 23:12:22 plunky Exp $");
78 1.1 augustss
79 1.1 augustss #include <sys/param.h>
80 1.14 gdamore #include <sys/device.h>
81 1.14 gdamore #include <sys/ioctl.h>
82 1.1 augustss #include <sys/kernel.h>
83 1.5 dsainty #include <sys/malloc.h>
84 1.14 gdamore #include <sys/mbuf.h>
85 1.1 augustss #include <sys/proc.h>
86 1.14 gdamore #include <sys/sysctl.h>
87 1.14 gdamore #include <sys/systm.h>
88 1.1 augustss
89 1.1 augustss #include <dev/usb/usb.h>
90 1.1 augustss #include <dev/usb/usbdi.h>
91 1.1 augustss #include <dev/usb/usbdi_util.h>
92 1.1 augustss #include <dev/usb/usbdevs.h>
93 1.1 augustss
94 1.14 gdamore #include <netbt/bluetooth.h>
95 1.14 gdamore #include <netbt/hci.h>
96 1.14 gdamore
97 1.14 gdamore /*******************************************************************************
98 1.14 gdamore *
99 1.14 gdamore * debugging stuff
100 1.14 gdamore */
101 1.14 gdamore #undef DPRINTF
102 1.14 gdamore #undef DPRINTFN
103 1.3 augustss
104 1.1 augustss #ifdef UBT_DEBUG
105 1.27 plunky int ubt_debug = 0;
106 1.14 gdamore
107 1.14 gdamore #define DPRINTF(fmt, args...) do { \
108 1.14 gdamore if (ubt_debug) \
109 1.14 gdamore printf("%s: "fmt, __func__ , ##args); \
110 1.14 gdamore } while (/* CONSTCOND */0)
111 1.14 gdamore
112 1.14 gdamore #define DPRINTFN(n, fmt, args...) do { \
113 1.14 gdamore if (ubt_debug > (n)) \
114 1.14 gdamore printf("%s: "fmt, __func__ , ##args); \
115 1.14 gdamore } while (/* CONSTCOND */0)
116 1.14 gdamore
117 1.14 gdamore SYSCTL_SETUP(sysctl_hw_ubt_debug_setup, "sysctl hw.ubt_debug setup")
118 1.14 gdamore {
119 1.14 gdamore
120 1.14 gdamore sysctl_createv(NULL, 0, NULL, NULL,
121 1.14 gdamore CTLFLAG_PERMANENT,
122 1.14 gdamore CTLTYPE_NODE, "hw",
123 1.14 gdamore NULL,
124 1.14 gdamore NULL, 0,
125 1.14 gdamore NULL, 0,
126 1.14 gdamore CTL_HW, CTL_EOL);
127 1.14 gdamore
128 1.14 gdamore sysctl_createv(NULL, 0, NULL, NULL,
129 1.14 gdamore CTLFLAG_PERMANENT | CTLFLAG_READWRITE,
130 1.14 gdamore CTLTYPE_INT, "ubt_debug",
131 1.14 gdamore SYSCTL_DESCR("ubt debug level"),
132 1.14 gdamore NULL, 0,
133 1.14 gdamore &ubt_debug, sizeof(ubt_debug),
134 1.14 gdamore CTL_HW, CTL_CREATE, CTL_EOL);
135 1.14 gdamore }
136 1.1 augustss #else
137 1.14 gdamore #define DPRINTF(...)
138 1.14 gdamore #define DPRINTFN(...)
139 1.1 augustss #endif
140 1.1 augustss
141 1.14 gdamore /*******************************************************************************
142 1.14 gdamore *
143 1.14 gdamore * ubt softc structure
144 1.14 gdamore *
145 1.14 gdamore */
146 1.14 gdamore
147 1.14 gdamore /* buffer sizes */
148 1.1 augustss /*
149 1.14 gdamore * NB: although ACL packets can extend to 65535 bytes, most devices
150 1.14 gdamore * have max_acl_size at much less (largest I have seen is 384)
151 1.1 augustss */
152 1.14 gdamore #define UBT_BUFSIZ_CMD (HCI_CMD_PKT_SIZE - 1)
153 1.14 gdamore #define UBT_BUFSIZ_ACL (2048 - 1)
154 1.14 gdamore #define UBT_BUFSIZ_EVENT (HCI_EVENT_PKT_SIZE - 1)
155 1.14 gdamore
156 1.14 gdamore /* Transmit timeouts */
157 1.14 gdamore #define UBT_CMD_TIMEOUT USBD_DEFAULT_TIMEOUT
158 1.14 gdamore #define UBT_ACL_TIMEOUT USBD_DEFAULT_TIMEOUT
159 1.14 gdamore
160 1.14 gdamore /*
161 1.14 gdamore * ISOC transfers
162 1.14 gdamore *
163 1.14 gdamore * xfer buffer size depends on the frame size, and the number
164 1.14 gdamore * of frames per transfer is fixed, as each frame should be
165 1.14 gdamore * 1ms worth of data. This keeps the rate that xfers complete
166 1.14 gdamore * fairly constant. We use multiple xfers to keep the hardware
167 1.14 gdamore * busy
168 1.14 gdamore */
169 1.14 gdamore #define UBT_NXFERS 3 /* max xfers to queue */
170 1.14 gdamore #define UBT_NFRAMES 10 /* frames per xfer */
171 1.14 gdamore
172 1.14 gdamore struct ubt_isoc_xfer {
173 1.14 gdamore struct ubt_softc *softc;
174 1.14 gdamore usbd_xfer_handle xfer;
175 1.14 gdamore uint8_t *buf;
176 1.14 gdamore uint16_t size[UBT_NFRAMES];
177 1.14 gdamore int busy;
178 1.14 gdamore };
179 1.1 augustss
180 1.1 augustss struct ubt_softc {
181 1.14 gdamore USBBASEDEVICE sc_dev;
182 1.14 gdamore usbd_device_handle sc_udev;
183 1.14 gdamore int sc_refcnt;
184 1.14 gdamore int sc_dying;
185 1.14 gdamore
186 1.14 gdamore /* Control Interface */
187 1.14 gdamore usbd_interface_handle sc_iface0;
188 1.14 gdamore
189 1.14 gdamore /* Commands (control) */
190 1.14 gdamore usbd_xfer_handle sc_cmd_xfer;
191 1.14 gdamore uint8_t *sc_cmd_buf;
192 1.14 gdamore
193 1.14 gdamore /* Events (interrupt) */
194 1.14 gdamore int sc_evt_addr; /* endpoint address */
195 1.14 gdamore usbd_pipe_handle sc_evt_pipe;
196 1.14 gdamore uint8_t *sc_evt_buf;
197 1.5 dsainty
198 1.5 dsainty /* ACL data (in) */
199 1.14 gdamore int sc_aclrd_addr; /* endpoint address */
200 1.14 gdamore usbd_pipe_handle sc_aclrd_pipe; /* read pipe */
201 1.14 gdamore usbd_xfer_handle sc_aclrd_xfer; /* read xfer */
202 1.14 gdamore uint8_t *sc_aclrd_buf; /* read buffer */
203 1.14 gdamore int sc_aclrd_busy; /* reading */
204 1.5 dsainty
205 1.5 dsainty /* ACL data (out) */
206 1.14 gdamore int sc_aclwr_addr; /* endpoint address */
207 1.14 gdamore usbd_pipe_handle sc_aclwr_pipe; /* write pipe */
208 1.14 gdamore usbd_xfer_handle sc_aclwr_xfer; /* write xfer */
209 1.14 gdamore uint8_t *sc_aclwr_buf; /* write buffer */
210 1.14 gdamore
211 1.14 gdamore /* ISOC interface */
212 1.14 gdamore usbd_interface_handle sc_iface1; /* ISOC interface */
213 1.14 gdamore struct sysctllog *sc_log; /* sysctl log */
214 1.14 gdamore int sc_config; /* current config no */
215 1.14 gdamore int sc_alt_config; /* no of alternates */
216 1.14 gdamore
217 1.14 gdamore /* SCO data (in) */
218 1.14 gdamore int sc_scord_addr; /* endpoint address */
219 1.14 gdamore usbd_pipe_handle sc_scord_pipe; /* read pipe */
220 1.14 gdamore int sc_scord_size; /* frame length */
221 1.14 gdamore struct ubt_isoc_xfer sc_scord[UBT_NXFERS];
222 1.14 gdamore struct mbuf *sc_scord_mbuf; /* current packet */
223 1.14 gdamore
224 1.14 gdamore /* SCO data (out) */
225 1.14 gdamore int sc_scowr_addr; /* endpoint address */
226 1.14 gdamore usbd_pipe_handle sc_scowr_pipe; /* write pipe */
227 1.14 gdamore int sc_scowr_size; /* frame length */
228 1.14 gdamore struct ubt_isoc_xfer sc_scowr[UBT_NXFERS];
229 1.14 gdamore struct mbuf *sc_scowr_mbuf; /* current packet */
230 1.1 augustss
231 1.14 gdamore /* Protocol structure */
232 1.14 gdamore struct hci_unit sc_unit;
233 1.23 plunky
234 1.23 plunky /* Successfully attached */
235 1.23 plunky int sc_ok;
236 1.14 gdamore };
237 1.14 gdamore
238 1.14 gdamore /*******************************************************************************
239 1.14 gdamore *
240 1.14 gdamore * Bluetooth unit/USB callback routines
241 1.14 gdamore *
242 1.14 gdamore */
243 1.27 plunky static int ubt_enable(device_ptr_t);
244 1.27 plunky static void ubt_disable(device_ptr_t);
245 1.14 gdamore
246 1.27 plunky static void ubt_xmit_cmd_start(device_ptr_t);
247 1.14 gdamore static void ubt_xmit_cmd_complete(usbd_xfer_handle,
248 1.14 gdamore usbd_private_handle, usbd_status);
249 1.14 gdamore
250 1.27 plunky static void ubt_xmit_acl_start(device_ptr_t);
251 1.14 gdamore static void ubt_xmit_acl_complete(usbd_xfer_handle,
252 1.14 gdamore usbd_private_handle, usbd_status);
253 1.14 gdamore
254 1.27 plunky static void ubt_xmit_sco_start(device_ptr_t);
255 1.14 gdamore static void ubt_xmit_sco_start1(struct ubt_softc *, struct ubt_isoc_xfer *);
256 1.14 gdamore static void ubt_xmit_sco_complete(usbd_xfer_handle,
257 1.14 gdamore usbd_private_handle, usbd_status);
258 1.5 dsainty
259 1.14 gdamore static void ubt_recv_event(usbd_xfer_handle,
260 1.14 gdamore usbd_private_handle, usbd_status);
261 1.1 augustss
262 1.14 gdamore static void ubt_recv_acl_start(struct ubt_softc *);
263 1.14 gdamore static void ubt_recv_acl_complete(usbd_xfer_handle,
264 1.14 gdamore usbd_private_handle, usbd_status);
265 1.5 dsainty
266 1.14 gdamore static void ubt_recv_sco_start1(struct ubt_softc *, struct ubt_isoc_xfer *);
267 1.14 gdamore static void ubt_recv_sco_complete(usbd_xfer_handle,
268 1.14 gdamore usbd_private_handle, usbd_status);
269 1.6 dsainty
270 1.6 dsainty
271 1.14 gdamore /*******************************************************************************
272 1.14 gdamore *
273 1.14 gdamore * USB Autoconfig stuff
274 1.14 gdamore *
275 1.14 gdamore */
276 1.5 dsainty
277 1.1 augustss USB_DECLARE_DRIVER(ubt);
278 1.1 augustss
279 1.14 gdamore static int ubt_set_isoc_config(struct ubt_softc *);
280 1.14 gdamore static int ubt_sysctl_config(SYSCTLFN_PROTO);
281 1.14 gdamore static void ubt_abortdealloc(struct ubt_softc *);
282 1.14 gdamore
283 1.15 plunky /*
284 1.23 plunky * Match against the whole device, since we want to take
285 1.23 plunky * both interfaces. If a device should be ignored then add
286 1.15 plunky *
287 1.15 plunky * { VendorID, ProductID }
288 1.15 plunky *
289 1.23 plunky * to the ubt_ignore list.
290 1.15 plunky */
291 1.15 plunky static const struct usb_devno ubt_ignore[] = {
292 1.15 plunky { USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM2033NF },
293 1.15 plunky { 0, 0 } /* end of list */
294 1.15 plunky };
295 1.15 plunky
296 1.1 augustss USB_MATCH(ubt)
297 1.1 augustss {
298 1.1 augustss USB_MATCH_START(ubt, uaa);
299 1.1 augustss
300 1.14 gdamore DPRINTFN(50, "ubt_match\n");
301 1.1 augustss
302 1.15 plunky if (usb_lookup(ubt_ignore, uaa->vendor, uaa->product))
303 1.15 plunky return UMATCH_NONE;
304 1.15 plunky
305 1.24 drochner if (uaa->class == UDCLASS_WIRELESS
306 1.24 drochner && uaa->subclass == UDSUBCLASS_RF
307 1.24 drochner && uaa->proto == UDPROTO_BLUETOOTH)
308 1.23 plunky return UMATCH_DEVCLASS_DEVSUBCLASS_DEVPROTO;
309 1.14 gdamore
310 1.14 gdamore return UMATCH_NONE;
311 1.1 augustss }
312 1.1 augustss
313 1.1 augustss USB_ATTACH(ubt)
314 1.1 augustss {
315 1.1 augustss USB_ATTACH_START(ubt, sc, uaa);
316 1.14 gdamore usb_config_descriptor_t *cd;
317 1.14 gdamore usb_endpoint_descriptor_t *ed;
318 1.14 gdamore const struct sysctlnode *node;
319 1.14 gdamore char *devinfop;
320 1.14 gdamore int err;
321 1.14 gdamore uint8_t count, i;
322 1.1 augustss
323 1.14 gdamore DPRINTFN(50, "ubt_attach: sc=%p\n", sc);
324 1.1 augustss
325 1.14 gdamore sc->sc_udev = uaa->device;
326 1.14 gdamore
327 1.14 gdamore devinfop = usbd_devinfo_alloc(sc->sc_udev, 0);
328 1.1 augustss USB_ATTACH_SETUP;
329 1.14 gdamore aprint_normal("%s: %s\n", USBDEVNAME(sc->sc_dev), devinfop);
330 1.12 augustss usbd_devinfo_free(devinfop);
331 1.1 augustss
332 1.14 gdamore /*
333 1.23 plunky * Move the device into the configured state
334 1.14 gdamore */
335 1.23 plunky err = usbd_set_config_index(sc->sc_udev, 0, 1);
336 1.23 plunky if (err) {
337 1.23 plunky aprint_error("%s: failed to set configuration idx 0: %s\n",
338 1.23 plunky USBDEVNAME(sc->sc_dev), usbd_errstr(err));
339 1.14 gdamore
340 1.14 gdamore USB_ATTACH_ERROR_RETURN;
341 1.14 gdamore }
342 1.1 augustss
343 1.5 dsainty /*
344 1.14 gdamore * Interface 0 must have 3 endpoints
345 1.14 gdamore * 1) Interrupt endpoint to receive HCI events
346 1.14 gdamore * 2) Bulk IN endpoint to receive ACL data
347 1.14 gdamore * 3) Bulk OUT endpoint to send ACL data
348 1.3 augustss */
349 1.23 plunky err = usbd_device2interface_handle(sc->sc_udev, 0, &sc->sc_iface0);
350 1.14 gdamore if (err) {
351 1.14 gdamore aprint_error("%s: Could not get interface 0 handle %s (%d)\n",
352 1.14 gdamore USBDEVNAME(sc->sc_dev), usbd_errstr(err), err);
353 1.14 gdamore
354 1.14 gdamore USB_ATTACH_ERROR_RETURN;
355 1.14 gdamore }
356 1.5 dsainty
357 1.5 dsainty sc->sc_evt_addr = -1;
358 1.5 dsainty sc->sc_aclrd_addr = -1;
359 1.5 dsainty sc->sc_aclwr_addr = -1;
360 1.5 dsainty
361 1.14 gdamore count = 0;
362 1.23 plunky (void)usbd_endpoint_count(sc->sc_iface0, &count);
363 1.14 gdamore
364 1.14 gdamore for (i = 0 ; i < count ; i++) {
365 1.14 gdamore int dir, type;
366 1.14 gdamore
367 1.23 plunky ed = usbd_interface2endpoint_descriptor(sc->sc_iface0, i);
368 1.1 augustss if (ed == NULL) {
369 1.14 gdamore aprint_error("%s: could not read endpoint descriptor %d\n",
370 1.1 augustss USBDEVNAME(sc->sc_dev), i);
371 1.14 gdamore
372 1.1 augustss USB_ATTACH_ERROR_RETURN;
373 1.1 augustss }
374 1.5 dsainty
375 1.14 gdamore dir = UE_GET_DIR(ed->bEndpointAddress);
376 1.14 gdamore type = UE_GET_XFERTYPE(ed->bmAttributes);
377 1.5 dsainty
378 1.14 gdamore if (dir == UE_DIR_IN && type == UE_INTERRUPT)
379 1.5 dsainty sc->sc_evt_addr = ed->bEndpointAddress;
380 1.14 gdamore else if (dir == UE_DIR_IN && type == UE_BULK)
381 1.5 dsainty sc->sc_aclrd_addr = ed->bEndpointAddress;
382 1.14 gdamore else if (dir == UE_DIR_OUT && type == UE_BULK)
383 1.5 dsainty sc->sc_aclwr_addr = ed->bEndpointAddress;
384 1.1 augustss }
385 1.5 dsainty
386 1.14 gdamore if (sc->sc_evt_addr == -1) {
387 1.14 gdamore aprint_error("%s: missing INTERRUPT endpoint on interface 0\n",
388 1.14 gdamore USBDEVNAME(sc->sc_dev));
389 1.14 gdamore
390 1.14 gdamore USB_ATTACH_ERROR_RETURN;
391 1.14 gdamore }
392 1.14 gdamore if (sc->sc_aclrd_addr == -1) {
393 1.14 gdamore aprint_error("%s: missing BULK IN endpoint on interface 0\n",
394 1.14 gdamore USBDEVNAME(sc->sc_dev));
395 1.14 gdamore
396 1.14 gdamore USB_ATTACH_ERROR_RETURN;
397 1.14 gdamore }
398 1.14 gdamore if (sc->sc_aclwr_addr == -1) {
399 1.14 gdamore aprint_error("%s: missing BULK OUT endpoint on interface 0\n",
400 1.14 gdamore USBDEVNAME(sc->sc_dev));
401 1.14 gdamore
402 1.14 gdamore USB_ATTACH_ERROR_RETURN;
403 1.14 gdamore }
404 1.14 gdamore
405 1.14 gdamore /*
406 1.14 gdamore * Interface 1 must have 2 endpoints
407 1.14 gdamore * 1) Isochronous IN endpoint to receive SCO data
408 1.14 gdamore * 2) Isochronous OUT endpoint to send SCO data
409 1.14 gdamore *
410 1.14 gdamore * and will have several configurations, which can be selected
411 1.14 gdamore * via a sysctl variable. We select config 0 to start, which
412 1.14 gdamore * means that no SCO data will be available.
413 1.14 gdamore */
414 1.23 plunky err = usbd_device2interface_handle(sc->sc_udev, 1, &sc->sc_iface1);
415 1.14 gdamore if (err) {
416 1.14 gdamore aprint_error("%s: Could not get interface 1 handle %s (%d)\n",
417 1.14 gdamore USBDEVNAME(sc->sc_dev), usbd_errstr(err), err);
418 1.14 gdamore
419 1.14 gdamore USB_ATTACH_ERROR_RETURN;
420 1.14 gdamore }
421 1.14 gdamore
422 1.14 gdamore cd = usbd_get_config_descriptor(sc->sc_udev);
423 1.14 gdamore if (cd == NULL) {
424 1.14 gdamore aprint_error("%s: could not get config descriptor\n",
425 1.14 gdamore USBDEVNAME(sc->sc_dev));
426 1.14 gdamore
427 1.14 gdamore USB_ATTACH_ERROR_RETURN;
428 1.14 gdamore }
429 1.14 gdamore
430 1.14 gdamore sc->sc_alt_config = usbd_get_no_alts(cd, 1);
431 1.14 gdamore
432 1.14 gdamore /* set initial config */
433 1.14 gdamore err = ubt_set_isoc_config(sc);
434 1.14 gdamore if (err) {
435 1.14 gdamore aprint_error("%s: ISOC config failed\n",
436 1.14 gdamore USBDEVNAME(sc->sc_dev));
437 1.14 gdamore
438 1.1 augustss USB_ATTACH_ERROR_RETURN;
439 1.1 augustss }
440 1.1 augustss
441 1.14 gdamore /* Attach HCI */
442 1.27 plunky sc->sc_unit.hci_dev = USBDEV(sc->sc_dev);
443 1.14 gdamore sc->sc_unit.hci_enable = ubt_enable;
444 1.14 gdamore sc->sc_unit.hci_disable = ubt_disable;
445 1.14 gdamore sc->sc_unit.hci_start_cmd = ubt_xmit_cmd_start;
446 1.14 gdamore sc->sc_unit.hci_start_acl = ubt_xmit_acl_start;
447 1.14 gdamore sc->sc_unit.hci_start_sco = ubt_xmit_sco_start;
448 1.22 yamt sc->sc_unit.hci_ipl = makeiplcookie(IPL_USB); /* XXX: IPL_SOFTUSB ?? */
449 1.14 gdamore hci_attach(&sc->sc_unit);
450 1.14 gdamore
451 1.14 gdamore usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
452 1.14 gdamore USBDEV(sc->sc_dev));
453 1.14 gdamore
454 1.14 gdamore /* sysctl set-up for alternate configs */
455 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, NULL,
456 1.14 gdamore CTLFLAG_PERMANENT,
457 1.14 gdamore CTLTYPE_NODE, "hw",
458 1.14 gdamore NULL,
459 1.14 gdamore NULL, 0,
460 1.14 gdamore NULL, 0,
461 1.14 gdamore CTL_HW, CTL_EOL);
462 1.14 gdamore
463 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, &node,
464 1.14 gdamore 0,
465 1.14 gdamore CTLTYPE_NODE, USBDEVNAME(sc->sc_dev),
466 1.14 gdamore SYSCTL_DESCR("ubt driver information"),
467 1.14 gdamore NULL, 0,
468 1.14 gdamore NULL, 0,
469 1.14 gdamore CTL_HW,
470 1.14 gdamore CTL_CREATE, CTL_EOL);
471 1.14 gdamore
472 1.14 gdamore if (node != NULL) {
473 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, NULL,
474 1.14 gdamore CTLFLAG_READWRITE,
475 1.14 gdamore CTLTYPE_INT, "config",
476 1.14 gdamore SYSCTL_DESCR("configuration number"),
477 1.14 gdamore ubt_sysctl_config, 0,
478 1.14 gdamore sc, 0,
479 1.14 gdamore CTL_HW, node->sysctl_num,
480 1.14 gdamore CTL_CREATE, CTL_EOL);
481 1.14 gdamore
482 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, NULL,
483 1.14 gdamore CTLFLAG_READONLY,
484 1.14 gdamore CTLTYPE_INT, "alt_config",
485 1.14 gdamore SYSCTL_DESCR("number of alternate configurations"),
486 1.14 gdamore NULL, 0,
487 1.14 gdamore &sc->sc_alt_config, sizeof(sc->sc_alt_config),
488 1.14 gdamore CTL_HW, node->sysctl_num,
489 1.14 gdamore CTL_CREATE, CTL_EOL);
490 1.14 gdamore
491 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, NULL,
492 1.14 gdamore CTLFLAG_READONLY,
493 1.14 gdamore CTLTYPE_INT, "sco_rxsize",
494 1.14 gdamore SYSCTL_DESCR("max SCO receive size"),
495 1.14 gdamore NULL, 0,
496 1.14 gdamore &sc->sc_scord_size, sizeof(sc->sc_scord_size),
497 1.14 gdamore CTL_HW, node->sysctl_num,
498 1.14 gdamore CTL_CREATE, CTL_EOL);
499 1.14 gdamore
500 1.14 gdamore sysctl_createv(&sc->sc_log, 0, NULL, NULL,
501 1.14 gdamore CTLFLAG_READONLY,
502 1.14 gdamore CTLTYPE_INT, "sco_txsize",
503 1.14 gdamore SYSCTL_DESCR("max SCO transmit size"),
504 1.14 gdamore NULL, 0,
505 1.14 gdamore &sc->sc_scowr_size, sizeof(sc->sc_scowr_size),
506 1.14 gdamore CTL_HW, node->sysctl_num,
507 1.14 gdamore CTL_CREATE, CTL_EOL);
508 1.14 gdamore }
509 1.14 gdamore
510 1.23 plunky sc->sc_ok = 1;
511 1.14 gdamore USB_ATTACH_SUCCESS_RETURN;
512 1.14 gdamore }
513 1.14 gdamore
514 1.14 gdamore USB_DETACH(ubt)
515 1.14 gdamore {
516 1.14 gdamore USB_DETACH_START(ubt, sc);
517 1.14 gdamore int s;
518 1.14 gdamore
519 1.14 gdamore DPRINTF("sc=%p flags=%d\n", sc, flags);
520 1.14 gdamore
521 1.14 gdamore sc->sc_dying = 1;
522 1.14 gdamore
523 1.23 plunky if (!sc->sc_ok)
524 1.23 plunky return 0;
525 1.23 plunky
526 1.14 gdamore /* delete sysctl nodes */
527 1.14 gdamore sysctl_teardown(&sc->sc_log);
528 1.14 gdamore
529 1.14 gdamore /* Detach HCI interface */
530 1.14 gdamore hci_detach(&sc->sc_unit);
531 1.14 gdamore
532 1.14 gdamore /*
533 1.14 gdamore * Abort all pipes. Causes processes waiting for transfer to wake.
534 1.14 gdamore *
535 1.14 gdamore * Actually, hci_detach() above will call ubt_disable() which may
536 1.14 gdamore * call ubt_abortdealloc(), but lets be sure since doing it twice
537 1.14 gdamore * wont cause an error.
538 1.14 gdamore */
539 1.14 gdamore ubt_abortdealloc(sc);
540 1.14 gdamore
541 1.14 gdamore /* wait for all processes to finish */
542 1.14 gdamore s = splusb();
543 1.14 gdamore if (sc->sc_refcnt-- > 0)
544 1.14 gdamore usb_detach_wait(USBDEV(sc->sc_dev));
545 1.14 gdamore
546 1.14 gdamore splx(s);
547 1.14 gdamore
548 1.14 gdamore usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
549 1.14 gdamore USBDEV(sc->sc_dev));
550 1.14 gdamore
551 1.14 gdamore DPRINTFN(1, "driver detached\n");
552 1.14 gdamore
553 1.14 gdamore return 0;
554 1.14 gdamore }
555 1.14 gdamore
556 1.14 gdamore int
557 1.14 gdamore ubt_activate(device_ptr_t self, enum devact act)
558 1.14 gdamore {
559 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
560 1.14 gdamore int error = 0;
561 1.14 gdamore
562 1.25 plunky DPRINTFN(1, "sc=%p, act=%d\n", sc, act);
563 1.14 gdamore
564 1.14 gdamore switch (act) {
565 1.14 gdamore case DVACT_ACTIVATE:
566 1.14 gdamore break;
567 1.14 gdamore
568 1.14 gdamore case DVACT_DEACTIVATE:
569 1.14 gdamore sc->sc_dying = 1;
570 1.14 gdamore break;
571 1.25 plunky
572 1.25 plunky default:
573 1.26 plunky error = EOPNOTSUPP;
574 1.25 plunky break;
575 1.14 gdamore }
576 1.25 plunky
577 1.14 gdamore return error;
578 1.14 gdamore }
579 1.14 gdamore
580 1.14 gdamore /* set ISOC configuration */
581 1.14 gdamore static int
582 1.14 gdamore ubt_set_isoc_config(struct ubt_softc *sc)
583 1.14 gdamore {
584 1.14 gdamore usb_endpoint_descriptor_t *ed;
585 1.14 gdamore int rd_addr, wr_addr, rd_size, wr_size;
586 1.14 gdamore uint8_t count, i;
587 1.14 gdamore int err;
588 1.14 gdamore
589 1.14 gdamore err = usbd_set_interface(sc->sc_iface1, sc->sc_config);
590 1.17 plunky if (err != USBD_NORMAL_COMPLETION) {
591 1.14 gdamore aprint_error(
592 1.14 gdamore "%s: Could not set config %d on ISOC interface. %s (%d)\n",
593 1.14 gdamore USBDEVNAME(sc->sc_dev), sc->sc_config, usbd_errstr(err), err);
594 1.14 gdamore
595 1.17 plunky return err == USBD_IN_USE ? EBUSY : EIO;
596 1.14 gdamore }
597 1.14 gdamore
598 1.14 gdamore /*
599 1.14 gdamore * We wont get past the above if there are any pipes open, so no
600 1.14 gdamore * need to worry about buf/xfer/pipe deallocation. If we get an
601 1.14 gdamore * error after this, the frame quantities will be 0 and no SCO
602 1.14 gdamore * data will be possible.
603 1.14 gdamore */
604 1.14 gdamore
605 1.14 gdamore sc->sc_scord_size = rd_size = 0;
606 1.14 gdamore sc->sc_scord_addr = rd_addr = -1;
607 1.14 gdamore
608 1.14 gdamore sc->sc_scowr_size = wr_size = 0;
609 1.14 gdamore sc->sc_scowr_addr = wr_addr = -1;
610 1.14 gdamore
611 1.14 gdamore count = 0;
612 1.14 gdamore (void)usbd_endpoint_count(sc->sc_iface1, &count);
613 1.14 gdamore
614 1.14 gdamore for (i = 0 ; i < count ; i++) {
615 1.14 gdamore ed = usbd_interface2endpoint_descriptor(sc->sc_iface1, i);
616 1.14 gdamore if (ed == NULL) {
617 1.14 gdamore printf("%s: could not read endpoint descriptor %d\n",
618 1.14 gdamore USBDEVNAME(sc->sc_dev), i);
619 1.14 gdamore
620 1.14 gdamore return EIO;
621 1.14 gdamore }
622 1.14 gdamore
623 1.14 gdamore DPRINTFN(5, "%s: endpoint type %02x (%02x) addr %02x (%s)\n",
624 1.14 gdamore USBDEVNAME(sc->sc_dev),
625 1.14 gdamore UE_GET_XFERTYPE(ed->bmAttributes),
626 1.14 gdamore UE_GET_ISO_TYPE(ed->bmAttributes),
627 1.14 gdamore ed->bEndpointAddress,
628 1.14 gdamore UE_GET_DIR(ed->bEndpointAddress) ? "in" : "out");
629 1.14 gdamore
630 1.14 gdamore if (UE_GET_XFERTYPE(ed->bmAttributes) != UE_ISOCHRONOUS)
631 1.3 augustss continue;
632 1.14 gdamore
633 1.14 gdamore if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN) {
634 1.14 gdamore rd_addr = ed->bEndpointAddress;
635 1.14 gdamore rd_size = UGETW(ed->wMaxPacketSize);
636 1.14 gdamore } else {
637 1.14 gdamore wr_addr = ed->bEndpointAddress;
638 1.14 gdamore wr_size = UGETW(ed->wMaxPacketSize);
639 1.3 augustss }
640 1.3 augustss }
641 1.3 augustss
642 1.14 gdamore if (rd_addr == -1) {
643 1.14 gdamore aprint_error(
644 1.14 gdamore "%s: missing ISOC IN endpoint on interface config %d\n",
645 1.14 gdamore USBDEVNAME(sc->sc_dev), sc->sc_config);
646 1.14 gdamore
647 1.14 gdamore return ENOENT;
648 1.14 gdamore }
649 1.14 gdamore if (wr_addr == -1) {
650 1.14 gdamore aprint_error(
651 1.14 gdamore "%s: missing ISOC OUT endpoint on interface config %d\n",
652 1.14 gdamore USBDEVNAME(sc->sc_dev), sc->sc_config);
653 1.14 gdamore
654 1.14 gdamore return ENOENT;
655 1.14 gdamore }
656 1.14 gdamore
657 1.14 gdamore #ifdef DIAGNOSTIC
658 1.14 gdamore if (rd_size > MLEN) {
659 1.14 gdamore printf("%s: rd_size=%d exceeds MLEN\n",
660 1.14 gdamore USBDEVNAME(sc->sc_dev), rd_size);
661 1.14 gdamore
662 1.14 gdamore return EOVERFLOW;
663 1.14 gdamore }
664 1.3 augustss
665 1.14 gdamore if (wr_size > MLEN) {
666 1.14 gdamore printf("%s: wr_size=%d exceeds MLEN\n",
667 1.14 gdamore USBDEVNAME(sc->sc_dev), wr_size);
668 1.14 gdamore
669 1.14 gdamore return EOVERFLOW;
670 1.14 gdamore }
671 1.14 gdamore #endif
672 1.14 gdamore
673 1.14 gdamore sc->sc_scord_size = rd_size;
674 1.14 gdamore sc->sc_scord_addr = rd_addr;
675 1.14 gdamore
676 1.14 gdamore sc->sc_scowr_size = wr_size;
677 1.14 gdamore sc->sc_scowr_addr = wr_addr;
678 1.14 gdamore
679 1.14 gdamore return 0;
680 1.14 gdamore }
681 1.1 augustss
682 1.14 gdamore /* sysctl helper to set alternate configurations */
683 1.14 gdamore static int
684 1.14 gdamore ubt_sysctl_config(SYSCTLFN_ARGS)
685 1.14 gdamore {
686 1.14 gdamore struct sysctlnode node;
687 1.14 gdamore struct ubt_softc *sc;
688 1.14 gdamore int t, error;
689 1.14 gdamore
690 1.14 gdamore node = *rnode;
691 1.14 gdamore sc = node.sysctl_data;
692 1.14 gdamore
693 1.14 gdamore t = sc->sc_config;
694 1.14 gdamore node.sysctl_data = &t;
695 1.14 gdamore error = sysctl_lookup(SYSCTLFN_CALL(&node));
696 1.14 gdamore if (error || newp == NULL)
697 1.14 gdamore return error;
698 1.5 dsainty
699 1.14 gdamore if (t < 0 || t >= sc->sc_alt_config)
700 1.14 gdamore return EINVAL;
701 1.1 augustss
702 1.18 plunky /* This may not change when the unit is enabled */
703 1.18 plunky if (sc->sc_unit.hci_flags & BTF_RUNNING)
704 1.18 plunky return EBUSY;
705 1.18 plunky
706 1.14 gdamore sc->sc_config = t;
707 1.14 gdamore return ubt_set_isoc_config(sc);
708 1.1 augustss }
709 1.1 augustss
710 1.5 dsainty static void
711 1.5 dsainty ubt_abortdealloc(struct ubt_softc *sc)
712 1.5 dsainty {
713 1.14 gdamore int i;
714 1.14 gdamore
715 1.14 gdamore DPRINTFN(1, "sc=%p\n", sc);
716 1.5 dsainty
717 1.14 gdamore /* Abort all pipes */
718 1.5 dsainty if (sc->sc_evt_pipe != NULL) {
719 1.5 dsainty usbd_abort_pipe(sc->sc_evt_pipe);
720 1.5 dsainty usbd_close_pipe(sc->sc_evt_pipe);
721 1.5 dsainty sc->sc_evt_pipe = NULL;
722 1.5 dsainty }
723 1.14 gdamore
724 1.5 dsainty if (sc->sc_aclrd_pipe != NULL) {
725 1.5 dsainty usbd_abort_pipe(sc->sc_aclrd_pipe);
726 1.5 dsainty usbd_close_pipe(sc->sc_aclrd_pipe);
727 1.5 dsainty sc->sc_aclrd_pipe = NULL;
728 1.5 dsainty }
729 1.14 gdamore
730 1.5 dsainty if (sc->sc_aclwr_pipe != NULL) {
731 1.5 dsainty usbd_abort_pipe(sc->sc_aclwr_pipe);
732 1.5 dsainty usbd_close_pipe(sc->sc_aclwr_pipe);
733 1.5 dsainty sc->sc_aclwr_pipe = NULL;
734 1.5 dsainty }
735 1.14 gdamore
736 1.14 gdamore if (sc->sc_scord_pipe != NULL) {
737 1.14 gdamore usbd_abort_pipe(sc->sc_scord_pipe);
738 1.14 gdamore usbd_close_pipe(sc->sc_scord_pipe);
739 1.14 gdamore sc->sc_scord_pipe = NULL;
740 1.14 gdamore }
741 1.14 gdamore
742 1.14 gdamore if (sc->sc_scowr_pipe != NULL) {
743 1.14 gdamore usbd_abort_pipe(sc->sc_scowr_pipe);
744 1.14 gdamore usbd_close_pipe(sc->sc_scowr_pipe);
745 1.14 gdamore sc->sc_scowr_pipe = NULL;
746 1.14 gdamore }
747 1.14 gdamore
748 1.14 gdamore /* Free event buffer */
749 1.14 gdamore if (sc->sc_evt_buf != NULL) {
750 1.14 gdamore free(sc->sc_evt_buf, M_USBDEV);
751 1.14 gdamore sc->sc_evt_buf = NULL;
752 1.14 gdamore }
753 1.14 gdamore
754 1.14 gdamore /* Free all xfers and xfer buffers (implicit) */
755 1.14 gdamore if (sc->sc_cmd_xfer != NULL) {
756 1.14 gdamore usbd_free_xfer(sc->sc_cmd_xfer);
757 1.14 gdamore sc->sc_cmd_xfer = NULL;
758 1.14 gdamore sc->sc_cmd_buf = NULL;
759 1.14 gdamore }
760 1.14 gdamore
761 1.5 dsainty if (sc->sc_aclrd_xfer != NULL) {
762 1.5 dsainty usbd_free_xfer(sc->sc_aclrd_xfer);
763 1.5 dsainty sc->sc_aclrd_xfer = NULL;
764 1.5 dsainty sc->sc_aclrd_buf = NULL;
765 1.5 dsainty }
766 1.14 gdamore
767 1.5 dsainty if (sc->sc_aclwr_xfer != NULL) {
768 1.5 dsainty usbd_free_xfer(sc->sc_aclwr_xfer);
769 1.5 dsainty sc->sc_aclwr_xfer = NULL;
770 1.5 dsainty sc->sc_aclwr_buf = NULL;
771 1.5 dsainty }
772 1.5 dsainty
773 1.14 gdamore for (i = 0 ; i < UBT_NXFERS ; i++) {
774 1.14 gdamore if (sc->sc_scord[i].xfer != NULL) {
775 1.14 gdamore usbd_free_xfer(sc->sc_scord[i].xfer);
776 1.14 gdamore sc->sc_scord[i].xfer = NULL;
777 1.14 gdamore sc->sc_scord[i].buf = NULL;
778 1.14 gdamore }
779 1.1 augustss
780 1.14 gdamore if (sc->sc_scowr[i].xfer != NULL) {
781 1.14 gdamore usbd_free_xfer(sc->sc_scowr[i].xfer);
782 1.14 gdamore sc->sc_scowr[i].xfer = NULL;
783 1.14 gdamore sc->sc_scowr[i].buf = NULL;
784 1.14 gdamore }
785 1.1 augustss }
786 1.1 augustss
787 1.14 gdamore /* Free partial SCO packets */
788 1.14 gdamore if (sc->sc_scord_mbuf != NULL) {
789 1.14 gdamore m_freem(sc->sc_scord_mbuf);
790 1.14 gdamore sc->sc_scord_mbuf = NULL;
791 1.1 augustss }
792 1.1 augustss
793 1.14 gdamore if (sc->sc_scowr_mbuf != NULL) {
794 1.14 gdamore m_freem(sc->sc_scowr_mbuf);
795 1.14 gdamore sc->sc_scowr_mbuf = NULL;
796 1.1 augustss }
797 1.5 dsainty }
798 1.5 dsainty
799 1.14 gdamore /*******************************************************************************
800 1.14 gdamore *
801 1.14 gdamore * Bluetooth Unit/USB callbacks
802 1.14 gdamore *
803 1.14 gdamore * All of this will be called at the IPL_ we specified above
804 1.14 gdamore */
805 1.5 dsainty static int
806 1.27 plunky ubt_enable(device_ptr_t self)
807 1.5 dsainty {
808 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
809 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
810 1.5 dsainty usbd_status err;
811 1.14 gdamore int i, error;
812 1.5 dsainty
813 1.14 gdamore DPRINTFN(1, "sc=%p\n", sc);
814 1.5 dsainty
815 1.14 gdamore if (unit->hci_flags & BTF_RUNNING)
816 1.14 gdamore return 0;
817 1.14 gdamore
818 1.14 gdamore /* Events */
819 1.14 gdamore sc->sc_evt_buf = malloc(UBT_BUFSIZ_EVENT, M_USBDEV, M_NOWAIT);
820 1.5 dsainty if (sc->sc_evt_buf == NULL) {
821 1.5 dsainty error = ENOMEM;
822 1.14 gdamore goto bad;
823 1.5 dsainty }
824 1.14 gdamore err = usbd_open_pipe_intr(sc->sc_iface0,
825 1.14 gdamore sc->sc_evt_addr,
826 1.14 gdamore USBD_SHORT_XFER_OK,
827 1.14 gdamore &sc->sc_evt_pipe,
828 1.14 gdamore sc,
829 1.14 gdamore sc->sc_evt_buf,
830 1.14 gdamore UBT_BUFSIZ_EVENT,
831 1.14 gdamore ubt_recv_event,
832 1.21 drochner USBD_DEFAULT_INTERVAL);
833 1.5 dsainty if (err != USBD_NORMAL_COMPLETION) {
834 1.5 dsainty error = EIO;
835 1.14 gdamore goto bad;
836 1.5 dsainty }
837 1.5 dsainty
838 1.14 gdamore /* Commands */
839 1.14 gdamore sc->sc_cmd_xfer = usbd_alloc_xfer(sc->sc_udev);
840 1.14 gdamore if (sc->sc_cmd_xfer == NULL) {
841 1.14 gdamore error = ENOMEM;
842 1.14 gdamore goto bad;
843 1.14 gdamore }
844 1.14 gdamore sc->sc_cmd_buf = usbd_alloc_buffer(sc->sc_cmd_xfer, UBT_BUFSIZ_CMD);
845 1.14 gdamore if (sc->sc_cmd_buf == NULL) {
846 1.14 gdamore error = ENOMEM;
847 1.14 gdamore goto bad;
848 1.5 dsainty }
849 1.5 dsainty
850 1.14 gdamore /* ACL read */
851 1.14 gdamore err = usbd_open_pipe(sc->sc_iface0, sc->sc_aclrd_addr,
852 1.14 gdamore USBD_EXCLUSIVE_USE, &sc->sc_aclrd_pipe);
853 1.5 dsainty if (err != USBD_NORMAL_COMPLETION) {
854 1.5 dsainty error = EIO;
855 1.14 gdamore goto bad;
856 1.5 dsainty }
857 1.5 dsainty sc->sc_aclrd_xfer = usbd_alloc_xfer(sc->sc_udev);
858 1.5 dsainty if (sc->sc_aclrd_xfer == NULL) {
859 1.5 dsainty error = ENOMEM;
860 1.14 gdamore goto bad;
861 1.5 dsainty }
862 1.14 gdamore sc->sc_aclrd_buf = usbd_alloc_buffer(sc->sc_aclrd_xfer, UBT_BUFSIZ_ACL);
863 1.14 gdamore if (sc->sc_aclrd_buf == NULL) {
864 1.5 dsainty error = ENOMEM;
865 1.14 gdamore goto bad;
866 1.5 dsainty }
867 1.14 gdamore sc->sc_aclrd_busy = 0;
868 1.14 gdamore ubt_recv_acl_start(sc);
869 1.5 dsainty
870 1.14 gdamore /* ACL write */
871 1.14 gdamore err = usbd_open_pipe(sc->sc_iface0, sc->sc_aclwr_addr,
872 1.14 gdamore USBD_EXCLUSIVE_USE, &sc->sc_aclwr_pipe);
873 1.14 gdamore if (err != USBD_NORMAL_COMPLETION) {
874 1.14 gdamore error = EIO;
875 1.14 gdamore goto bad;
876 1.5 dsainty }
877 1.14 gdamore sc->sc_aclwr_xfer = usbd_alloc_xfer(sc->sc_udev);
878 1.14 gdamore if (sc->sc_aclwr_xfer == NULL) {
879 1.5 dsainty error = ENOMEM;
880 1.14 gdamore goto bad;
881 1.5 dsainty }
882 1.14 gdamore sc->sc_aclwr_buf = usbd_alloc_buffer(sc->sc_aclwr_xfer, UBT_BUFSIZ_ACL);
883 1.5 dsainty if (sc->sc_aclwr_buf == NULL) {
884 1.5 dsainty error = ENOMEM;
885 1.14 gdamore goto bad;
886 1.14 gdamore }
887 1.14 gdamore
888 1.14 gdamore /* SCO read */
889 1.14 gdamore if (sc->sc_scord_size > 0) {
890 1.14 gdamore err = usbd_open_pipe(sc->sc_iface1, sc->sc_scord_addr,
891 1.14 gdamore USBD_EXCLUSIVE_USE, &sc->sc_scord_pipe);
892 1.14 gdamore if (err != USBD_NORMAL_COMPLETION) {
893 1.14 gdamore error = EIO;
894 1.14 gdamore goto bad;
895 1.14 gdamore }
896 1.14 gdamore
897 1.14 gdamore for (i = 0 ; i < UBT_NXFERS ; i++) {
898 1.14 gdamore sc->sc_scord[i].xfer = usbd_alloc_xfer(sc->sc_udev);
899 1.14 gdamore if (sc->sc_scord[i].xfer == NULL) {
900 1.14 gdamore error = ENOMEM;
901 1.14 gdamore goto bad;
902 1.14 gdamore }
903 1.14 gdamore sc->sc_scord[i].buf = usbd_alloc_buffer(sc->sc_scord[i].xfer,
904 1.14 gdamore sc->sc_scord_size * UBT_NFRAMES);
905 1.14 gdamore if (sc->sc_scord[i].buf == NULL) {
906 1.14 gdamore error = ENOMEM;
907 1.14 gdamore goto bad;
908 1.14 gdamore }
909 1.14 gdamore sc->sc_scord[i].softc = sc;
910 1.14 gdamore sc->sc_scord[i].busy = 0;
911 1.14 gdamore ubt_recv_sco_start1(sc, &sc->sc_scord[i]);
912 1.14 gdamore }
913 1.5 dsainty }
914 1.5 dsainty
915 1.14 gdamore /* SCO write */
916 1.14 gdamore if (sc->sc_scowr_size > 0) {
917 1.14 gdamore err = usbd_open_pipe(sc->sc_iface1, sc->sc_scowr_addr,
918 1.14 gdamore USBD_EXCLUSIVE_USE, &sc->sc_scowr_pipe);
919 1.14 gdamore if (err != USBD_NORMAL_COMPLETION) {
920 1.14 gdamore error = EIO;
921 1.14 gdamore goto bad;
922 1.14 gdamore }
923 1.14 gdamore
924 1.14 gdamore for (i = 0 ; i < UBT_NXFERS ; i++) {
925 1.14 gdamore sc->sc_scowr[i].xfer = usbd_alloc_xfer(sc->sc_udev);
926 1.14 gdamore if (sc->sc_scowr[i].xfer == NULL) {
927 1.14 gdamore error = ENOMEM;
928 1.14 gdamore goto bad;
929 1.14 gdamore }
930 1.14 gdamore sc->sc_scowr[i].buf = usbd_alloc_buffer(sc->sc_scowr[i].xfer,
931 1.14 gdamore sc->sc_scowr_size * UBT_NFRAMES);
932 1.14 gdamore if (sc->sc_scowr[i].buf == NULL) {
933 1.14 gdamore error = ENOMEM;
934 1.14 gdamore goto bad;
935 1.14 gdamore }
936 1.14 gdamore sc->sc_scowr[i].softc = sc;
937 1.14 gdamore sc->sc_scowr[i].busy = 0;
938 1.14 gdamore }
939 1.14 gdamore }
940 1.5 dsainty
941 1.14 gdamore unit->hci_flags &= ~BTF_XMIT;
942 1.14 gdamore unit->hci_flags |= BTF_RUNNING;
943 1.5 dsainty return 0;
944 1.5 dsainty
945 1.14 gdamore bad:
946 1.14 gdamore ubt_abortdealloc(sc);
947 1.5 dsainty return error;
948 1.5 dsainty }
949 1.5 dsainty
950 1.14 gdamore static void
951 1.27 plunky ubt_disable(device_ptr_t self)
952 1.5 dsainty {
953 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
954 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
955 1.14 gdamore
956 1.14 gdamore DPRINTFN(1, "sc=%p\n", sc);
957 1.5 dsainty
958 1.14 gdamore if ((unit->hci_flags & BTF_RUNNING) == 0)
959 1.14 gdamore return;
960 1.5 dsainty
961 1.5 dsainty ubt_abortdealloc(sc);
962 1.5 dsainty
963 1.14 gdamore unit->hci_flags &= ~BTF_RUNNING;
964 1.5 dsainty }
965 1.5 dsainty
966 1.14 gdamore static void
967 1.27 plunky ubt_xmit_cmd_start(device_ptr_t self)
968 1.5 dsainty {
969 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
970 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
971 1.5 dsainty usb_device_request_t req;
972 1.5 dsainty usbd_status status;
973 1.14 gdamore struct mbuf *m;
974 1.14 gdamore int len;
975 1.5 dsainty
976 1.14 gdamore if (sc->sc_dying)
977 1.14 gdamore return;
978 1.5 dsainty
979 1.14 gdamore if (MBUFQ_FIRST(&unit->hci_cmdq) == NULL)
980 1.14 gdamore return;
981 1.6 dsainty
982 1.14 gdamore MBUFQ_DEQUEUE(&unit->hci_cmdq, m);
983 1.14 gdamore KASSERT(m != NULL);
984 1.5 dsainty
985 1.14 gdamore DPRINTFN(15, "%s: xmit CMD packet (%d bytes)\n",
986 1.27 plunky USBDEVNAME(sc->sc_dev), m->m_pkthdr.len);
987 1.5 dsainty
988 1.5 dsainty sc->sc_refcnt++;
989 1.14 gdamore unit->hci_flags |= BTF_XMIT_CMD;
990 1.14 gdamore
991 1.14 gdamore len = m->m_pkthdr.len - 1;
992 1.14 gdamore m_copydata(m, 1, len, sc->sc_cmd_buf);
993 1.14 gdamore m_freem(m);
994 1.5 dsainty
995 1.5 dsainty memset(&req, 0, sizeof(req));
996 1.5 dsainty req.bmRequestType = UT_WRITE_CLASS_DEVICE;
997 1.5 dsainty USETW(req.wLength, len);
998 1.5 dsainty
999 1.14 gdamore usbd_setup_default_xfer(sc->sc_cmd_xfer,
1000 1.5 dsainty sc->sc_udev,
1001 1.27 plunky sc,
1002 1.14 gdamore UBT_CMD_TIMEOUT,
1003 1.14 gdamore &req,
1004 1.14 gdamore sc->sc_cmd_buf,
1005 1.14 gdamore len,
1006 1.14 gdamore USBD_NO_COPY | USBD_FORCE_SHORT_XFER,
1007 1.14 gdamore ubt_xmit_cmd_complete);
1008 1.14 gdamore
1009 1.14 gdamore status = usbd_transfer(sc->sc_cmd_xfer);
1010 1.14 gdamore
1011 1.14 gdamore KASSERT(status != USBD_NORMAL_COMPLETION);
1012 1.14 gdamore
1013 1.14 gdamore if (status != USBD_IN_PROGRESS) {
1014 1.14 gdamore DPRINTF("usbd_transfer status=%s (%d)\n",
1015 1.14 gdamore usbd_errstr(status), status);
1016 1.14 gdamore
1017 1.14 gdamore sc->sc_refcnt--;
1018 1.14 gdamore unit->hci_flags &= ~BTF_XMIT_CMD;
1019 1.14 gdamore }
1020 1.14 gdamore }
1021 1.14 gdamore
1022 1.14 gdamore static void
1023 1.14 gdamore ubt_xmit_cmd_complete(usbd_xfer_handle xfer,
1024 1.14 gdamore usbd_private_handle h, usbd_status status)
1025 1.14 gdamore {
1026 1.27 plunky struct ubt_softc *sc = h;
1027 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
1028 1.14 gdamore uint32_t count;
1029 1.5 dsainty
1030 1.14 gdamore DPRINTFN(15, "%s: CMD complete status=%s (%d)\n",
1031 1.27 plunky USBDEVNAME(sc->sc_dev), usbd_errstr(status), status);
1032 1.5 dsainty
1033 1.14 gdamore unit->hci_flags &= ~BTF_XMIT_CMD;
1034 1.14 gdamore
1035 1.14 gdamore if (--sc->sc_refcnt < 0) {
1036 1.14 gdamore DPRINTF("sc_refcnt=%d\n", sc->sc_refcnt);
1037 1.5 dsainty usb_detach_wakeup(USBDEV(sc->sc_dev));
1038 1.14 gdamore return;
1039 1.14 gdamore }
1040 1.5 dsainty
1041 1.14 gdamore if (sc->sc_dying) {
1042 1.14 gdamore DPRINTF("sc_dying\n");
1043 1.14 gdamore return;
1044 1.14 gdamore }
1045 1.5 dsainty
1046 1.14 gdamore if (status != USBD_NORMAL_COMPLETION) {
1047 1.14 gdamore DPRINTF("status=%s (%d)\n",
1048 1.14 gdamore usbd_errstr(status), status);
1049 1.5 dsainty
1050 1.14 gdamore unit->hci_stats.err_tx++;
1051 1.14 gdamore return;
1052 1.14 gdamore }
1053 1.6 dsainty
1054 1.14 gdamore usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1055 1.14 gdamore unit->hci_stats.cmd_tx++;
1056 1.14 gdamore unit->hci_stats.byte_tx += count;
1057 1.6 dsainty
1058 1.27 plunky ubt_xmit_cmd_start(USBDEV(sc->sc_dev));
1059 1.6 dsainty }
1060 1.6 dsainty
1061 1.14 gdamore static void
1062 1.27 plunky ubt_xmit_acl_start(device_ptr_t self)
1063 1.5 dsainty {
1064 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
1065 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
1066 1.14 gdamore struct mbuf *m;
1067 1.5 dsainty usbd_status status;
1068 1.14 gdamore int len;
1069 1.14 gdamore
1070 1.14 gdamore if (sc->sc_dying)
1071 1.14 gdamore return;
1072 1.14 gdamore
1073 1.14 gdamore if (MBUFQ_FIRST(&unit->hci_acltxq) == NULL)
1074 1.14 gdamore return;
1075 1.5 dsainty
1076 1.14 gdamore sc->sc_refcnt++;
1077 1.14 gdamore unit->hci_flags |= BTF_XMIT_ACL;
1078 1.14 gdamore
1079 1.14 gdamore MBUFQ_DEQUEUE(&unit->hci_acltxq, m);
1080 1.14 gdamore KASSERT(m != NULL);
1081 1.5 dsainty
1082 1.14 gdamore DPRINTFN(15, "%s: xmit ACL packet (%d bytes)\n",
1083 1.27 plunky USBDEVNAME(sc->sc_dev), m->m_pkthdr.len);
1084 1.14 gdamore
1085 1.14 gdamore len = m->m_pkthdr.len - 1;
1086 1.14 gdamore if (len > UBT_BUFSIZ_ACL) {
1087 1.14 gdamore DPRINTF("%s: truncating ACL packet (%d => %d)!\n",
1088 1.27 plunky USBDEVNAME(sc->sc_dev), len, UBT_BUFSIZ_ACL);
1089 1.6 dsainty
1090 1.14 gdamore len = UBT_BUFSIZ_ACL;
1091 1.14 gdamore }
1092 1.5 dsainty
1093 1.14 gdamore m_copydata(m, 1, len, sc->sc_aclwr_buf);
1094 1.14 gdamore m_freem(m);
1095 1.5 dsainty
1096 1.14 gdamore unit->hci_stats.acl_tx++;
1097 1.14 gdamore unit->hci_stats.byte_tx += len;
1098 1.5 dsainty
1099 1.5 dsainty usbd_setup_xfer(sc->sc_aclwr_xfer,
1100 1.5 dsainty sc->sc_aclwr_pipe,
1101 1.27 plunky sc,
1102 1.14 gdamore sc->sc_aclwr_buf,
1103 1.14 gdamore len,
1104 1.14 gdamore USBD_NO_COPY | USBD_FORCE_SHORT_XFER,
1105 1.14 gdamore UBT_ACL_TIMEOUT,
1106 1.14 gdamore ubt_xmit_acl_complete);
1107 1.5 dsainty
1108 1.5 dsainty status = usbd_transfer(sc->sc_aclwr_xfer);
1109 1.5 dsainty
1110 1.14 gdamore KASSERT(status != USBD_NORMAL_COMPLETION);
1111 1.14 gdamore
1112 1.14 gdamore if (status != USBD_IN_PROGRESS) {
1113 1.14 gdamore DPRINTF("usbd_transfer status=%s (%d)\n",
1114 1.14 gdamore usbd_errstr(status), status);
1115 1.14 gdamore
1116 1.14 gdamore sc->sc_refcnt--;
1117 1.14 gdamore unit->hci_flags &= ~BTF_XMIT_ACL;
1118 1.14 gdamore }
1119 1.14 gdamore }
1120 1.14 gdamore
1121 1.14 gdamore static void
1122 1.20 christos ubt_xmit_acl_complete(usbd_xfer_handle xfer,
1123 1.14 gdamore usbd_private_handle h, usbd_status status)
1124 1.14 gdamore {
1125 1.27 plunky struct ubt_softc *sc = h;
1126 1.27 plunky struct hci_unit *unit = &sc->sc_unit;
1127 1.14 gdamore
1128 1.14 gdamore DPRINTFN(15, "%s: ACL complete status=%s (%d)\n",
1129 1.27 plunky USBDEVNAME(sc->sc_dev), usbd_errstr(status), status);
1130 1.14 gdamore
1131 1.14 gdamore unit->hci_flags &= ~BTF_XMIT_ACL;
1132 1.14 gdamore
1133 1.14 gdamore if (--sc->sc_refcnt < 0) {
1134 1.5 dsainty usb_detach_wakeup(USBDEV(sc->sc_dev));
1135 1.14 gdamore return;
1136 1.14 gdamore }
1137 1.5 dsainty
1138 1.14 gdamore if (sc->sc_dying)
1139 1.14 gdamore return;
1140 1.5 dsainty
1141 1.14 gdamore if (status != USBD_NORMAL_COMPLETION) {
1142 1.14 gdamore DPRINTF("status=%s (%d)\n",
1143 1.14 gdamore usbd_errstr(status), status);
1144 1.14 gdamore
1145 1.14 gdamore unit->hci_stats.err_tx++;
1146 1.14 gdamore
1147 1.14 gdamore if (status == USBD_STALLED)
1148 1.14 gdamore usbd_clear_endpoint_stall_async(sc->sc_aclwr_pipe);
1149 1.14 gdamore else
1150 1.14 gdamore return;
1151 1.14 gdamore }
1152 1.14 gdamore
1153 1.27 plunky ubt_xmit_acl_start(USBDEV(sc->sc_dev));
1154 1.14 gdamore }
1155 1.14 gdamore
1156 1.14 gdamore static void
1157 1.27 plunky ubt_xmit_sco_start(device_ptr_t self)
1158 1.14 gdamore {
1159 1.27 plunky struct ubt_softc *sc = USBGETSOFTC(self);
1160 1.14 gdamore int i;
1161 1.14 gdamore
1162 1.14 gdamore if (sc->sc_dying || sc->sc_scowr_size == 0)
1163 1.14 gdamore return;
1164 1.14 gdamore
1165 1.14 gdamore for (i = 0 ; i < UBT_NXFERS ; i++) {
1166 1.14 gdamore if (sc->sc_scowr[i].busy)
1167 1.14 gdamore continue;
1168 1.14 gdamore
1169 1.14 gdamore ubt_xmit_sco_start1(sc, &sc->sc_scowr[i]);
1170 1.14 gdamore }
1171 1.5 dsainty }
1172 1.5 dsainty
1173 1.14 gdamore static void
1174 1.14 gdamore ubt_xmit_sco_start1(struct ubt_softc *sc, struct ubt_isoc_xfer *isoc)
1175 1.6 dsainty {
1176 1.14 gdamore struct mbuf *m;
1177 1.14 gdamore uint8_t *buf;
1178 1.14 gdamore int num, len, size, space;
1179 1.14 gdamore
1180 1.14 gdamore space = sc->sc_scowr_size * UBT_NFRAMES;
1181 1.14 gdamore buf = isoc->buf;
1182 1.14 gdamore len = 0;
1183 1.14 gdamore
1184 1.14 gdamore /*
1185 1.14 gdamore * Fill the request buffer with data from the queue,
1186 1.14 gdamore * keeping any leftover packet on our private hook.
1187 1.14 gdamore *
1188 1.14 gdamore * Complete packets are passed back up to the stack
1189 1.14 gdamore * for disposal, since we can't rely on the controller
1190 1.14 gdamore * to tell us when it has finished with them.
1191 1.14 gdamore */
1192 1.14 gdamore
1193 1.14 gdamore m = sc->sc_scowr_mbuf;
1194 1.14 gdamore while (space > 0) {
1195 1.14 gdamore if (m == NULL) {
1196 1.14 gdamore MBUFQ_DEQUEUE(&sc->sc_unit.hci_scotxq, m);
1197 1.14 gdamore if (m == NULL)
1198 1.14 gdamore break;
1199 1.14 gdamore
1200 1.14 gdamore m_adj(m, 1); /* packet type */
1201 1.14 gdamore }
1202 1.14 gdamore
1203 1.14 gdamore if (m->m_pkthdr.len > 0) {
1204 1.14 gdamore size = MIN(m->m_pkthdr.len, space);
1205 1.14 gdamore
1206 1.14 gdamore m_copydata(m, 0, size, buf);
1207 1.14 gdamore m_adj(m, size);
1208 1.14 gdamore
1209 1.14 gdamore buf += size;
1210 1.14 gdamore len += size;
1211 1.14 gdamore space -= size;
1212 1.14 gdamore }
1213 1.14 gdamore
1214 1.14 gdamore if (m->m_pkthdr.len == 0) {
1215 1.14 gdamore sc->sc_unit.hci_stats.sco_tx++;
1216 1.14 gdamore hci_complete_sco(&sc->sc_unit, m);
1217 1.14 gdamore m = NULL;
1218 1.14 gdamore }
1219 1.14 gdamore }
1220 1.14 gdamore sc->sc_scowr_mbuf = m;
1221 1.14 gdamore
1222 1.14 gdamore DPRINTFN(15, "isoc=%p, len=%d, space=%d\n", isoc, len, space);
1223 1.14 gdamore
1224 1.14 gdamore if (len == 0) /* nothing to send */
1225 1.14 gdamore return;
1226 1.14 gdamore
1227 1.14 gdamore sc->sc_refcnt++;
1228 1.14 gdamore sc->sc_unit.hci_flags |= BTF_XMIT_SCO;
1229 1.14 gdamore sc->sc_unit.hci_stats.byte_tx += len;
1230 1.14 gdamore isoc->busy = 1;
1231 1.14 gdamore
1232 1.14 gdamore /*
1233 1.14 gdamore * calculate number of isoc frames and sizes
1234 1.14 gdamore */
1235 1.14 gdamore
1236 1.14 gdamore for (num = 0 ; len > 0 ; num++) {
1237 1.14 gdamore size = MIN(sc->sc_scowr_size, len);
1238 1.14 gdamore
1239 1.14 gdamore isoc->size[num] = size;
1240 1.14 gdamore len -= size;
1241 1.14 gdamore }
1242 1.14 gdamore
1243 1.14 gdamore usbd_setup_isoc_xfer(isoc->xfer,
1244 1.14 gdamore sc->sc_scowr_pipe,
1245 1.14 gdamore isoc,
1246 1.14 gdamore isoc->size,
1247 1.14 gdamore num,
1248 1.14 gdamore USBD_NO_COPY | USBD_FORCE_SHORT_XFER,
1249 1.14 gdamore ubt_xmit_sco_complete);
1250 1.14 gdamore
1251 1.14 gdamore usbd_transfer(isoc->xfer);
1252 1.6 dsainty }
1253 1.6 dsainty
1254 1.14 gdamore static void
1255 1.20 christos ubt_xmit_sco_complete(usbd_xfer_handle xfer,
1256 1.14 gdamore usbd_private_handle h, usbd_status status)
1257 1.5 dsainty {
1258 1.14 gdamore struct ubt_isoc_xfer *isoc = h;
1259 1.14 gdamore struct ubt_softc *sc;
1260 1.14 gdamore int i;
1261 1.14 gdamore
1262 1.14 gdamore KASSERT(xfer == isoc->xfer);
1263 1.14 gdamore sc = isoc->softc;
1264 1.14 gdamore
1265 1.14 gdamore DPRINTFN(15, "isoc=%p, status=%s (%d)\n",
1266 1.14 gdamore isoc, usbd_errstr(status), status);
1267 1.14 gdamore
1268 1.14 gdamore isoc->busy = 0;
1269 1.14 gdamore
1270 1.14 gdamore for (i = 0 ; ; i++) {
1271 1.14 gdamore if (i == UBT_NXFERS) {
1272 1.14 gdamore sc->sc_unit.hci_flags &= ~BTF_XMIT_SCO;
1273 1.14 gdamore break;
1274 1.14 gdamore }
1275 1.5 dsainty
1276 1.14 gdamore if (sc->sc_scowr[i].busy)
1277 1.14 gdamore break;
1278 1.14 gdamore }
1279 1.14 gdamore
1280 1.14 gdamore if (--sc->sc_refcnt < 0) {
1281 1.14 gdamore usb_detach_wakeup(USBDEV(sc->sc_dev));
1282 1.14 gdamore return;
1283 1.14 gdamore }
1284 1.5 dsainty
1285 1.5 dsainty if (sc->sc_dying)
1286 1.14 gdamore return;
1287 1.5 dsainty
1288 1.14 gdamore if (status != USBD_NORMAL_COMPLETION) {
1289 1.14 gdamore DPRINTF("status=%s (%d)\n",
1290 1.14 gdamore usbd_errstr(status), status);
1291 1.14 gdamore
1292 1.14 gdamore sc->sc_unit.hci_stats.err_tx++;
1293 1.14 gdamore
1294 1.14 gdamore if (status == USBD_STALLED)
1295 1.14 gdamore usbd_clear_endpoint_stall_async(sc->sc_scowr_pipe);
1296 1.14 gdamore else
1297 1.14 gdamore return;
1298 1.14 gdamore }
1299 1.14 gdamore
1300 1.27 plunky ubt_xmit_sco_start(USBDEV(sc->sc_dev));
1301 1.14 gdamore }
1302 1.14 gdamore
1303 1.14 gdamore /*
1304 1.14 gdamore * load incoming data into an mbuf with
1305 1.14 gdamore * leading type byte
1306 1.14 gdamore */
1307 1.14 gdamore static struct mbuf *
1308 1.14 gdamore ubt_mbufload(uint8_t *buf, int count, uint8_t type)
1309 1.14 gdamore {
1310 1.14 gdamore struct mbuf *m;
1311 1.14 gdamore
1312 1.14 gdamore MGETHDR(m, M_DONTWAIT, MT_DATA);
1313 1.14 gdamore if (m == NULL)
1314 1.14 gdamore return NULL;
1315 1.14 gdamore
1316 1.14 gdamore *mtod(m, uint8_t *) = type;
1317 1.14 gdamore m->m_pkthdr.len = m->m_len = MHLEN;
1318 1.14 gdamore m_copyback(m, 1, count, buf); // (extends if necessary)
1319 1.14 gdamore if (m->m_pkthdr.len != MAX(MHLEN, count + 1)) {
1320 1.14 gdamore m_free(m);
1321 1.14 gdamore return NULL;
1322 1.14 gdamore }
1323 1.14 gdamore
1324 1.14 gdamore m->m_pkthdr.len = count + 1;
1325 1.14 gdamore m->m_len = MIN(MHLEN, m->m_pkthdr.len);
1326 1.14 gdamore
1327 1.14 gdamore return m;
1328 1.5 dsainty }
1329 1.5 dsainty
1330 1.5 dsainty static void
1331 1.14 gdamore ubt_recv_event(usbd_xfer_handle xfer, usbd_private_handle h, usbd_status status)
1332 1.5 dsainty {
1333 1.5 dsainty struct ubt_softc *sc = h;
1334 1.14 gdamore struct mbuf *m;
1335 1.14 gdamore uint32_t count;
1336 1.5 dsainty void *buf;
1337 1.5 dsainty
1338 1.14 gdamore DPRINTFN(15, "sc=%p status=%s (%d)\n",
1339 1.14 gdamore sc, usbd_errstr(status), status);
1340 1.5 dsainty
1341 1.14 gdamore if (status != USBD_NORMAL_COMPLETION || sc->sc_dying)
1342 1.5 dsainty return;
1343 1.5 dsainty
1344 1.14 gdamore usbd_get_xfer_status(xfer, NULL, &buf, &count, NULL);
1345 1.14 gdamore
1346 1.16 plunky if (count < sizeof(hci_event_hdr_t) - 1) {
1347 1.16 plunky DPRINTF("dumped undersized event (count = %d)\n", count);
1348 1.16 plunky sc->sc_unit.hci_stats.err_rx++;
1349 1.16 plunky return;
1350 1.16 plunky }
1351 1.16 plunky
1352 1.14 gdamore sc->sc_unit.hci_stats.evt_rx++;
1353 1.14 gdamore sc->sc_unit.hci_stats.byte_rx += count;
1354 1.5 dsainty
1355 1.14 gdamore m = ubt_mbufload(buf, count, HCI_EVENT_PKT);
1356 1.14 gdamore if (m != NULL)
1357 1.14 gdamore hci_input_event(&sc->sc_unit, m);
1358 1.14 gdamore else
1359 1.14 gdamore sc->sc_unit.hci_stats.err_rx++;
1360 1.5 dsainty }
1361 1.5 dsainty
1362 1.5 dsainty static void
1363 1.14 gdamore ubt_recv_acl_start(struct ubt_softc *sc)
1364 1.5 dsainty {
1365 1.5 dsainty usbd_status status;
1366 1.5 dsainty
1367 1.14 gdamore DPRINTFN(15, "sc=%p\n", sc);
1368 1.5 dsainty
1369 1.14 gdamore if (sc->sc_aclrd_busy || sc->sc_dying) {
1370 1.14 gdamore DPRINTF("sc_aclrd_busy=%d, sc_dying=%d\n",
1371 1.14 gdamore sc->sc_aclrd_busy,
1372 1.14 gdamore sc->sc_dying);
1373 1.5 dsainty
1374 1.5 dsainty return;
1375 1.5 dsainty }
1376 1.6 dsainty
1377 1.14 gdamore sc->sc_refcnt++;
1378 1.14 gdamore sc->sc_aclrd_busy = 1;
1379 1.14 gdamore
1380 1.14 gdamore usbd_setup_xfer(sc->sc_aclrd_xfer,
1381 1.14 gdamore sc->sc_aclrd_pipe,
1382 1.14 gdamore sc,
1383 1.14 gdamore sc->sc_aclrd_buf,
1384 1.14 gdamore UBT_BUFSIZ_ACL,
1385 1.14 gdamore USBD_NO_COPY | USBD_SHORT_XFER_OK,
1386 1.14 gdamore USBD_NO_TIMEOUT,
1387 1.14 gdamore ubt_recv_acl_complete);
1388 1.5 dsainty
1389 1.5 dsainty status = usbd_transfer(sc->sc_aclrd_xfer);
1390 1.9 dsainty
1391 1.14 gdamore KASSERT(status != USBD_NORMAL_COMPLETION);
1392 1.5 dsainty
1393 1.14 gdamore if (status != USBD_IN_PROGRESS) {
1394 1.14 gdamore DPRINTF("usbd_transfer status=%s (%d)\n",
1395 1.14 gdamore usbd_errstr(status), status);
1396 1.5 dsainty
1397 1.14 gdamore sc->sc_refcnt--;
1398 1.14 gdamore sc->sc_aclrd_busy = 0;
1399 1.14 gdamore }
1400 1.5 dsainty }
1401 1.5 dsainty
1402 1.5 dsainty static void
1403 1.14 gdamore ubt_recv_acl_complete(usbd_xfer_handle xfer,
1404 1.14 gdamore usbd_private_handle h, usbd_status status)
1405 1.5 dsainty {
1406 1.5 dsainty struct ubt_softc *sc = h;
1407 1.14 gdamore struct mbuf *m;
1408 1.14 gdamore uint32_t count;
1409 1.5 dsainty void *buf;
1410 1.5 dsainty
1411 1.14 gdamore DPRINTFN(15, "sc=%p status=%s (%d)\n",
1412 1.14 gdamore sc, usbd_errstr(status), status);
1413 1.14 gdamore
1414 1.14 gdamore sc->sc_aclrd_busy = 0;
1415 1.14 gdamore
1416 1.14 gdamore if (--sc->sc_refcnt < 0) {
1417 1.14 gdamore DPRINTF("refcnt = %d\n", sc->sc_refcnt);
1418 1.14 gdamore usb_detach_wakeup(USBDEV(sc->sc_dev));
1419 1.14 gdamore return;
1420 1.14 gdamore }
1421 1.14 gdamore
1422 1.14 gdamore if (sc->sc_dying) {
1423 1.14 gdamore DPRINTF("sc_dying\n");
1424 1.14 gdamore return;
1425 1.14 gdamore }
1426 1.14 gdamore
1427 1.14 gdamore if (status != USBD_NORMAL_COMPLETION) {
1428 1.14 gdamore DPRINTF("status=%s (%d)\n",
1429 1.14 gdamore usbd_errstr(status), status);
1430 1.14 gdamore
1431 1.14 gdamore sc->sc_unit.hci_stats.err_rx++;
1432 1.14 gdamore
1433 1.14 gdamore if (status == USBD_STALLED)
1434 1.14 gdamore usbd_clear_endpoint_stall_async(sc->sc_aclrd_pipe);
1435 1.14 gdamore else
1436 1.14 gdamore return;
1437 1.14 gdamore } else {
1438 1.14 gdamore usbd_get_xfer_status(xfer, NULL, &buf, &count, NULL);
1439 1.14 gdamore
1440 1.16 plunky if (count < sizeof(hci_acldata_hdr_t) - 1) {
1441 1.16 plunky DPRINTF("dumped undersized packet (%d)\n", count);
1442 1.16 plunky sc->sc_unit.hci_stats.err_rx++;
1443 1.16 plunky } else {
1444 1.16 plunky sc->sc_unit.hci_stats.acl_rx++;
1445 1.16 plunky sc->sc_unit.hci_stats.byte_rx += count;
1446 1.14 gdamore
1447 1.16 plunky m = ubt_mbufload(buf, count, HCI_ACL_DATA_PKT);
1448 1.16 plunky if (m != NULL)
1449 1.16 plunky hci_input_acl(&sc->sc_unit, m);
1450 1.16 plunky else
1451 1.16 plunky sc->sc_unit.hci_stats.err_rx++;
1452 1.16 plunky }
1453 1.14 gdamore }
1454 1.5 dsainty
1455 1.14 gdamore /* and restart */
1456 1.14 gdamore ubt_recv_acl_start(sc);
1457 1.14 gdamore }
1458 1.14 gdamore
1459 1.14 gdamore static void
1460 1.14 gdamore ubt_recv_sco_start1(struct ubt_softc *sc, struct ubt_isoc_xfer *isoc)
1461 1.14 gdamore {
1462 1.14 gdamore int i;
1463 1.14 gdamore
1464 1.14 gdamore DPRINTFN(15, "sc=%p, isoc=%p\n", sc, isoc);
1465 1.14 gdamore
1466 1.14 gdamore if (isoc->busy || sc->sc_dying || sc->sc_scord_size == 0) {
1467 1.14 gdamore DPRINTF("%s%s%s\n",
1468 1.14 gdamore isoc->busy ? " busy" : "",
1469 1.14 gdamore sc->sc_dying ? " dying" : "",
1470 1.14 gdamore sc->sc_scord_size == 0 ? " size=0" : "");
1471 1.5 dsainty
1472 1.5 dsainty return;
1473 1.14 gdamore }
1474 1.14 gdamore
1475 1.14 gdamore sc->sc_refcnt++;
1476 1.14 gdamore isoc->busy = 1;
1477 1.5 dsainty
1478 1.14 gdamore for (i = 0 ; i < UBT_NFRAMES ; i++)
1479 1.14 gdamore isoc->size[i] = sc->sc_scord_size;
1480 1.5 dsainty
1481 1.14 gdamore usbd_setup_isoc_xfer(isoc->xfer,
1482 1.14 gdamore sc->sc_scord_pipe,
1483 1.14 gdamore isoc,
1484 1.14 gdamore isoc->size,
1485 1.14 gdamore UBT_NFRAMES,
1486 1.14 gdamore USBD_NO_COPY | USBD_SHORT_XFER_OK,
1487 1.14 gdamore ubt_recv_sco_complete);
1488 1.5 dsainty
1489 1.14 gdamore usbd_transfer(isoc->xfer);
1490 1.5 dsainty }
1491 1.5 dsainty
1492 1.14 gdamore static void
1493 1.14 gdamore ubt_recv_sco_complete(usbd_xfer_handle xfer,
1494 1.14 gdamore usbd_private_handle h, usbd_status status)
1495 1.5 dsainty {
1496 1.14 gdamore struct ubt_isoc_xfer *isoc = h;
1497 1.14 gdamore struct ubt_softc *sc;
1498 1.14 gdamore struct mbuf *m;
1499 1.14 gdamore uint32_t count;
1500 1.14 gdamore uint8_t *ptr, *frame;
1501 1.14 gdamore int i, size, got, want;
1502 1.14 gdamore
1503 1.14 gdamore KASSERT(isoc != NULL);
1504 1.14 gdamore KASSERT(isoc->xfer == xfer);
1505 1.14 gdamore
1506 1.14 gdamore sc = isoc->softc;
1507 1.14 gdamore isoc->busy = 0;
1508 1.14 gdamore
1509 1.14 gdamore if (--sc->sc_refcnt < 0) {
1510 1.14 gdamore DPRINTF("refcnt=%d\n", sc->sc_refcnt);
1511 1.14 gdamore usb_detach_wakeup(USBDEV(sc->sc_dev));
1512 1.14 gdamore return;
1513 1.14 gdamore }
1514 1.14 gdamore
1515 1.14 gdamore if (sc->sc_dying) {
1516 1.14 gdamore DPRINTF("sc_dying\n");
1517 1.14 gdamore return;
1518 1.14 gdamore }
1519 1.14 gdamore
1520 1.14 gdamore if (status != USBD_NORMAL_COMPLETION) {
1521 1.14 gdamore DPRINTF("status=%s (%d)\n",
1522 1.14 gdamore usbd_errstr(status), status);
1523 1.14 gdamore
1524 1.14 gdamore sc->sc_unit.hci_stats.err_rx++;
1525 1.14 gdamore
1526 1.14 gdamore if (status == USBD_STALLED) {
1527 1.14 gdamore usbd_clear_endpoint_stall_async(sc->sc_scord_pipe);
1528 1.14 gdamore goto restart;
1529 1.14 gdamore }
1530 1.14 gdamore
1531 1.14 gdamore return;
1532 1.14 gdamore }
1533 1.14 gdamore
1534 1.14 gdamore usbd_get_xfer_status(xfer, NULL, NULL, &count, NULL);
1535 1.14 gdamore if (count == 0)
1536 1.14 gdamore goto restart;
1537 1.14 gdamore
1538 1.14 gdamore DPRINTFN(15, "sc=%p, isoc=%p, count=%u\n",
1539 1.14 gdamore sc, isoc, count);
1540 1.14 gdamore
1541 1.14 gdamore sc->sc_unit.hci_stats.byte_rx += count;
1542 1.14 gdamore
1543 1.14 gdamore /*
1544 1.14 gdamore * Extract SCO packets from ISOC frames. The way we have it,
1545 1.14 gdamore * no SCO packet can be bigger than MHLEN. This is unlikely
1546 1.14 gdamore * to actually happen, but if we ran out of mbufs and lost
1547 1.14 gdamore * sync then we may get spurious data that makes it seem that
1548 1.14 gdamore * way, so we discard data that wont fit. This doesnt really
1549 1.14 gdamore * help with the lost sync situation alas.
1550 1.14 gdamore */
1551 1.14 gdamore
1552 1.14 gdamore m = sc->sc_scord_mbuf;
1553 1.14 gdamore if (m != NULL) {
1554 1.14 gdamore sc->sc_scord_mbuf = NULL;
1555 1.14 gdamore ptr = mtod(m, uint8_t *) + m->m_pkthdr.len;
1556 1.14 gdamore got = m->m_pkthdr.len;
1557 1.14 gdamore want = sizeof(hci_scodata_hdr_t);
1558 1.14 gdamore if (got >= want)
1559 1.14 gdamore want += mtod(m, hci_scodata_hdr_t *)->length ;
1560 1.14 gdamore } else {
1561 1.14 gdamore ptr = NULL;
1562 1.14 gdamore got = 0;
1563 1.14 gdamore want = 0;
1564 1.14 gdamore }
1565 1.14 gdamore
1566 1.14 gdamore for (i = 0 ; i < UBT_NFRAMES ; i++) {
1567 1.14 gdamore frame = isoc->buf + (i * sc->sc_scord_size);
1568 1.14 gdamore
1569 1.14 gdamore while (isoc->size[i] > 0) {
1570 1.14 gdamore size = isoc->size[i];
1571 1.14 gdamore
1572 1.14 gdamore if (m == NULL) {
1573 1.14 gdamore MGETHDR(m, M_DONTWAIT, MT_DATA);
1574 1.14 gdamore if (m == NULL) {
1575 1.14 gdamore printf("%s: out of memory (xfer halted)\n",
1576 1.14 gdamore USBDEVNAME(sc->sc_dev));
1577 1.14 gdamore
1578 1.14 gdamore sc->sc_unit.hci_stats.err_rx++;
1579 1.14 gdamore return; /* lost sync */
1580 1.14 gdamore }
1581 1.14 gdamore
1582 1.14 gdamore ptr = mtod(m, uint8_t *);
1583 1.14 gdamore *ptr++ = HCI_SCO_DATA_PKT;
1584 1.14 gdamore got = 1;
1585 1.14 gdamore want = sizeof(hci_scodata_hdr_t);
1586 1.14 gdamore }
1587 1.14 gdamore
1588 1.14 gdamore if (got + size > want)
1589 1.14 gdamore size = want - got;
1590 1.14 gdamore
1591 1.14 gdamore if (got + size > MHLEN)
1592 1.14 gdamore memcpy(ptr, frame, MHLEN - got);
1593 1.14 gdamore else
1594 1.14 gdamore memcpy(ptr, frame, size);
1595 1.14 gdamore
1596 1.14 gdamore ptr += size;
1597 1.14 gdamore got += size;
1598 1.14 gdamore frame += size;
1599 1.14 gdamore
1600 1.14 gdamore if (got == want) {
1601 1.14 gdamore /*
1602 1.14 gdamore * If we only got a header, add the packet
1603 1.14 gdamore * length to our want count. Send complete
1604 1.14 gdamore * packets up to protocol stack.
1605 1.14 gdamore */
1606 1.14 gdamore if (want == sizeof(hci_scodata_hdr_t))
1607 1.14 gdamore want += mtod(m, hci_scodata_hdr_t *)->length;
1608 1.14 gdamore
1609 1.14 gdamore if (got == want) {
1610 1.14 gdamore m->m_pkthdr.len = m->m_len = got;
1611 1.14 gdamore sc->sc_unit.hci_stats.sco_rx++;
1612 1.14 gdamore hci_input_sco(&sc->sc_unit, m);
1613 1.14 gdamore m = NULL;
1614 1.14 gdamore }
1615 1.14 gdamore }
1616 1.14 gdamore
1617 1.14 gdamore isoc->size[i] -= size;
1618 1.14 gdamore }
1619 1.14 gdamore }
1620 1.14 gdamore
1621 1.14 gdamore if (m != NULL) {
1622 1.14 gdamore m->m_pkthdr.len = m->m_len = got;
1623 1.14 gdamore sc->sc_scord_mbuf = m;
1624 1.14 gdamore }
1625 1.14 gdamore
1626 1.14 gdamore restart: /* and restart */
1627 1.14 gdamore ubt_recv_sco_start1(sc, isoc);
1628 1.1 augustss }
1629