usbdi.c revision 1.55 1 1.55 augustss /* $NetBSD: usbdi.c,v 1.55 2000/01/16 13:22:18 augustss Exp $ */
2 1.51 augustss /* $FreeBSD: src/sys/dev/usb/usbdi.c,v 1.28 1999/11/17 22:33:49 n_hibma Exp $ */
3 1.1 augustss
4 1.1 augustss /*
5 1.1 augustss * Copyright (c) 1998 The NetBSD Foundation, Inc.
6 1.1 augustss * All rights reserved.
7 1.1 augustss *
8 1.11 augustss * This code is derived from software contributed to The NetBSD Foundation
9 1.11 augustss * by Lennart Augustsson (augustss (at) carlstedt.se) at
10 1.11 augustss * Carlstedt Research & Technology.
11 1.1 augustss *
12 1.1 augustss * Redistribution and use in source and binary forms, with or without
13 1.1 augustss * modification, are permitted provided that the following conditions
14 1.1 augustss * are met:
15 1.1 augustss * 1. Redistributions of source code must retain the above copyright
16 1.1 augustss * notice, this list of conditions and the following disclaimer.
17 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
18 1.1 augustss * notice, this list of conditions and the following disclaimer in the
19 1.1 augustss * documentation and/or other materials provided with the distribution.
20 1.1 augustss * 3. All advertising materials mentioning features or use of this software
21 1.1 augustss * must display the following acknowledgement:
22 1.1 augustss * This product includes software developed by the NetBSD
23 1.1 augustss * Foundation, Inc. and its contributors.
24 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
25 1.1 augustss * contributors may be used to endorse or promote products derived
26 1.1 augustss * from this software without specific prior written permission.
27 1.1 augustss *
28 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
29 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
30 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
31 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
32 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
33 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
34 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
35 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
36 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
37 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
38 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
39 1.1 augustss */
40 1.1 augustss
41 1.1 augustss #include <sys/param.h>
42 1.1 augustss #include <sys/systm.h>
43 1.51 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
44 1.1 augustss #include <sys/kernel.h>
45 1.15 augustss #include <sys/device.h>
46 1.45 augustss #elif defined(__FreeBSD__)
47 1.15 augustss #include <sys/module.h>
48 1.15 augustss #include <sys/bus.h>
49 1.15 augustss #include <sys/conf.h>
50 1.45 augustss #include "usb_if.h"
51 1.51 augustss #if defined(DIAGNOSTIC) && defined(__i386__)
52 1.51 augustss #include <machine/cpu.h>
53 1.51 augustss #endif
54 1.15 augustss #endif
55 1.1 augustss #include <sys/malloc.h>
56 1.1 augustss #include <sys/proc.h>
57 1.1 augustss
58 1.36 augustss #include <machine/bus.h>
59 1.36 augustss
60 1.1 augustss #include <dev/usb/usb.h>
61 1.1 augustss #include <dev/usb/usbdi.h>
62 1.1 augustss #include <dev/usb/usbdi_util.h>
63 1.1 augustss #include <dev/usb/usbdivar.h>
64 1.36 augustss #include <dev/usb/usb_mem.h>
65 1.1 augustss
66 1.51 augustss #if defined(__FreeBSD__)
67 1.51 augustss #include "usb_if.h"
68 1.51 augustss #endif
69 1.51 augustss
70 1.1 augustss #ifdef USB_DEBUG
71 1.27 augustss #define DPRINTF(x) if (usbdebug) logprintf x
72 1.27 augustss #define DPRINTFN(n,x) if (usbdebug>(n)) logprintf x
73 1.1 augustss extern int usbdebug;
74 1.1 augustss #else
75 1.1 augustss #define DPRINTF(x)
76 1.1 augustss #define DPRINTFN(n,x)
77 1.1 augustss #endif
78 1.1 augustss
79 1.1 augustss static usbd_status usbd_ar_pipe __P((usbd_pipe_handle pipe));
80 1.48 augustss static void usbd_do_request_async_cb
81 1.48 augustss __P((usbd_xfer_handle, usbd_private_handle, usbd_status));
82 1.48 augustss static void usbd_start_next __P((usbd_pipe_handle pipe));
83 1.1 augustss
84 1.50 augustss static SIMPLEQ_HEAD(, usbd_xfer) usbd_free_xfers =
85 1.50 augustss SIMPLEQ_HEAD_INITIALIZER(usbd_free_xfers);
86 1.1 augustss
87 1.45 augustss static int usbd_nbuses = 0;
88 1.45 augustss
89 1.45 augustss void
90 1.45 augustss usbd_init()
91 1.45 augustss {
92 1.45 augustss usbd_nbuses++;
93 1.45 augustss }
94 1.45 augustss
95 1.45 augustss void
96 1.45 augustss usbd_finish()
97 1.45 augustss {
98 1.48 augustss usbd_xfer_handle xfer;
99 1.15 augustss
100 1.45 augustss if (--usbd_nbuses == 0) {
101 1.50 augustss /* Last controller is gone, free all xfers. */
102 1.45 augustss for (;;) {
103 1.50 augustss xfer = SIMPLEQ_FIRST(&usbd_free_xfers);
104 1.48 augustss if (xfer == NULL)
105 1.45 augustss break;
106 1.50 augustss SIMPLEQ_REMOVE_HEAD(&usbd_free_xfers, xfer, next);
107 1.48 augustss free(xfer, M_USB);
108 1.45 augustss }
109 1.45 augustss }
110 1.45 augustss }
111 1.15 augustss
112 1.48 augustss static __inline int usbd_xfer_isread __P((usbd_xfer_handle xfer));
113 1.37 augustss static __inline int
114 1.48 augustss usbd_xfer_isread(xfer)
115 1.48 augustss usbd_xfer_handle xfer;
116 1.37 augustss {
117 1.48 augustss if (xfer->rqflags & URQ_REQUEST)
118 1.48 augustss return (xfer->request.bmRequestType & UT_READ);
119 1.37 augustss else
120 1.48 augustss return (xfer->pipe->endpoint->edesc->bEndpointAddress &
121 1.37 augustss UE_DIR_IN);
122 1.37 augustss }
123 1.37 augustss
124 1.28 augustss #ifdef USB_DEBUG
125 1.28 augustss void usbd_dump_queue __P((usbd_pipe_handle));
126 1.28 augustss
127 1.28 augustss void
128 1.28 augustss usbd_dump_queue(pipe)
129 1.28 augustss usbd_pipe_handle pipe;
130 1.28 augustss {
131 1.48 augustss usbd_xfer_handle xfer;
132 1.28 augustss
133 1.28 augustss printf("usbd_dump_queue: pipe=%p\n", pipe);
134 1.48 augustss for (xfer = SIMPLEQ_FIRST(&pipe->queue);
135 1.48 augustss xfer;
136 1.48 augustss xfer = SIMPLEQ_NEXT(xfer, next)) {
137 1.48 augustss printf(" xfer=%p\n", xfer);
138 1.28 augustss }
139 1.28 augustss }
140 1.28 augustss #endif
141 1.28 augustss
142 1.1 augustss usbd_status
143 1.1 augustss usbd_open_pipe(iface, address, flags, pipe)
144 1.1 augustss usbd_interface_handle iface;
145 1.1 augustss u_int8_t address;
146 1.1 augustss u_int8_t flags;
147 1.1 augustss usbd_pipe_handle *pipe;
148 1.1 augustss {
149 1.1 augustss usbd_pipe_handle p;
150 1.1 augustss struct usbd_endpoint *ep;
151 1.48 augustss usbd_status err;
152 1.12 augustss int i;
153 1.1 augustss
154 1.53 augustss DPRINTFN(3,("usbd_open_pipe: address=0x%x flags=0x%x\n", address,
155 1.53 augustss flags));
156 1.53 augustss
157 1.1 augustss for (i = 0; i < iface->idesc->bNumEndpoints; i++) {
158 1.1 augustss ep = &iface->endpoints[i];
159 1.49 augustss if (ep->edesc == NULL)
160 1.49 augustss return (USBD_IOERROR);
161 1.1 augustss if (ep->edesc->bEndpointAddress == address)
162 1.1 augustss goto found;
163 1.1 augustss }
164 1.1 augustss return (USBD_BAD_ADDRESS);
165 1.1 augustss found:
166 1.1 augustss if ((flags & USBD_EXCLUSIVE_USE) &&
167 1.1 augustss ep->refcnt != 0)
168 1.1 augustss return (USBD_IN_USE);
169 1.48 augustss err = usbd_setup_pipe(iface->device, iface, ep, &p);
170 1.48 augustss if (err)
171 1.48 augustss return (err);
172 1.1 augustss LIST_INSERT_HEAD(&iface->pipes, p, next);
173 1.1 augustss *pipe = p;
174 1.1 augustss return (USBD_NORMAL_COMPLETION);
175 1.1 augustss }
176 1.1 augustss
177 1.1 augustss usbd_status
178 1.1 augustss usbd_open_pipe_intr(iface, address, flags, pipe, priv, buffer, length, cb)
179 1.1 augustss usbd_interface_handle iface;
180 1.1 augustss u_int8_t address;
181 1.1 augustss u_int8_t flags;
182 1.1 augustss usbd_pipe_handle *pipe;
183 1.1 augustss usbd_private_handle priv;
184 1.1 augustss void *buffer;
185 1.1 augustss u_int32_t length;
186 1.1 augustss usbd_callback cb;
187 1.1 augustss {
188 1.48 augustss usbd_status err;
189 1.48 augustss usbd_xfer_handle xfer;
190 1.1 augustss usbd_pipe_handle ipipe;
191 1.1 augustss
192 1.53 augustss DPRINTFN(3,("usbd_open_pipe_intr: address=0x%x flags=0x%x length=%d\n",
193 1.53 augustss address, flags, length));
194 1.53 augustss
195 1.48 augustss err = usbd_open_pipe(iface, address, USBD_EXCLUSIVE_USE, &ipipe);
196 1.48 augustss if (err)
197 1.48 augustss return (err);
198 1.50 augustss xfer = usbd_alloc_xfer(iface->device);
199 1.48 augustss if (xfer == NULL) {
200 1.48 augustss err = USBD_NOMEM;
201 1.1 augustss goto bad1;
202 1.36 augustss }
203 1.50 augustss usbd_setup_xfer(xfer, ipipe, priv, buffer, length, flags,
204 1.37 augustss USBD_NO_TIMEOUT, cb);
205 1.48 augustss ipipe->intrxfer = xfer;
206 1.25 augustss ipipe->repeat = 1;
207 1.48 augustss err = usbd_transfer(xfer);
208 1.1 augustss *pipe = ipipe;
209 1.48 augustss if (err != USBD_IN_PROGRESS)
210 1.36 augustss goto bad2;
211 1.1 augustss return (USBD_NORMAL_COMPLETION);
212 1.1 augustss
213 1.36 augustss bad2:
214 1.48 augustss ipipe->intrxfer = NULL;
215 1.25 augustss ipipe->repeat = 0;
216 1.50 augustss usbd_free_xfer(xfer);
217 1.36 augustss bad1:
218 1.1 augustss usbd_close_pipe(ipipe);
219 1.48 augustss return (err);
220 1.9 augustss }
221 1.9 augustss
222 1.1 augustss usbd_status
223 1.1 augustss usbd_close_pipe(pipe)
224 1.1 augustss usbd_pipe_handle pipe;
225 1.1 augustss {
226 1.26 augustss #ifdef DIAGNOSTIC
227 1.48 augustss if (pipe == NULL) {
228 1.26 augustss printf("usbd_close_pipe: pipe==NULL\n");
229 1.26 augustss return (USBD_NORMAL_COMPLETION);
230 1.26 augustss }
231 1.26 augustss #endif
232 1.26 augustss
233 1.1 augustss if (--pipe->refcnt != 0)
234 1.1 augustss return (USBD_NORMAL_COMPLETION);
235 1.1 augustss if (SIMPLEQ_FIRST(&pipe->queue) != 0)
236 1.1 augustss return (USBD_PENDING_REQUESTS);
237 1.1 augustss LIST_REMOVE(pipe, next);
238 1.1 augustss pipe->endpoint->refcnt--;
239 1.1 augustss pipe->methods->close(pipe);
240 1.48 augustss if (pipe->intrxfer != NULL)
241 1.50 augustss usbd_free_xfer(pipe->intrxfer);
242 1.1 augustss free(pipe, M_USB);
243 1.1 augustss return (USBD_NORMAL_COMPLETION);
244 1.1 augustss }
245 1.1 augustss
246 1.31 augustss usbd_status
247 1.48 augustss usbd_transfer(xfer)
248 1.48 augustss usbd_xfer_handle xfer;
249 1.1 augustss {
250 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
251 1.48 augustss usb_dma_t *dmap = &xfer->dmabuf;
252 1.48 augustss usbd_status err;
253 1.37 augustss u_int size;
254 1.31 augustss int s;
255 1.16 augustss
256 1.48 augustss DPRINTFN(5,("usbd_transfer: xfer=%p, flags=%d, pipe=%p, running=%d\n",
257 1.48 augustss xfer, xfer->flags, pipe, pipe->running));
258 1.28 augustss #ifdef USB_DEBUG
259 1.28 augustss if (usbdebug > 5)
260 1.28 augustss usbd_dump_queue(pipe);
261 1.28 augustss #endif
262 1.48 augustss xfer->done = 0;
263 1.31 augustss
264 1.48 augustss size = xfer->length;
265 1.38 augustss /* If there is no buffer, allocate one. */
266 1.48 augustss if (!(xfer->rqflags & URQ_DEV_DMABUF) && size != 0) {
267 1.37 augustss struct usbd_bus *bus = pipe->device->bus;
268 1.37 augustss
269 1.37 augustss #ifdef DIAGNOSTIC
270 1.48 augustss if (xfer->rqflags & URQ_AUTO_DMABUF)
271 1.37 augustss printf("usbd_transfer: has old buffer!\n");
272 1.37 augustss #endif
273 1.48 augustss err = bus->methods->allocm(bus, dmap, size);
274 1.48 augustss if (err)
275 1.48 augustss return (err);
276 1.48 augustss xfer->rqflags |= URQ_AUTO_DMABUF;
277 1.38 augustss }
278 1.37 augustss
279 1.38 augustss /* Copy data if going out. */
280 1.48 augustss if (!(xfer->flags & USBD_NO_COPY) && size != 0 &&
281 1.48 augustss !usbd_xfer_isread(xfer))
282 1.48 augustss memcpy(KERNADDR(dmap), xfer->buffer, size);
283 1.37 augustss
284 1.48 augustss err = pipe->methods->transfer(xfer);
285 1.37 augustss
286 1.51 augustss if (err != USBD_IN_PROGRESS && err) {
287 1.37 augustss /* The transfer has not been queued, so free buffer. */
288 1.48 augustss if (xfer->rqflags & URQ_AUTO_DMABUF) {
289 1.37 augustss struct usbd_bus *bus = pipe->device->bus;
290 1.37 augustss
291 1.48 augustss bus->methods->freem(bus, &xfer->dmabuf);
292 1.48 augustss xfer->rqflags &= ~URQ_AUTO_DMABUF;
293 1.37 augustss }
294 1.37 augustss }
295 1.37 augustss
296 1.48 augustss if (!(xfer->flags & USBD_SYNCHRONOUS))
297 1.48 augustss return (err);
298 1.31 augustss
299 1.31 augustss /* Sync transfer, wait for completion. */
300 1.48 augustss if (err != USBD_IN_PROGRESS)
301 1.48 augustss return (err);
302 1.31 augustss s = splusb();
303 1.48 augustss if (!xfer->done) {
304 1.37 augustss if (pipe->device->bus->use_polling)
305 1.31 augustss panic("usbd_transfer: not done\n");
306 1.55 augustss /* XXX Temporary hack XXX */
307 1.55 augustss if (xfer->flags & USBD_NO_TSLEEP) {
308 1.55 augustss int i;
309 1.55 augustss usbd_bus_handle bus = pipe->device->bus;
310 1.55 augustss for (i = 0; i < xfer->timeout; i += 10) {
311 1.55 augustss delay(10);
312 1.55 augustss bus->methods->do_poll(bus);
313 1.55 augustss if (xfer->done)
314 1.55 augustss break;
315 1.55 augustss }
316 1.55 augustss if (!xfer->done)
317 1.55 augustss pipe->methods->abort(xfer);
318 1.55 augustss } else
319 1.55 augustss tsleep(xfer, PRIBIO, "usbsyn", 0);
320 1.31 augustss }
321 1.31 augustss splx(s);
322 1.48 augustss return (xfer->status);
323 1.31 augustss }
324 1.31 augustss
325 1.31 augustss /* Like usbd_transfer(), but waits for completion. */
326 1.31 augustss usbd_status
327 1.48 augustss usbd_sync_transfer(xfer)
328 1.48 augustss usbd_xfer_handle xfer;
329 1.31 augustss {
330 1.48 augustss xfer->flags |= USBD_SYNCHRONOUS;
331 1.48 augustss return (usbd_transfer(xfer));
332 1.16 augustss }
333 1.16 augustss
334 1.36 augustss void *
335 1.48 augustss usbd_alloc_buffer(xfer, size)
336 1.48 augustss usbd_xfer_handle xfer;
337 1.36 augustss u_int32_t size;
338 1.36 augustss {
339 1.48 augustss struct usbd_bus *bus = xfer->device->bus;
340 1.48 augustss usbd_status err;
341 1.37 augustss
342 1.48 augustss err = bus->methods->allocm(bus, &xfer->dmabuf, size);
343 1.48 augustss if (err)
344 1.36 augustss return (0);
345 1.48 augustss xfer->rqflags |= URQ_DEV_DMABUF;
346 1.48 augustss return (KERNADDR(&xfer->dmabuf));
347 1.36 augustss }
348 1.36 augustss
349 1.36 augustss void
350 1.48 augustss usbd_free_buffer(xfer)
351 1.48 augustss usbd_xfer_handle xfer;
352 1.36 augustss {
353 1.37 augustss #ifdef DIAGNOSTIC
354 1.48 augustss if (!(xfer->rqflags & (URQ_DEV_DMABUF | URQ_AUTO_DMABUF))) {
355 1.37 augustss printf("usbd_free_buffer: no buffer\n");
356 1.37 augustss return;
357 1.37 augustss }
358 1.37 augustss #endif
359 1.48 augustss xfer->rqflags &= ~(URQ_DEV_DMABUF | URQ_AUTO_DMABUF);
360 1.48 augustss xfer->device->bus->methods->freem(xfer->device->bus, &xfer->dmabuf);
361 1.36 augustss }
362 1.36 augustss
363 1.38 augustss void *
364 1.48 augustss usbd_get_buffer(xfer)
365 1.48 augustss usbd_xfer_handle xfer;
366 1.38 augustss {
367 1.48 augustss if (!(xfer->rqflags & URQ_DEV_DMABUF))
368 1.38 augustss return (0);
369 1.48 augustss return (KERNADDR(&xfer->dmabuf));
370 1.38 augustss }
371 1.38 augustss
372 1.48 augustss usbd_xfer_handle
373 1.50 augustss usbd_alloc_xfer(dev)
374 1.36 augustss usbd_device_handle dev;
375 1.1 augustss {
376 1.48 augustss usbd_xfer_handle xfer;
377 1.1 augustss
378 1.50 augustss xfer = SIMPLEQ_FIRST(&usbd_free_xfers);
379 1.48 augustss if (xfer != NULL)
380 1.50 augustss SIMPLEQ_REMOVE_HEAD(&usbd_free_xfers, xfer, next);
381 1.1 augustss else
382 1.48 augustss xfer = malloc(sizeof(*xfer), M_USB, M_NOWAIT);
383 1.48 augustss if (xfer == NULL)
384 1.1 augustss return (0);
385 1.48 augustss memset(xfer, 0, sizeof *xfer);
386 1.48 augustss xfer->device = dev;
387 1.50 augustss DPRINTFN(5,("usbd_alloc_xfer() = %p\n", xfer));
388 1.48 augustss return (xfer);
389 1.1 augustss }
390 1.1 augustss
391 1.1 augustss usbd_status
392 1.50 augustss usbd_free_xfer(xfer)
393 1.48 augustss usbd_xfer_handle xfer;
394 1.1 augustss {
395 1.50 augustss DPRINTFN(5,("usbd_free_xfer: %p\n", xfer));
396 1.48 augustss if (xfer->rqflags & (URQ_DEV_DMABUF | URQ_AUTO_DMABUF))
397 1.48 augustss usbd_free_buffer(xfer);
398 1.50 augustss SIMPLEQ_INSERT_HEAD(&usbd_free_xfers, xfer, next);
399 1.1 augustss return (USBD_NORMAL_COMPLETION);
400 1.1 augustss }
401 1.1 augustss
402 1.36 augustss void
403 1.50 augustss usbd_setup_xfer(xfer, pipe, priv, buffer, length, flags, timeout, callback)
404 1.48 augustss usbd_xfer_handle xfer;
405 1.1 augustss usbd_pipe_handle pipe;
406 1.1 augustss usbd_private_handle priv;
407 1.1 augustss void *buffer;
408 1.1 augustss u_int32_t length;
409 1.1 augustss u_int16_t flags;
410 1.1 augustss u_int32_t timeout;
411 1.48 augustss void (*callback) __P((usbd_xfer_handle,
412 1.1 augustss usbd_private_handle,
413 1.1 augustss usbd_status));
414 1.1 augustss {
415 1.48 augustss xfer->pipe = pipe;
416 1.48 augustss xfer->priv = priv;
417 1.48 augustss xfer->buffer = buffer;
418 1.48 augustss xfer->length = length;
419 1.48 augustss xfer->actlen = 0;
420 1.48 augustss xfer->flags = flags;
421 1.48 augustss xfer->timeout = timeout;
422 1.48 augustss xfer->status = USBD_NOT_STARTED;
423 1.48 augustss xfer->callback = callback;
424 1.48 augustss xfer->rqflags &= ~URQ_REQUEST;
425 1.48 augustss xfer->nframes = 0;
426 1.1 augustss }
427 1.1 augustss
428 1.36 augustss void
429 1.50 augustss usbd_setup_default_xfer(xfer, dev, priv, timeout, req, buffer,
430 1.1 augustss length, flags, callback)
431 1.48 augustss usbd_xfer_handle xfer;
432 1.1 augustss usbd_device_handle dev;
433 1.1 augustss usbd_private_handle priv;
434 1.1 augustss u_int32_t timeout;
435 1.1 augustss usb_device_request_t *req;
436 1.1 augustss void *buffer;
437 1.1 augustss u_int32_t length;
438 1.1 augustss u_int16_t flags;
439 1.48 augustss void (*callback) __P((usbd_xfer_handle,
440 1.1 augustss usbd_private_handle,
441 1.1 augustss usbd_status));
442 1.1 augustss {
443 1.48 augustss xfer->pipe = dev->default_pipe;
444 1.48 augustss xfer->priv = priv;
445 1.48 augustss xfer->buffer = buffer;
446 1.48 augustss xfer->length = length;
447 1.48 augustss xfer->actlen = 0;
448 1.48 augustss xfer->flags = flags;
449 1.48 augustss xfer->timeout = timeout;
450 1.48 augustss xfer->status = USBD_NOT_STARTED;
451 1.48 augustss xfer->callback = callback;
452 1.48 augustss xfer->request = *req;
453 1.48 augustss xfer->rqflags |= URQ_REQUEST;
454 1.48 augustss xfer->nframes = 0;
455 1.36 augustss }
456 1.36 augustss
457 1.36 augustss void
458 1.50 augustss usbd_setup_isoc_xfer(xfer, pipe, priv, frlengths, nframes, flags, callback)
459 1.48 augustss usbd_xfer_handle xfer;
460 1.36 augustss usbd_pipe_handle pipe;
461 1.36 augustss usbd_private_handle priv;
462 1.36 augustss u_int16_t *frlengths;
463 1.36 augustss u_int32_t nframes;
464 1.38 augustss u_int16_t flags;
465 1.36 augustss usbd_callback callback;
466 1.36 augustss {
467 1.48 augustss xfer->pipe = pipe;
468 1.48 augustss xfer->priv = priv;
469 1.48 augustss xfer->buffer = 0;
470 1.48 augustss xfer->length = 0;
471 1.48 augustss xfer->actlen = 0;
472 1.48 augustss xfer->flags = flags;
473 1.48 augustss xfer->timeout = USBD_NO_TIMEOUT;
474 1.48 augustss xfer->status = USBD_NOT_STARTED;
475 1.48 augustss xfer->callback = callback;
476 1.48 augustss xfer->rqflags &= ~URQ_REQUEST;
477 1.48 augustss xfer->frlengths = frlengths;
478 1.48 augustss xfer->nframes = nframes;
479 1.1 augustss }
480 1.1 augustss
481 1.31 augustss void
482 1.50 augustss usbd_get_xfer_status(xfer, priv, buffer, count, status)
483 1.48 augustss usbd_xfer_handle xfer;
484 1.1 augustss usbd_private_handle *priv;
485 1.1 augustss void **buffer;
486 1.1 augustss u_int32_t *count;
487 1.1 augustss usbd_status *status;
488 1.1 augustss {
489 1.48 augustss if (priv != NULL)
490 1.48 augustss *priv = xfer->priv;
491 1.48 augustss if (buffer != NULL)
492 1.48 augustss *buffer = xfer->buffer;
493 1.48 augustss if (count != NULL)
494 1.48 augustss *count = xfer->actlen;
495 1.48 augustss if (status != NULL)
496 1.48 augustss *status = xfer->status;
497 1.1 augustss }
498 1.1 augustss
499 1.1 augustss usb_config_descriptor_t *
500 1.1 augustss usbd_get_config_descriptor(dev)
501 1.1 augustss usbd_device_handle dev;
502 1.1 augustss {
503 1.53 augustss #ifdef DIAGNOSTIC
504 1.53 augustss if (dev == NULL) {
505 1.53 augustss printf("usbd_get_config_descriptor: dev == NULL\n");
506 1.53 augustss return (NULL);
507 1.53 augustss }
508 1.53 augustss #endif
509 1.1 augustss return (dev->cdesc);
510 1.1 augustss }
511 1.1 augustss
512 1.1 augustss usb_interface_descriptor_t *
513 1.1 augustss usbd_get_interface_descriptor(iface)
514 1.1 augustss usbd_interface_handle iface;
515 1.1 augustss {
516 1.53 augustss #ifdef DIAGNOSTIC
517 1.53 augustss if (iface == NULL) {
518 1.53 augustss printf("usbd_get_interface_descriptor: dev == NULL\n");
519 1.53 augustss return (NULL);
520 1.53 augustss }
521 1.53 augustss #endif
522 1.1 augustss return (iface->idesc);
523 1.1 augustss }
524 1.1 augustss
525 1.1 augustss usb_device_descriptor_t *
526 1.1 augustss usbd_get_device_descriptor(dev)
527 1.1 augustss usbd_device_handle dev;
528 1.1 augustss {
529 1.1 augustss return (&dev->ddesc);
530 1.1 augustss }
531 1.1 augustss
532 1.1 augustss usb_endpoint_descriptor_t *
533 1.1 augustss usbd_interface2endpoint_descriptor(iface, index)
534 1.1 augustss usbd_interface_handle iface;
535 1.1 augustss u_int8_t index;
536 1.1 augustss {
537 1.1 augustss if (index >= iface->idesc->bNumEndpoints)
538 1.12 augustss return (0);
539 1.1 augustss return (iface->endpoints[index].edesc);
540 1.1 augustss }
541 1.1 augustss
542 1.12 augustss usbd_status
543 1.1 augustss usbd_abort_pipe(pipe)
544 1.1 augustss usbd_pipe_handle pipe;
545 1.1 augustss {
546 1.48 augustss usbd_status err;
547 1.24 augustss int s;
548 1.1 augustss
549 1.26 augustss #ifdef DIAGNOSTIC
550 1.48 augustss if (pipe == NULL) {
551 1.26 augustss printf("usbd_close_pipe: pipe==NULL\n");
552 1.26 augustss return (USBD_NORMAL_COMPLETION);
553 1.26 augustss }
554 1.26 augustss #endif
555 1.1 augustss s = splusb();
556 1.48 augustss err = usbd_ar_pipe(pipe);
557 1.1 augustss splx(s);
558 1.48 augustss return (err);
559 1.1 augustss }
560 1.1 augustss
561 1.1 augustss usbd_status
562 1.1 augustss usbd_clear_endpoint_stall(pipe)
563 1.1 augustss usbd_pipe_handle pipe;
564 1.1 augustss {
565 1.1 augustss usbd_device_handle dev = pipe->device;
566 1.1 augustss usb_device_request_t req;
567 1.48 augustss usbd_status err;
568 1.1 augustss
569 1.22 augustss DPRINTFN(8, ("usbd_clear_endpoint_stall\n"));
570 1.33 augustss
571 1.33 augustss /*
572 1.33 augustss * Clearing en endpoint stall resets the enpoint toggle, so
573 1.33 augustss * do the same to the HC toggle.
574 1.33 augustss */
575 1.30 augustss pipe->methods->cleartoggle(pipe);
576 1.33 augustss
577 1.1 augustss req.bmRequestType = UT_WRITE_ENDPOINT;
578 1.1 augustss req.bRequest = UR_CLEAR_FEATURE;
579 1.15 augustss USETW(req.wValue, UF_ENDPOINT_HALT);
580 1.7 augustss USETW(req.wIndex, pipe->endpoint->edesc->bEndpointAddress);
581 1.1 augustss USETW(req.wLength, 0);
582 1.48 augustss err = usbd_do_request(dev, &req, 0);
583 1.1 augustss #if 0
584 1.1 augustss XXX should we do this?
585 1.51 augustss if (!err) {
586 1.1 augustss pipe->state = USBD_PIPE_ACTIVE;
587 1.1 augustss /* XXX activate pipe */
588 1.1 augustss }
589 1.1 augustss #endif
590 1.48 augustss return (err);
591 1.1 augustss }
592 1.1 augustss
593 1.1 augustss usbd_status
594 1.7 augustss usbd_clear_endpoint_stall_async(pipe)
595 1.7 augustss usbd_pipe_handle pipe;
596 1.7 augustss {
597 1.7 augustss usbd_device_handle dev = pipe->device;
598 1.7 augustss usb_device_request_t req;
599 1.48 augustss usbd_status err;
600 1.7 augustss
601 1.30 augustss pipe->methods->cleartoggle(pipe);
602 1.33 augustss
603 1.7 augustss req.bmRequestType = UT_WRITE_ENDPOINT;
604 1.7 augustss req.bRequest = UR_CLEAR_FEATURE;
605 1.15 augustss USETW(req.wValue, UF_ENDPOINT_HALT);
606 1.7 augustss USETW(req.wIndex, pipe->endpoint->edesc->bEndpointAddress);
607 1.7 augustss USETW(req.wLength, 0);
608 1.48 augustss err = usbd_do_request_async(dev, &req, 0);
609 1.48 augustss return (err);
610 1.7 augustss }
611 1.7 augustss
612 1.7 augustss usbd_status
613 1.1 augustss usbd_endpoint_count(iface, count)
614 1.1 augustss usbd_interface_handle iface;
615 1.1 augustss u_int8_t *count;
616 1.1 augustss {
617 1.1 augustss *count = iface->idesc->bNumEndpoints;
618 1.1 augustss return (USBD_NORMAL_COMPLETION);
619 1.1 augustss }
620 1.1 augustss
621 1.1 augustss usbd_status
622 1.1 augustss usbd_interface_count(dev, count)
623 1.1 augustss usbd_device_handle dev;
624 1.1 augustss u_int8_t *count;
625 1.1 augustss {
626 1.48 augustss if (dev->cdesc == NULL)
627 1.1 augustss return (USBD_NOT_CONFIGURED);
628 1.1 augustss *count = dev->cdesc->bNumInterface;
629 1.1 augustss return (USBD_NORMAL_COMPLETION);
630 1.1 augustss }
631 1.1 augustss
632 1.1 augustss usbd_status
633 1.1 augustss usbd_interface2device_handle(iface, dev)
634 1.1 augustss usbd_interface_handle iface;
635 1.1 augustss usbd_device_handle *dev;
636 1.1 augustss {
637 1.1 augustss *dev = iface->device;
638 1.1 augustss return (USBD_NORMAL_COMPLETION);
639 1.1 augustss }
640 1.1 augustss
641 1.1 augustss usbd_status
642 1.1 augustss usbd_device2interface_handle(dev, ifaceno, iface)
643 1.1 augustss usbd_device_handle dev;
644 1.1 augustss u_int8_t ifaceno;
645 1.1 augustss usbd_interface_handle *iface;
646 1.1 augustss {
647 1.48 augustss if (dev->cdesc == NULL)
648 1.1 augustss return (USBD_NOT_CONFIGURED);
649 1.1 augustss if (ifaceno >= dev->cdesc->bNumInterface)
650 1.1 augustss return (USBD_INVAL);
651 1.1 augustss *iface = &dev->ifaces[ifaceno];
652 1.1 augustss return (USBD_NORMAL_COMPLETION);
653 1.1 augustss }
654 1.1 augustss
655 1.36 augustss usbd_device_handle
656 1.36 augustss usbd_pipe2device_handle(pipe)
657 1.36 augustss usbd_pipe_handle pipe;
658 1.36 augustss {
659 1.36 augustss return (pipe->device);
660 1.36 augustss }
661 1.36 augustss
662 1.13 augustss /* XXXX use altno */
663 1.3 augustss usbd_status
664 1.13 augustss usbd_set_interface(iface, altidx)
665 1.3 augustss usbd_interface_handle iface;
666 1.13 augustss int altidx;
667 1.3 augustss {
668 1.3 augustss usb_device_request_t req;
669 1.48 augustss usbd_status err;
670 1.13 augustss
671 1.13 augustss if (LIST_FIRST(&iface->pipes) != 0)
672 1.13 augustss return (USBD_IN_USE);
673 1.13 augustss
674 1.16 augustss if (iface->endpoints)
675 1.16 augustss free(iface->endpoints, M_USB);
676 1.13 augustss iface->endpoints = 0;
677 1.13 augustss iface->idesc = 0;
678 1.13 augustss
679 1.48 augustss err = usbd_fill_iface_data(iface->device, iface->index, altidx);
680 1.48 augustss if (err)
681 1.48 augustss return (err);
682 1.3 augustss
683 1.3 augustss req.bmRequestType = UT_WRITE_INTERFACE;
684 1.3 augustss req.bRequest = UR_SET_INTERFACE;
685 1.13 augustss USETW(req.wValue, iface->idesc->bAlternateSetting);
686 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
687 1.3 augustss USETW(req.wLength, 0);
688 1.48 augustss return (usbd_do_request(iface->device, &req, 0));
689 1.12 augustss }
690 1.12 augustss
691 1.12 augustss int
692 1.13 augustss usbd_get_no_alts(cdesc, ifaceno)
693 1.13 augustss usb_config_descriptor_t *cdesc;
694 1.13 augustss int ifaceno;
695 1.12 augustss {
696 1.13 augustss char *p = (char *)cdesc;
697 1.13 augustss char *end = p + UGETW(cdesc->wTotalLength);
698 1.12 augustss usb_interface_descriptor_t *d;
699 1.12 augustss int n;
700 1.12 augustss
701 1.12 augustss for (n = 0; p < end; p += d->bLength) {
702 1.12 augustss d = (usb_interface_descriptor_t *)p;
703 1.12 augustss if (p + d->bLength <= end &&
704 1.12 augustss d->bDescriptorType == UDESC_INTERFACE &&
705 1.13 augustss d->bInterfaceNumber == ifaceno)
706 1.12 augustss n++;
707 1.12 augustss }
708 1.12 augustss return (n);
709 1.13 augustss }
710 1.13 augustss
711 1.13 augustss int
712 1.13 augustss usbd_get_interface_altindex(iface)
713 1.13 augustss usbd_interface_handle iface;
714 1.13 augustss {
715 1.13 augustss return (iface->altindex);
716 1.12 augustss }
717 1.12 augustss
718 1.12 augustss usbd_status
719 1.12 augustss usbd_get_interface(iface, aiface)
720 1.12 augustss usbd_interface_handle iface;
721 1.12 augustss u_int8_t *aiface;
722 1.12 augustss {
723 1.12 augustss usb_device_request_t req;
724 1.12 augustss
725 1.12 augustss req.bmRequestType = UT_READ_INTERFACE;
726 1.12 augustss req.bRequest = UR_GET_INTERFACE;
727 1.12 augustss USETW(req.wValue, 0);
728 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
729 1.12 augustss USETW(req.wLength, 1);
730 1.48 augustss return (usbd_do_request(iface->device, &req, aiface));
731 1.3 augustss }
732 1.1 augustss
733 1.1 augustss /*** Internal routines ***/
734 1.1 augustss
735 1.1 augustss /* Dequeue all pipe operations, called at splusb(). */
736 1.1 augustss static usbd_status
737 1.1 augustss usbd_ar_pipe(pipe)
738 1.1 augustss usbd_pipe_handle pipe;
739 1.1 augustss {
740 1.48 augustss usbd_xfer_handle xfer;
741 1.1 augustss
742 1.40 augustss SPLUSBCHECK;
743 1.40 augustss
744 1.25 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p\n", pipe));
745 1.28 augustss #ifdef USB_DEBUG
746 1.28 augustss if (usbdebug > 5)
747 1.28 augustss usbd_dump_queue(pipe);
748 1.28 augustss #endif
749 1.47 augustss pipe->repeat = 0;
750 1.48 augustss while ((xfer = SIMPLEQ_FIRST(&pipe->queue)) != NULL) {
751 1.48 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p xfer=%p (methods=%p)\n",
752 1.48 augustss pipe, xfer, pipe->methods));
753 1.28 augustss /* Make the HC abort it (and invoke the callback). */
754 1.48 augustss pipe->methods->abort(xfer);
755 1.33 augustss /* XXX only for non-0 usbd_clear_endpoint_stall(pipe); */
756 1.20 augustss }
757 1.1 augustss return (USBD_NORMAL_COMPLETION);
758 1.1 augustss }
759 1.1 augustss
760 1.40 augustss /* Called at splusb() */
761 1.31 augustss void
762 1.48 augustss usb_transfer_complete(xfer)
763 1.48 augustss usbd_xfer_handle xfer;
764 1.1 augustss {
765 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
766 1.48 augustss usb_dma_t *dmap = &xfer->dmabuf;
767 1.47 augustss int repeat = pipe->repeat;
768 1.31 augustss int polling;
769 1.31 augustss
770 1.40 augustss SPLUSBCHECK;
771 1.40 augustss
772 1.48 augustss DPRINTFN(5, ("usb_transfer_complete: pipe=%p xfer=%p status=%d "
773 1.48 augustss "actlen=%d\n", pipe, xfer, xfer->status, xfer->actlen));
774 1.5 augustss
775 1.23 augustss #ifdef DIAGNOSTIC
776 1.48 augustss if (pipe == NULL) {
777 1.48 augustss printf("usbd_transfer_cb: pipe==0, xfer=%p\n", xfer);
778 1.31 augustss return;
779 1.31 augustss }
780 1.23 augustss #endif
781 1.37 augustss polling = pipe->device->bus->use_polling;
782 1.31 augustss /* XXXX */
783 1.31 augustss if (polling)
784 1.31 augustss pipe->running = 0;
785 1.31 augustss
786 1.48 augustss if (!(xfer->flags & USBD_NO_COPY) && xfer->actlen != 0 &&
787 1.48 augustss usbd_xfer_isread(xfer)) {
788 1.43 augustss #ifdef DIAGNOSTIC
789 1.48 augustss if (xfer->actlen > xfer->length) {
790 1.43 augustss printf("usb_transfer_complete: actlen > len %d > %d\n",
791 1.48 augustss xfer->actlen, xfer->length);
792 1.48 augustss xfer->actlen = xfer->length;
793 1.43 augustss }
794 1.43 augustss #endif
795 1.48 augustss memcpy(xfer->buffer, KERNADDR(dmap), xfer->actlen);
796 1.43 augustss }
797 1.38 augustss
798 1.37 augustss /* if we allocated the buffer in usbd_transfer() we free it here. */
799 1.48 augustss if (xfer->rqflags & URQ_AUTO_DMABUF) {
800 1.47 augustss if (!repeat) {
801 1.37 augustss struct usbd_bus *bus = pipe->device->bus;
802 1.37 augustss bus->methods->freem(bus, dmap);
803 1.48 augustss xfer->rqflags &= ~URQ_AUTO_DMABUF;
804 1.37 augustss }
805 1.37 augustss }
806 1.37 augustss
807 1.48 augustss if (pipe->methods->done != NULL)
808 1.48 augustss pipe->methods->done(xfer);
809 1.31 augustss
810 1.47 augustss if (!repeat) {
811 1.47 augustss /* Remove request from queue. */
812 1.47 augustss #ifdef DIAGNOSTIC
813 1.48 augustss if (xfer != SIMPLEQ_FIRST(&pipe->queue))
814 1.47 augustss printf("usb_transfer_complete: bad dequeue %p != %p\n",
815 1.48 augustss xfer, SIMPLEQ_FIRST(&pipe->queue));
816 1.45 augustss #endif
817 1.48 augustss SIMPLEQ_REMOVE_HEAD(&pipe->queue, xfer, next);
818 1.47 augustss }
819 1.31 augustss
820 1.31 augustss /* Count completed transfers. */
821 1.5 augustss ++pipe->device->bus->stats.requests
822 1.5 augustss [pipe->endpoint->edesc->bmAttributes & UE_XFERTYPE];
823 1.1 augustss
824 1.48 augustss xfer->done = 1;
825 1.52 augustss if (!xfer->status && xfer->actlen < xfer->length &&
826 1.48 augustss !(xfer->flags & USBD_SHORT_XFER_OK)) {
827 1.48 augustss DPRINTFN(-1,("usbd_transfer_cb: short transfer %d<%d\n",
828 1.48 augustss xfer->actlen, xfer->length));
829 1.48 augustss xfer->status = USBD_SHORT_XFER;
830 1.1 augustss }
831 1.31 augustss
832 1.48 augustss if (xfer->callback)
833 1.48 augustss xfer->callback(xfer, xfer->priv, xfer->status);
834 1.31 augustss
835 1.48 augustss if ((xfer->flags & USBD_SYNCHRONOUS) && !polling)
836 1.48 augustss wakeup(xfer);
837 1.31 augustss
838 1.47 augustss if (!repeat) {
839 1.40 augustss /* XXX should we stop the queue on all errors? */
840 1.48 augustss if (xfer->status == USBD_CANCELLED ||
841 1.48 augustss xfer->status == USBD_TIMEOUT)
842 1.40 augustss pipe->running = 0;
843 1.40 augustss else
844 1.40 augustss usbd_start_next(pipe);
845 1.40 augustss }
846 1.1 augustss }
847 1.1 augustss
848 1.31 augustss usbd_status
849 1.48 augustss usb_insert_transfer(xfer)
850 1.48 augustss usbd_xfer_handle xfer;
851 1.1 augustss {
852 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
853 1.48 augustss usbd_status err;
854 1.37 augustss int s;
855 1.31 augustss
856 1.40 augustss DPRINTFN(5,("usb_insert_transfer: pipe=%p running=%d timeout=%d\n",
857 1.48 augustss pipe, pipe->running, xfer->timeout));
858 1.37 augustss s = splusb();
859 1.48 augustss SIMPLEQ_INSERT_TAIL(&pipe->queue, xfer, next);
860 1.31 augustss if (pipe->running)
861 1.48 augustss err = USBD_IN_PROGRESS;
862 1.37 augustss else {
863 1.37 augustss pipe->running = 1;
864 1.48 augustss err = USBD_NORMAL_COMPLETION;
865 1.37 augustss }
866 1.37 augustss splx(s);
867 1.48 augustss return (err);
868 1.1 augustss }
869 1.1 augustss
870 1.40 augustss /* Called at splusb() */
871 1.31 augustss void
872 1.31 augustss usbd_start_next(pipe)
873 1.31 augustss usbd_pipe_handle pipe;
874 1.31 augustss {
875 1.48 augustss usbd_xfer_handle xfer;
876 1.48 augustss usbd_status err;
877 1.40 augustss
878 1.40 augustss SPLUSBCHECK;
879 1.1 augustss
880 1.31 augustss #ifdef DIAGNOSTIC
881 1.48 augustss if (pipe == NULL) {
882 1.51 augustss printf("usbd_start_next: pipe == NULL\n");
883 1.31 augustss return;
884 1.31 augustss }
885 1.48 augustss if (pipe->methods == NULL || pipe->methods->start == NULL) {
886 1.51 augustss printf("usbd_start_next: pipe=%p no start method\n", pipe);
887 1.31 augustss return;
888 1.31 augustss }
889 1.31 augustss #endif
890 1.31 augustss
891 1.31 augustss /* Get next request in queue. */
892 1.48 augustss xfer = SIMPLEQ_FIRST(&pipe->queue);
893 1.51 augustss DPRINTFN(5, ("usbd_start_next: pipe=%p, xfer=%p\n", pipe, xfer));
894 1.51 augustss if (xfer == NULL) {
895 1.31 augustss pipe->running = 0;
896 1.51 augustss } else {
897 1.48 augustss err = pipe->methods->start(xfer);
898 1.48 augustss if (err != USBD_IN_PROGRESS) {
899 1.48 augustss printf("usbd_start_next: error=%d\n", err);
900 1.31 augustss pipe->running = 0;
901 1.31 augustss /* XXX do what? */
902 1.31 augustss }
903 1.1 augustss }
904 1.1 augustss }
905 1.1 augustss
906 1.1 augustss usbd_status
907 1.1 augustss usbd_do_request(dev, req, data)
908 1.1 augustss usbd_device_handle dev;
909 1.1 augustss usb_device_request_t *req;
910 1.1 augustss void *data;
911 1.1 augustss {
912 1.19 augustss return (usbd_do_request_flags(dev, req, data, 0, 0));
913 1.17 augustss }
914 1.17 augustss
915 1.17 augustss usbd_status
916 1.19 augustss usbd_do_request_flags(dev, req, data, flags, actlen)
917 1.17 augustss usbd_device_handle dev;
918 1.17 augustss usb_device_request_t *req;
919 1.17 augustss void *data;
920 1.17 augustss u_int16_t flags;
921 1.19 augustss int *actlen;
922 1.17 augustss {
923 1.48 augustss usbd_xfer_handle xfer;
924 1.48 augustss usbd_status err;
925 1.1 augustss
926 1.7 augustss #ifdef DIAGNOSTIC
927 1.51 augustss #if defined(__i386__) && defined(__FreeBSD__)
928 1.51 augustss KASSERT(intr_nesting_level == 0,
929 1.51 augustss ("ohci_abort_req in interrupt context"));
930 1.51 augustss #endif
931 1.39 augustss if (dev->bus->intr_context) {
932 1.7 augustss printf("usbd_do_request: not in process context\n");
933 1.37 augustss return (USBD_INVAL);
934 1.7 augustss }
935 1.7 augustss #endif
936 1.7 augustss
937 1.50 augustss xfer = usbd_alloc_xfer(dev);
938 1.48 augustss if (xfer == NULL)
939 1.1 augustss return (USBD_NOMEM);
940 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
941 1.37 augustss data, UGETW(req->wLength), flags, 0);
942 1.48 augustss err = usbd_sync_transfer(xfer);
943 1.1 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
944 1.48 augustss if (xfer->actlen > xfer->length)
945 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
946 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
947 1.48 augustss dev->address, xfer->request.bmRequestType,
948 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
949 1.48 augustss UGETW(xfer->request.wIndex),
950 1.48 augustss UGETW(xfer->request.wLength),
951 1.48 augustss xfer->length, xfer->actlen));
952 1.1 augustss #endif
953 1.48 augustss if (actlen != NULL)
954 1.48 augustss *actlen = xfer->actlen;
955 1.48 augustss if (err == USBD_STALLED) {
956 1.15 augustss /*
957 1.15 augustss * The control endpoint has stalled. Control endpoints
958 1.15 augustss * should not halt, but some may do so anyway so clear
959 1.15 augustss * any halt condition.
960 1.15 augustss */
961 1.15 augustss usb_device_request_t treq;
962 1.15 augustss usb_status_t status;
963 1.15 augustss u_int16_t s;
964 1.48 augustss usbd_status nerr;
965 1.15 augustss
966 1.15 augustss treq.bmRequestType = UT_READ_ENDPOINT;
967 1.15 augustss treq.bRequest = UR_GET_STATUS;
968 1.15 augustss USETW(treq.wValue, 0);
969 1.15 augustss USETW(treq.wIndex, 0);
970 1.15 augustss USETW(treq.wLength, sizeof(usb_status_t));
971 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
972 1.37 augustss &treq, &status,sizeof(usb_status_t),
973 1.36 augustss 0, 0);
974 1.48 augustss nerr = usbd_sync_transfer(xfer);
975 1.48 augustss if (nerr)
976 1.15 augustss goto bad;
977 1.15 augustss s = UGETW(status.wStatus);
978 1.15 augustss DPRINTF(("usbd_do_request: status = 0x%04x\n", s));
979 1.15 augustss if (!(s & UES_HALT))
980 1.15 augustss goto bad;
981 1.15 augustss treq.bmRequestType = UT_WRITE_ENDPOINT;
982 1.15 augustss treq.bRequest = UR_CLEAR_FEATURE;
983 1.15 augustss USETW(treq.wValue, UF_ENDPOINT_HALT);
984 1.15 augustss USETW(treq.wIndex, 0);
985 1.15 augustss USETW(treq.wLength, 0);
986 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
987 1.36 augustss &treq, &status, 0, 0, 0);
988 1.48 augustss nerr = usbd_sync_transfer(xfer);
989 1.48 augustss if (nerr)
990 1.15 augustss goto bad;
991 1.15 augustss }
992 1.15 augustss
993 1.15 augustss bad:
994 1.50 augustss usbd_free_xfer(xfer);
995 1.48 augustss return (err);
996 1.7 augustss }
997 1.7 augustss
998 1.7 augustss void
999 1.48 augustss usbd_do_request_async_cb(xfer, priv, status)
1000 1.48 augustss usbd_xfer_handle xfer;
1001 1.7 augustss usbd_private_handle priv;
1002 1.7 augustss usbd_status status;
1003 1.7 augustss {
1004 1.7 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
1005 1.48 augustss if (xfer->actlen > xfer->length)
1006 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
1007 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
1008 1.48 augustss xfer->pipe->device->address,
1009 1.48 augustss xfer->request.bmRequestType,
1010 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
1011 1.48 augustss UGETW(xfer->request.wIndex),
1012 1.48 augustss UGETW(xfer->request.wLength),
1013 1.48 augustss xfer->length, xfer->actlen));
1014 1.7 augustss #endif
1015 1.50 augustss usbd_free_xfer(xfer);
1016 1.7 augustss }
1017 1.7 augustss
1018 1.7 augustss /*
1019 1.7 augustss * Execute a request without waiting for completion.
1020 1.7 augustss * Can be used from interrupt context.
1021 1.7 augustss */
1022 1.7 augustss usbd_status
1023 1.7 augustss usbd_do_request_async(dev, req, data)
1024 1.7 augustss usbd_device_handle dev;
1025 1.7 augustss usb_device_request_t *req;
1026 1.7 augustss void *data;
1027 1.7 augustss {
1028 1.48 augustss usbd_xfer_handle xfer;
1029 1.48 augustss usbd_status err;
1030 1.7 augustss
1031 1.50 augustss xfer = usbd_alloc_xfer(dev);
1032 1.49 augustss if (xfer == NULL)
1033 1.7 augustss return (USBD_NOMEM);
1034 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
1035 1.48 augustss data, UGETW(req->wLength), 0, usbd_do_request_async_cb);
1036 1.48 augustss err = usbd_transfer(xfer);
1037 1.48 augustss if (err != USBD_IN_PROGRESS) {
1038 1.50 augustss usbd_free_xfer(xfer);
1039 1.48 augustss return (err);
1040 1.7 augustss }
1041 1.7 augustss return (USBD_NORMAL_COMPLETION);
1042 1.1 augustss }
1043 1.1 augustss
1044 1.1 augustss struct usbd_quirks *
1045 1.1 augustss usbd_get_quirks(dev)
1046 1.1 augustss usbd_device_handle dev;
1047 1.1 augustss {
1048 1.1 augustss return (dev->quirks);
1049 1.1 augustss }
1050 1.1 augustss
1051 1.1 augustss /* XXX do periodic free() of free list */
1052 1.1 augustss
1053 1.6 augustss /*
1054 1.6 augustss * Called from keyboard driver when in polling mode.
1055 1.6 augustss */
1056 1.6 augustss void
1057 1.6 augustss usbd_dopoll(iface)
1058 1.6 augustss usbd_interface_handle iface;
1059 1.6 augustss {
1060 1.36 augustss iface->device->bus->methods->do_poll(iface->device->bus);
1061 1.8 augustss }
1062 1.8 augustss
1063 1.8 augustss void
1064 1.54 augustss usbd_set_polling(dev, on)
1065 1.54 augustss usbd_device_handle dev;
1066 1.8 augustss int on;
1067 1.8 augustss {
1068 1.42 augustss if (on)
1069 1.54 augustss dev->bus->use_polling++;
1070 1.42 augustss else
1071 1.54 augustss dev->bus->use_polling--;
1072 1.6 augustss }
1073 1.12 augustss
1074 1.12 augustss
1075 1.12 augustss usb_endpoint_descriptor_t *
1076 1.12 augustss usbd_get_endpoint_descriptor(iface, address)
1077 1.12 augustss usbd_interface_handle iface;
1078 1.12 augustss u_int8_t address;
1079 1.12 augustss {
1080 1.12 augustss struct usbd_endpoint *ep;
1081 1.12 augustss int i;
1082 1.12 augustss
1083 1.12 augustss for (i = 0; i < iface->idesc->bNumEndpoints; i++) {
1084 1.12 augustss ep = &iface->endpoints[i];
1085 1.12 augustss if (ep->edesc->bEndpointAddress == address)
1086 1.12 augustss return (iface->endpoints[i].edesc);
1087 1.12 augustss }
1088 1.12 augustss return (0);
1089 1.12 augustss }
1090 1.12 augustss
1091 1.20 augustss #if defined(__FreeBSD__)
1092 1.20 augustss int
1093 1.20 augustss usbd_driver_load(module_t mod, int what, void *arg)
1094 1.20 augustss {
1095 1.45 augustss /* XXX should implement something like a function that removes all generic devices */
1096 1.45 augustss
1097 1.48 augustss return (0);
1098 1.20 augustss }
1099 1.20 augustss
1100 1.20 augustss #endif
1101