ubt.c revision 1.8 1 1.8 dsainty /* $NetBSD: ubt.c,v 1.8 2004/01/01 16:10:13 dsainty Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.5 dsainty * Copyright (c) 2002, 2003 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.1 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.5 dsainty * by Lennart Augustsson (lennart (at) augustsson.net) and
9 1.5 dsainty * David Sainty (David.Sainty (at) dtsp.co.nz).
10 1.1 augustss *
11 1.1 augustss * Redistribution and use in source and binary forms, with or without
12 1.1 augustss * modification, are permitted provided that the following conditions
13 1.1 augustss * are met:
14 1.1 augustss * 1. Redistributions of source code must retain the above copyright
15 1.1 augustss * notice, this list of conditions and the following disclaimer.
16 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 augustss * notice, this list of conditions and the following disclaimer in the
18 1.1 augustss * documentation and/or other materials provided with the distribution.
19 1.1 augustss * 3. All advertising materials mentioning features or use of this software
20 1.1 augustss * must display the following acknowledgement:
21 1.1 augustss * This product includes software developed by the NetBSD
22 1.1 augustss * Foundation, Inc. and its contributors.
23 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.1 augustss * contributors may be used to endorse or promote products derived
25 1.1 augustss * from this software without specific prior written permission.
26 1.1 augustss *
27 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
38 1.1 augustss */
39 1.1 augustss
40 1.1 augustss #include <sys/cdefs.h>
41 1.8 dsainty __KERNEL_RCSID(0, "$NetBSD: ubt.c,v 1.8 2004/01/01 16:10:13 dsainty Exp $");
42 1.1 augustss
43 1.1 augustss #include <sys/param.h>
44 1.1 augustss #include <sys/systm.h>
45 1.1 augustss #include <sys/kernel.h>
46 1.5 dsainty #include <sys/malloc.h>
47 1.1 augustss #include <sys/device.h>
48 1.1 augustss #include <sys/lock.h>
49 1.1 augustss #include <sys/ioctl.h>
50 1.1 augustss #include <sys/conf.h>
51 1.1 augustss #include <sys/file.h>
52 1.1 augustss #include <sys/poll.h>
53 1.1 augustss #include <sys/select.h>
54 1.1 augustss #include <sys/proc.h>
55 1.1 augustss
56 1.5 dsainty #include <dev/usb/ubtreg.h>
57 1.1 augustss #include <dev/usb/usb.h>
58 1.1 augustss #include <dev/usb/usbdi.h>
59 1.1 augustss #include <dev/usb/usbdi_util.h>
60 1.1 augustss #include <dev/usb/usbdevs.h>
61 1.1 augustss
62 1.3 augustss #include <dev/bluetooth/bluetooth.h>
63 1.3 augustss
64 1.1 augustss #ifdef UBT_DEBUG
65 1.1 augustss #define DPRINTF(x) if (ubtdebug) logprintf x
66 1.1 augustss #define DPRINTFN(n,x) if (ubtdebug>(n)) logprintf x
67 1.7 augustss int ubtdebug = 49;
68 1.1 augustss #else
69 1.1 augustss #define DPRINTF(x)
70 1.1 augustss #define DPRINTFN(n,x)
71 1.1 augustss #endif
72 1.1 augustss
73 1.1 augustss /*
74 1.1 augustss * Protocol related definitions
75 1.1 augustss */
76 1.1 augustss
77 1.1 augustss struct ubt_softc {
78 1.1 augustss USBBASEDEVICE sc_dev;
79 1.1 augustss usbd_device_handle sc_udev;
80 1.3 augustss usbd_interface_handle sc_ctl_iface;
81 1.3 augustss usbd_interface_handle sc_isoc_iface;
82 1.1 augustss
83 1.5 dsainty /* Control */
84 1.5 dsainty usbd_pipe_handle sc_ctl_pipe;
85 1.5 dsainty usbd_xfer_handle sc_ctl_xfer;
86 1.5 dsainty u_int8_t *sc_ctl_buf;
87 1.5 dsainty
88 1.5 dsainty /* Events */
89 1.5 dsainty int sc_evt_addr;
90 1.5 dsainty usbd_pipe_handle sc_evt_pipe;
91 1.5 dsainty usbd_xfer_handle sc_evt_xfer;
92 1.5 dsainty u_int8_t *sc_evt_buf;
93 1.5 dsainty
94 1.5 dsainty /* ACL data (in) */
95 1.5 dsainty int sc_aclrd_addr;
96 1.5 dsainty usbd_pipe_handle sc_aclrd_pipe;
97 1.5 dsainty usbd_xfer_handle sc_aclrd_xfer;
98 1.5 dsainty u_int8_t *sc_aclrd_buf;
99 1.5 dsainty int sc_aclrd_running;
100 1.5 dsainty
101 1.5 dsainty /* ACL data (out) */
102 1.5 dsainty int sc_aclwr_addr;
103 1.5 dsainty usbd_pipe_handle sc_aclwr_pipe;
104 1.5 dsainty usbd_xfer_handle sc_aclwr_xfer;
105 1.5 dsainty u_int8_t *sc_aclwr_buf;
106 1.1 augustss
107 1.5 dsainty struct device *sc_child;
108 1.5 dsainty struct btframe_callback_methods const *sc_cb;
109 1.5 dsainty
110 1.5 dsainty unsigned int sc_blocked;
111 1.1 augustss
112 1.1 augustss int sc_refcnt;
113 1.1 augustss char sc_dying;
114 1.1 augustss };
115 1.1 augustss
116 1.5 dsainty static int ubt_open(void *h, int flag, int mode, usb_proc_ptr p);
117 1.5 dsainty static int ubt_close(void *h, int flag, int mode, usb_proc_ptr p);
118 1.5 dsainty
119 1.6 dsainty static u_int8_t* ubt_alloc_control(void*, size_t, struct btframe_buffer**);
120 1.6 dsainty static int ubt_send_control(void*, struct btframe_buffer*, size_t);
121 1.6 dsainty
122 1.6 dsainty static u_int8_t* ubt_alloc_acldata(void*, size_t, struct btframe_buffer**);
123 1.6 dsainty static int ubt_send_acldata(void*, struct btframe_buffer*, size_t);
124 1.6 dsainty
125 1.6 dsainty static u_int8_t* ubt_alloc_scodata(void*, size_t, struct btframe_buffer**);
126 1.6 dsainty static int ubt_send_scodata(void*, struct btframe_buffer*, size_t);
127 1.5 dsainty
128 1.5 dsainty static int ubt_splraise(void);
129 1.5 dsainty static unsigned int ubt_blockcb(void *h, unsigned int cbblocks);
130 1.5 dsainty static unsigned int ubt_unblockcb(void *h, unsigned int cbblocks);
131 1.5 dsainty
132 1.5 dsainty static void ubt_event_cb(usbd_xfer_handle, usbd_private_handle, usbd_status);
133 1.5 dsainty static void ubt_aclrd_cb(usbd_xfer_handle, usbd_private_handle, usbd_status);
134 1.5 dsainty static void ubt_aclrd_request(struct ubt_softc *);
135 1.5 dsainty
136 1.5 dsainty static struct btframe_methods const ubt_methods = {
137 1.6 dsainty ubt_open, ubt_close,
138 1.6 dsainty {ubt_alloc_control, ubt_send_control},
139 1.6 dsainty {ubt_alloc_acldata, ubt_send_acldata},
140 1.6 dsainty {ubt_alloc_scodata, ubt_send_scodata},
141 1.5 dsainty ubt_splraise, ubt_blockcb, ubt_unblockcb
142 1.5 dsainty };
143 1.5 dsainty
144 1.1 augustss USB_DECLARE_DRIVER(ubt);
145 1.1 augustss
146 1.1 augustss USB_MATCH(ubt)
147 1.1 augustss {
148 1.1 augustss USB_MATCH_START(ubt, uaa);
149 1.1 augustss usb_interface_descriptor_t *id;
150 1.1 augustss
151 1.1 augustss DPRINTFN(50,("ubt_match\n"));
152 1.1 augustss
153 1.1 augustss if (uaa->iface == NULL)
154 1.1 augustss return (UMATCH_NONE);
155 1.1 augustss
156 1.1 augustss id = usbd_get_interface_descriptor(uaa->iface);
157 1.1 augustss if (id != NULL &&
158 1.1 augustss id->bInterfaceClass == UICLASS_WIRELESS &&
159 1.1 augustss id->bInterfaceSubClass == UISUBCLASS_RF &&
160 1.1 augustss id->bInterfaceProtocol == UIPROTO_BLUETOOTH)
161 1.1 augustss return (UMATCH_IFACECLASS_IFACESUBCLASS_IFACEPROTO);
162 1.1 augustss return (UMATCH_NONE);
163 1.1 augustss }
164 1.1 augustss
165 1.1 augustss USB_ATTACH(ubt)
166 1.1 augustss {
167 1.1 augustss USB_ATTACH_START(ubt, sc, uaa);
168 1.1 augustss usbd_device_handle dev = uaa->device;
169 1.1 augustss usbd_interface_handle iface = uaa->iface;
170 1.3 augustss struct bt_attach_args bt;
171 1.5 dsainty usb_interface_descriptor_t const *id;
172 1.1 augustss char devinfo[1024];
173 1.5 dsainty usb_endpoint_descriptor_t const *ed;
174 1.1 augustss u_int8_t epcount;
175 1.1 augustss int i;
176 1.1 augustss
177 1.1 augustss DPRINTFN(10,("ubt_attach: sc=%p\n", sc));
178 1.1 augustss
179 1.1 augustss usbd_devinfo(dev, 0, devinfo);
180 1.1 augustss USB_ATTACH_SETUP;
181 1.1 augustss printf("%s: %s\n", USBDEVNAME(sc->sc_dev), devinfo);
182 1.1 augustss
183 1.1 augustss sc->sc_udev = dev;
184 1.3 augustss sc->sc_ctl_iface = iface;
185 1.1 augustss
186 1.5 dsainty /*
187 1.3 augustss * The control interface comes before the isoc interface
188 1.3 augustss * according to the spec, so we find it first.
189 1.3 augustss */
190 1.1 augustss epcount = 0;
191 1.1 augustss (void)usbd_endpoint_count(iface, &epcount);
192 1.5 dsainty
193 1.5 dsainty sc->sc_evt_addr = -1;
194 1.5 dsainty sc->sc_aclrd_addr = -1;
195 1.5 dsainty sc->sc_aclwr_addr = -1;
196 1.5 dsainty
197 1.1 augustss for (i = 0; i < epcount; i++) {
198 1.1 augustss ed = usbd_interface2endpoint_descriptor(iface, i);
199 1.1 augustss if (ed == NULL) {
200 1.1 augustss printf("%s: couldn't get ep %d\n",
201 1.1 augustss USBDEVNAME(sc->sc_dev), i);
202 1.1 augustss USB_ATTACH_ERROR_RETURN;
203 1.1 augustss }
204 1.5 dsainty
205 1.5 dsainty DPRINTFN(10, ("%s: addr=%d attr=%d\n", __func__,
206 1.5 dsainty (int)ed->bEndpointAddress,
207 1.5 dsainty (int)ed->bmAttributes));
208 1.5 dsainty
209 1.1 augustss if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
210 1.5 dsainty UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
211 1.5 dsainty sc->sc_evt_addr = ed->bEndpointAddress;
212 1.5 dsainty } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
213 1.5 dsainty UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
214 1.5 dsainty sc->sc_aclrd_addr = ed->bEndpointAddress;
215 1.1 augustss } else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
216 1.1 augustss UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
217 1.5 dsainty sc->sc_aclwr_addr = ed->bEndpointAddress;
218 1.1 augustss }
219 1.1 augustss }
220 1.5 dsainty
221 1.5 dsainty if (sc->sc_evt_addr == -1 ||
222 1.5 dsainty sc->sc_aclrd_addr == -1 || sc->sc_aclwr_addr == -1) {
223 1.1 augustss printf("%s: missing endpoint\n", USBDEVNAME(sc->sc_dev));
224 1.1 augustss USB_ATTACH_ERROR_RETURN;
225 1.1 augustss }
226 1.1 augustss
227 1.3 augustss /* XXX works because isoc comes after ctl */
228 1.3 augustss /* Grab isoc interface as well. */
229 1.3 augustss for (i = 0; i < uaa->nifaces; i++) {
230 1.3 augustss if (uaa->ifaces[i] == NULL)
231 1.3 augustss continue;
232 1.3 augustss id = usbd_get_interface_descriptor(uaa->ifaces[i]);
233 1.3 augustss if (id != NULL &&
234 1.3 augustss id->bInterfaceClass == UICLASS_WIRELESS &&
235 1.3 augustss id->bInterfaceSubClass == UISUBCLASS_RF &&
236 1.3 augustss id->bInterfaceProtocol == UIPROTO_BLUETOOTH) {
237 1.3 augustss sc->sc_isoc_iface = uaa->ifaces[i];
238 1.3 augustss uaa->ifaces[i] = NULL;
239 1.3 augustss }
240 1.3 augustss }
241 1.3 augustss
242 1.3 augustss printf("%s: has%s isoc data\n", USBDEVNAME(sc->sc_dev),
243 1.3 augustss sc->sc_isoc_iface != NULL ? "" : " no");
244 1.3 augustss
245 1.1 augustss usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_udev,
246 1.1 augustss USBDEV(sc->sc_dev));
247 1.1 augustss
248 1.5 dsainty bt.bt_methods = &ubt_methods;
249 1.5 dsainty bt.bt_cb = &sc->sc_cb;
250 1.8 dsainty bt.bt_handle = sc;
251 1.5 dsainty
252 1.3 augustss sc->sc_child = config_found(self, &bt, bt_print);
253 1.1 augustss
254 1.1 augustss USB_ATTACH_SUCCESS_RETURN;
255 1.1 augustss }
256 1.1 augustss
257 1.5 dsainty static void
258 1.5 dsainty ubt_abortdealloc(struct ubt_softc *sc)
259 1.5 dsainty {
260 1.5 dsainty DPRINTFN(0, ("%s: sc=%p\n", __func__, sc));
261 1.5 dsainty
262 1.5 dsainty if (sc->sc_evt_pipe != NULL) {
263 1.5 dsainty usbd_abort_pipe(sc->sc_evt_pipe);
264 1.5 dsainty usbd_close_pipe(sc->sc_evt_pipe);
265 1.5 dsainty sc->sc_evt_pipe = NULL;
266 1.5 dsainty }
267 1.5 dsainty if (sc->sc_evt_buf != NULL) {
268 1.5 dsainty free(sc->sc_evt_buf, M_USBDEV);
269 1.5 dsainty sc->sc_evt_buf = NULL;
270 1.5 dsainty }
271 1.5 dsainty if (sc->sc_aclrd_pipe != NULL) {
272 1.5 dsainty usbd_abort_pipe(sc->sc_aclrd_pipe);
273 1.5 dsainty usbd_close_pipe(sc->sc_aclrd_pipe);
274 1.5 dsainty sc->sc_aclrd_pipe = NULL;
275 1.5 dsainty }
276 1.5 dsainty if (sc->sc_aclwr_pipe != NULL) {
277 1.5 dsainty usbd_abort_pipe(sc->sc_aclwr_pipe);
278 1.5 dsainty usbd_close_pipe(sc->sc_aclwr_pipe);
279 1.5 dsainty sc->sc_aclwr_pipe = NULL;
280 1.5 dsainty }
281 1.5 dsainty if (sc->sc_aclrd_xfer != NULL) {
282 1.5 dsainty usbd_free_xfer(sc->sc_aclrd_xfer);
283 1.5 dsainty sc->sc_aclrd_xfer = NULL;
284 1.5 dsainty sc->sc_aclrd_buf = NULL;
285 1.5 dsainty }
286 1.5 dsainty if (sc->sc_aclwr_xfer != NULL) {
287 1.5 dsainty usbd_free_xfer(sc->sc_aclwr_xfer);
288 1.5 dsainty sc->sc_aclwr_xfer = NULL;
289 1.5 dsainty sc->sc_aclwr_buf = NULL;
290 1.5 dsainty }
291 1.5 dsainty }
292 1.5 dsainty
293 1.1 augustss USB_DETACH(ubt)
294 1.1 augustss {
295 1.1 augustss USB_DETACH_START(ubt, sc);
296 1.1 augustss int s;
297 1.1 augustss int rv = 0;
298 1.1 augustss
299 1.5 dsainty DPRINTF(("%s: sc=%p flags=%d\n", __func__, sc, flags));
300 1.1 augustss
301 1.1 augustss sc->sc_dying = 1;
302 1.5 dsainty
303 1.1 augustss /* Abort all pipes. Causes processes waiting for transfer to wake. */
304 1.5 dsainty ubt_abortdealloc(sc);
305 1.1 augustss
306 1.5 dsainty DPRINTFN(1, ("%s: waiting for USB detach\n", __func__));
307 1.1 augustss s = splusb();
308 1.1 augustss if (--sc->sc_refcnt >= 0) {
309 1.1 augustss /* Wait for processes to go away. */
310 1.1 augustss usb_detach_wait(USBDEV(sc->sc_dev));
311 1.1 augustss }
312 1.1 augustss splx(s);
313 1.5 dsainty DPRINTFN(1, ("%s: USB detach complete\n", __func__));
314 1.1 augustss
315 1.1 augustss if (sc->sc_child != NULL) {
316 1.5 dsainty DPRINTFN(1, ("%s: waiting for child detach\n", __func__));
317 1.1 augustss rv = config_detach(sc->sc_child, flags);
318 1.1 augustss sc->sc_child = NULL;
319 1.5 dsainty DPRINTFN(1, ("%s: child detach complete\n", __func__));
320 1.1 augustss }
321 1.1 augustss
322 1.1 augustss usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_udev,
323 1.1 augustss USBDEV(sc->sc_dev));
324 1.1 augustss
325 1.5 dsainty DPRINTFN(1, ("%s: driver detached\n", __func__));
326 1.5 dsainty
327 1.1 augustss return (rv);
328 1.1 augustss }
329 1.1 augustss
330 1.1 augustss int
331 1.1 augustss ubt_activate(device_ptr_t self, enum devact act)
332 1.1 augustss {
333 1.1 augustss struct ubt_softc *sc = (struct ubt_softc *)self;
334 1.1 augustss int error = 0;
335 1.1 augustss
336 1.1 augustss switch (act) {
337 1.1 augustss case DVACT_ACTIVATE:
338 1.1 augustss return (EOPNOTSUPP);
339 1.1 augustss break;
340 1.1 augustss
341 1.1 augustss case DVACT_DEACTIVATE:
342 1.1 augustss sc->sc_dying = 1;
343 1.1 augustss if (sc->sc_child != NULL)
344 1.1 augustss error = config_deactivate(sc->sc_child);
345 1.1 augustss break;
346 1.1 augustss }
347 1.1 augustss return (error);
348 1.5 dsainty }
349 1.5 dsainty
350 1.5 dsainty static int
351 1.5 dsainty ubt_open(void *h, int flag, int mode, usb_proc_ptr p)
352 1.5 dsainty {
353 1.5 dsainty struct ubt_softc *sc = h;
354 1.5 dsainty int error;
355 1.5 dsainty usbd_status err;
356 1.5 dsainty
357 1.5 dsainty DPRINTFN(0, ("%s: sc=%p\n", __func__, sc));
358 1.5 dsainty
359 1.5 dsainty sc->sc_evt_buf = malloc(BTHCI_EVENT_MAX_LEN, M_USBDEV, M_NOWAIT);
360 1.5 dsainty if (sc->sc_evt_buf == NULL) {
361 1.5 dsainty error = ENOMEM;
362 1.5 dsainty goto bad0;
363 1.5 dsainty }
364 1.5 dsainty
365 1.5 dsainty err = usbd_open_pipe_intr(sc->sc_ctl_iface, sc->sc_evt_addr,
366 1.5 dsainty USBD_SHORT_XFER_OK, &sc->sc_evt_pipe,
367 1.5 dsainty sc, sc->sc_evt_buf, BTHCI_EVENT_MAX_LEN,
368 1.5 dsainty ubt_event_cb, UBT_EVENT_EP_INTERVAL);
369 1.5 dsainty if (err != USBD_NORMAL_COMPLETION) {
370 1.5 dsainty error = EIO;
371 1.5 dsainty goto bad1;
372 1.5 dsainty }
373 1.5 dsainty
374 1.5 dsainty err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_aclrd_addr,
375 1.5 dsainty 0, &sc->sc_aclrd_pipe);
376 1.5 dsainty if (err != USBD_NORMAL_COMPLETION) {
377 1.5 dsainty error = EIO;
378 1.5 dsainty goto bad2;
379 1.5 dsainty }
380 1.5 dsainty
381 1.5 dsainty err = usbd_open_pipe(sc->sc_ctl_iface, sc->sc_aclwr_addr,
382 1.5 dsainty 0, &sc->sc_aclwr_pipe);
383 1.5 dsainty if (err != USBD_NORMAL_COMPLETION) {
384 1.5 dsainty error = EIO;
385 1.5 dsainty goto bad3;
386 1.5 dsainty }
387 1.5 dsainty
388 1.5 dsainty sc->sc_ctl_xfer = usbd_alloc_xfer(sc->sc_udev);
389 1.5 dsainty if (sc->sc_ctl_xfer == NULL) {
390 1.5 dsainty error = ENOMEM;
391 1.5 dsainty goto bad4;
392 1.5 dsainty }
393 1.5 dsainty sc->sc_aclrd_xfer = usbd_alloc_xfer(sc->sc_udev);
394 1.5 dsainty if (sc->sc_aclrd_xfer == NULL) {
395 1.5 dsainty error = ENOMEM;
396 1.5 dsainty goto bad5;
397 1.5 dsainty }
398 1.5 dsainty sc->sc_aclwr_xfer = usbd_alloc_xfer(sc->sc_udev);
399 1.5 dsainty if (sc->sc_aclwr_xfer == NULL) {
400 1.5 dsainty error = ENOMEM;
401 1.5 dsainty goto bad6;
402 1.5 dsainty }
403 1.5 dsainty
404 1.5 dsainty /* Buffers */
405 1.5 dsainty sc->sc_ctl_buf = usbd_alloc_buffer(sc->sc_ctl_xfer,
406 1.5 dsainty BTHCI_COMMAND_MAX_LEN);
407 1.5 dsainty if (sc->sc_ctl_buf == NULL) {
408 1.5 dsainty error = ENOMEM;
409 1.5 dsainty goto bad7;
410 1.5 dsainty }
411 1.5 dsainty sc->sc_aclrd_buf = usbd_alloc_buffer(sc->sc_aclrd_xfer,
412 1.5 dsainty BTHCI_ACL_DATA_MAX_LEN);
413 1.5 dsainty if (sc->sc_aclrd_buf == NULL) {
414 1.5 dsainty error = ENOMEM;
415 1.5 dsainty goto bad7;
416 1.5 dsainty }
417 1.5 dsainty sc->sc_aclwr_buf = usbd_alloc_buffer(sc->sc_aclwr_xfer,
418 1.5 dsainty BTHCI_ACL_DATA_MAX_LEN);
419 1.5 dsainty if (sc->sc_aclwr_buf == NULL) {
420 1.5 dsainty error = ENOMEM;
421 1.5 dsainty goto bad7;
422 1.5 dsainty }
423 1.5 dsainty
424 1.5 dsainty /* Start reading */
425 1.5 dsainty ubt_aclrd_request(sc);
426 1.5 dsainty
427 1.5 dsainty return 0;
428 1.5 dsainty
429 1.5 dsainty bad7:
430 1.5 dsainty usbd_free_xfer(sc->sc_aclwr_xfer);
431 1.5 dsainty sc->sc_aclwr_xfer = NULL;
432 1.5 dsainty bad6:
433 1.5 dsainty usbd_free_xfer(sc->sc_aclrd_xfer);
434 1.5 dsainty sc->sc_aclrd_xfer = NULL;
435 1.5 dsainty bad5:
436 1.5 dsainty usbd_free_xfer(sc->sc_ctl_xfer);
437 1.5 dsainty sc->sc_ctl_xfer = NULL;
438 1.5 dsainty bad4:
439 1.5 dsainty usbd_close_pipe(sc->sc_aclwr_pipe);
440 1.5 dsainty sc->sc_aclwr_pipe = NULL;
441 1.5 dsainty bad3:
442 1.5 dsainty usbd_close_pipe(sc->sc_aclrd_pipe);
443 1.5 dsainty sc->sc_aclrd_pipe = NULL;
444 1.5 dsainty bad2:
445 1.5 dsainty usbd_close_pipe(sc->sc_evt_pipe);
446 1.5 dsainty sc->sc_evt_pipe = NULL;
447 1.5 dsainty bad1:
448 1.5 dsainty free(sc->sc_evt_buf, M_USBDEV);
449 1.5 dsainty sc->sc_evt_buf = NULL;
450 1.5 dsainty bad0:
451 1.5 dsainty return error;
452 1.5 dsainty }
453 1.5 dsainty
454 1.5 dsainty static int
455 1.5 dsainty ubt_close(void *h, int flag, int mode, usb_proc_ptr p)
456 1.5 dsainty {
457 1.5 dsainty struct ubt_softc *sc = h;
458 1.5 dsainty
459 1.5 dsainty DPRINTFN(0, ("%s: sc=%p\n", __func__, sc));
460 1.5 dsainty
461 1.5 dsainty ubt_abortdealloc(sc);
462 1.5 dsainty
463 1.5 dsainty return 0;
464 1.5 dsainty }
465 1.5 dsainty
466 1.6 dsainty static u_int8_t*
467 1.6 dsainty ubt_alloc_control(void *h, size_t len, struct btframe_buffer **buf)
468 1.6 dsainty {
469 1.6 dsainty struct ubt_softc *sc = h;
470 1.6 dsainty
471 1.6 dsainty /*
472 1.6 dsainty * We should be catching this earlier, but at the moment a
473 1.6 dsainty * user request can generate oversized allocations.
474 1.6 dsainty */
475 1.6 dsainty if (len > BTHCI_COMMAND_MAX_LEN)
476 1.6 dsainty return NULL;
477 1.6 dsainty
478 1.6 dsainty *buf = (struct btframe_buffer*)sc->sc_ctl_buf;
479 1.6 dsainty return sc->sc_ctl_buf;
480 1.6 dsainty }
481 1.6 dsainty
482 1.5 dsainty static int
483 1.6 dsainty ubt_send_control(void *h, struct btframe_buffer *buf, size_t len)
484 1.5 dsainty {
485 1.5 dsainty struct ubt_softc *sc = h;
486 1.5 dsainty usb_device_request_t req;
487 1.5 dsainty usbd_status status;
488 1.5 dsainty
489 1.5 dsainty DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
490 1.5 dsainty
491 1.6 dsainty #ifdef DIAGNOSTIC
492 1.6 dsainty if ((u_int8_t*)buf != sc->sc_ctl_buf)
493 1.6 dsainty panic("ubt_control() called with wrong buffer");
494 1.6 dsainty #endif
495 1.6 dsainty
496 1.5 dsainty if (sc->sc_dying)
497 1.5 dsainty return EIO;
498 1.5 dsainty
499 1.5 dsainty if (len < BTHCI_COMMAND_MIN_LEN || len > BTHCI_COMMAND_MAX_LEN)
500 1.5 dsainty return EINVAL;
501 1.5 dsainty
502 1.5 dsainty sc->sc_refcnt++;
503 1.5 dsainty
504 1.5 dsainty memset(&req, 0, sizeof(req));
505 1.5 dsainty req.bmRequestType = UT_WRITE_CLASS_DEVICE;
506 1.5 dsainty USETW(req.wLength, len);
507 1.5 dsainty
508 1.5 dsainty usbd_setup_default_xfer(sc->sc_ctl_xfer,
509 1.5 dsainty sc->sc_udev,
510 1.5 dsainty sc,
511 1.5 dsainty USBD_DEFAULT_TIMEOUT,
512 1.5 dsainty &req, sc->sc_ctl_buf, len,
513 1.5 dsainty USBD_SYNCHRONOUS | USBD_NO_COPY, NULL);
514 1.5 dsainty
515 1.5 dsainty status = usbd_transfer(sc->sc_ctl_xfer);
516 1.5 dsainty
517 1.5 dsainty if (--sc->sc_refcnt < 0)
518 1.5 dsainty usb_detach_wakeup(USBDEV(sc->sc_dev));
519 1.5 dsainty
520 1.5 dsainty if (status != USBD_NORMAL_COMPLETION)
521 1.5 dsainty return EIO;
522 1.5 dsainty
523 1.5 dsainty return 0;
524 1.5 dsainty }
525 1.5 dsainty
526 1.6 dsainty static u_int8_t*
527 1.6 dsainty ubt_alloc_acldata(void *h, size_t len, struct btframe_buffer **buf)
528 1.6 dsainty {
529 1.6 dsainty struct ubt_softc *sc = h;
530 1.6 dsainty
531 1.6 dsainty /*
532 1.6 dsainty * We should be catching this earlier, but at the moment a
533 1.6 dsainty * user request can generate oversized allocations.
534 1.6 dsainty */
535 1.6 dsainty if (len > BTHCI_ACL_DATA_MAX_LEN)
536 1.6 dsainty return NULL;
537 1.6 dsainty
538 1.6 dsainty *buf = (struct btframe_buffer*)sc->sc_aclwr_buf;
539 1.6 dsainty return sc->sc_aclwr_buf;
540 1.6 dsainty }
541 1.6 dsainty
542 1.5 dsainty static int
543 1.6 dsainty ubt_send_acldata(void *h, struct btframe_buffer *buf, size_t len)
544 1.5 dsainty {
545 1.5 dsainty struct ubt_softc *sc = h;
546 1.5 dsainty usbd_status status;
547 1.5 dsainty
548 1.5 dsainty DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
549 1.5 dsainty
550 1.6 dsainty #ifdef DIAGNOSTIC
551 1.6 dsainty if ((u_int8_t*)buf != sc->sc_aclwr_buf)
552 1.6 dsainty panic("ubt_sendacldata() called with wrong buffer");
553 1.6 dsainty #endif
554 1.6 dsainty
555 1.5 dsainty if (sc->sc_dying)
556 1.5 dsainty return EIO;
557 1.5 dsainty
558 1.5 dsainty if (len < BTHCI_ACL_DATA_MIN_LEN || len > BTHCI_ACL_DATA_MAX_LEN)
559 1.5 dsainty return EINVAL;
560 1.5 dsainty
561 1.5 dsainty sc->sc_refcnt++;
562 1.5 dsainty
563 1.5 dsainty usbd_setup_xfer(sc->sc_aclwr_xfer,
564 1.5 dsainty sc->sc_aclwr_pipe,
565 1.5 dsainty (usbd_private_handle)sc,
566 1.5 dsainty sc->sc_aclwr_buf, len,
567 1.5 dsainty USBD_SYNCHRONOUS | USBD_NO_COPY,
568 1.5 dsainty USBD_DEFAULT_TIMEOUT,
569 1.5 dsainty NULL);
570 1.5 dsainty
571 1.5 dsainty status = usbd_transfer(sc->sc_aclwr_xfer);
572 1.5 dsainty
573 1.5 dsainty if (--sc->sc_refcnt < 0)
574 1.5 dsainty usb_detach_wakeup(USBDEV(sc->sc_dev));
575 1.5 dsainty
576 1.5 dsainty if (status != USBD_NORMAL_COMPLETION)
577 1.5 dsainty return EIO;
578 1.5 dsainty
579 1.5 dsainty return 0;
580 1.5 dsainty }
581 1.5 dsainty
582 1.6 dsainty static u_int8_t*
583 1.6 dsainty ubt_alloc_scodata(void *h, size_t len, struct btframe_buffer **buf)
584 1.6 dsainty {
585 1.6 dsainty return NULL;
586 1.6 dsainty }
587 1.6 dsainty
588 1.5 dsainty static int
589 1.6 dsainty ubt_send_scodata(void *h, struct btframe_buffer *buf, size_t len)
590 1.5 dsainty {
591 1.5 dsainty struct ubt_softc *sc = h;
592 1.5 dsainty
593 1.5 dsainty DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
594 1.5 dsainty
595 1.5 dsainty if (sc->sc_dying)
596 1.5 dsainty return EIO;
597 1.5 dsainty
598 1.5 dsainty return ENXIO;
599 1.5 dsainty }
600 1.5 dsainty
601 1.5 dsainty static void
602 1.5 dsainty ubt_event_cb(usbd_xfer_handle xfer, usbd_private_handle h, usbd_status status)
603 1.5 dsainty {
604 1.5 dsainty struct ubt_softc *sc = h;
605 1.5 dsainty void *buf;
606 1.5 dsainty u_int32_t size;
607 1.5 dsainty
608 1.5 dsainty DPRINTFN(1,("%s: sc=%p status=%s\n", __func__, sc,
609 1.5 dsainty usbd_errstr(status)));
610 1.5 dsainty
611 1.5 dsainty if (status != USBD_NORMAL_COMPLETION || sc->sc_dying ||
612 1.5 dsainty sc->sc_child == NULL)
613 1.5 dsainty return;
614 1.5 dsainty
615 1.5 dsainty usbd_get_xfer_status(xfer, NULL, &buf, &size, NULL);
616 1.5 dsainty
617 1.5 dsainty sc->sc_cb->bt_recveventdata(sc->sc_child, buf, (size_t)size);
618 1.5 dsainty }
619 1.5 dsainty
620 1.5 dsainty static void
621 1.5 dsainty ubt_aclrd_request(struct ubt_softc *sc)
622 1.5 dsainty {
623 1.5 dsainty usbd_status status;
624 1.5 dsainty int s;
625 1.5 dsainty
626 1.5 dsainty DPRINTFN(1,("%s: sc=%p\n", __func__, sc));
627 1.5 dsainty
628 1.5 dsainty if (sc->sc_dying)
629 1.5 dsainty return;
630 1.5 dsainty
631 1.5 dsainty s = splusb();
632 1.5 dsainty if (sc->sc_aclrd_running) {
633 1.5 dsainty splx(s);
634 1.5 dsainty return;
635 1.5 dsainty }
636 1.5 dsainty sc->sc_aclrd_running = 1;
637 1.5 dsainty splx(s);
638 1.6 dsainty
639 1.5 dsainty usbd_setup_xfer(sc->sc_aclrd_xfer, sc->sc_aclrd_pipe,
640 1.5 dsainty sc, sc->sc_aclrd_buf, BTHCI_ACL_DATA_MAX_LEN,
641 1.5 dsainty USBD_SHORT_XFER_OK | USBD_NO_COPY,
642 1.5 dsainty USBD_NO_TIMEOUT, ubt_aclrd_cb);
643 1.5 dsainty
644 1.5 dsainty status = usbd_transfer(sc->sc_aclrd_xfer);
645 1.5 dsainty if (status == USBD_IN_PROGRESS || USBD_CANCELLED)
646 1.5 dsainty return;
647 1.5 dsainty
648 1.5 dsainty DPRINTFN(1,("%s: read request failed: %s\n", __func__,
649 1.5 dsainty usbd_errstr(status)));
650 1.5 dsainty
651 1.5 dsainty sc->sc_aclrd_running = 0;
652 1.5 dsainty sc->sc_blocked |= BT_CBBLOCK_ACL_DATA;
653 1.5 dsainty }
654 1.5 dsainty
655 1.5 dsainty static void
656 1.5 dsainty ubt_aclrd_cb(usbd_xfer_handle xfer, usbd_private_handle h, usbd_status status)
657 1.5 dsainty {
658 1.5 dsainty struct ubt_softc *sc = h;
659 1.5 dsainty void *buf;
660 1.5 dsainty u_int32_t size;
661 1.5 dsainty
662 1.5 dsainty DPRINTFN(1,("%s: sc=%p status=%s\n", __func__, sc,
663 1.5 dsainty usbd_errstr(status)));
664 1.5 dsainty
665 1.5 dsainty sc->sc_aclrd_running = 0;
666 1.5 dsainty
667 1.5 dsainty if (status != USBD_NORMAL_COMPLETION || sc->sc_dying ||
668 1.5 dsainty sc->sc_child == NULL)
669 1.5 dsainty return;
670 1.5 dsainty
671 1.5 dsainty usbd_get_xfer_status(xfer, NULL, &buf, &size, NULL);
672 1.5 dsainty
673 1.5 dsainty sc->sc_cb->bt_recvacldata(sc->sc_child, buf, (size_t)size);
674 1.5 dsainty
675 1.5 dsainty /* Re-issue the request if not blocked */
676 1.5 dsainty if (!sc->sc_dying && !(sc->sc_blocked & BT_CBBLOCK_ACL_DATA))
677 1.5 dsainty ubt_aclrd_request(sc);
678 1.5 dsainty }
679 1.5 dsainty
680 1.5 dsainty static unsigned int
681 1.5 dsainty ubt_blockcb(void *h, unsigned int cbblocks)
682 1.5 dsainty {
683 1.5 dsainty struct ubt_softc *sc = h;
684 1.5 dsainty
685 1.5 dsainty sc->sc_blocked |= (cbblocks & BT_CBBLOCK_ACL_DATA);
686 1.5 dsainty
687 1.5 dsainty return sc->sc_blocked;
688 1.5 dsainty }
689 1.5 dsainty
690 1.5 dsainty static unsigned int
691 1.5 dsainty ubt_unblockcb(void *h, unsigned int cbblocks)
692 1.5 dsainty {
693 1.5 dsainty struct ubt_softc *sc = h;
694 1.5 dsainty unsigned int oblocks, changes;
695 1.5 dsainty
696 1.5 dsainty oblocks = sc->sc_blocked;
697 1.5 dsainty sc->sc_blocked = oblocks & ~cbblocks;
698 1.5 dsainty
699 1.5 dsainty changes = oblocks & cbblocks;
700 1.5 dsainty
701 1.5 dsainty if (changes & BT_CBBLOCK_ACL_DATA)
702 1.5 dsainty /* Re-issue the request if action un-blocked reads */
703 1.5 dsainty ubt_aclrd_request(sc);
704 1.5 dsainty
705 1.5 dsainty return sc->sc_blocked;
706 1.5 dsainty }
707 1.5 dsainty
708 1.5 dsainty static int
709 1.5 dsainty ubt_splraise(void)
710 1.5 dsainty {
711 1.5 dsainty return splusb();
712 1.1 augustss }
713