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