usbdi.c revision 1.56 1 1.56 augustss /* $NetBSD: usbdi.c,v 1.56 2000/01/16 13:34:51 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.56 augustss int to = xfer->timeout * 1000;
311 1.56 augustss for (i = 0; i < to; i += 10) {
312 1.55 augustss delay(10);
313 1.55 augustss bus->methods->do_poll(bus);
314 1.55 augustss if (xfer->done)
315 1.55 augustss break;
316 1.55 augustss }
317 1.55 augustss if (!xfer->done)
318 1.55 augustss pipe->methods->abort(xfer);
319 1.55 augustss } else
320 1.56 augustss /* XXX End hack XXX */
321 1.55 augustss tsleep(xfer, PRIBIO, "usbsyn", 0);
322 1.31 augustss }
323 1.31 augustss splx(s);
324 1.48 augustss return (xfer->status);
325 1.31 augustss }
326 1.31 augustss
327 1.31 augustss /* Like usbd_transfer(), but waits for completion. */
328 1.31 augustss usbd_status
329 1.48 augustss usbd_sync_transfer(xfer)
330 1.48 augustss usbd_xfer_handle xfer;
331 1.31 augustss {
332 1.48 augustss xfer->flags |= USBD_SYNCHRONOUS;
333 1.48 augustss return (usbd_transfer(xfer));
334 1.16 augustss }
335 1.16 augustss
336 1.36 augustss void *
337 1.48 augustss usbd_alloc_buffer(xfer, size)
338 1.48 augustss usbd_xfer_handle xfer;
339 1.36 augustss u_int32_t size;
340 1.36 augustss {
341 1.48 augustss struct usbd_bus *bus = xfer->device->bus;
342 1.48 augustss usbd_status err;
343 1.37 augustss
344 1.48 augustss err = bus->methods->allocm(bus, &xfer->dmabuf, size);
345 1.48 augustss if (err)
346 1.36 augustss return (0);
347 1.48 augustss xfer->rqflags |= URQ_DEV_DMABUF;
348 1.48 augustss return (KERNADDR(&xfer->dmabuf));
349 1.36 augustss }
350 1.36 augustss
351 1.36 augustss void
352 1.48 augustss usbd_free_buffer(xfer)
353 1.48 augustss usbd_xfer_handle xfer;
354 1.36 augustss {
355 1.37 augustss #ifdef DIAGNOSTIC
356 1.48 augustss if (!(xfer->rqflags & (URQ_DEV_DMABUF | URQ_AUTO_DMABUF))) {
357 1.37 augustss printf("usbd_free_buffer: no buffer\n");
358 1.37 augustss return;
359 1.37 augustss }
360 1.37 augustss #endif
361 1.48 augustss xfer->rqflags &= ~(URQ_DEV_DMABUF | URQ_AUTO_DMABUF);
362 1.48 augustss xfer->device->bus->methods->freem(xfer->device->bus, &xfer->dmabuf);
363 1.36 augustss }
364 1.36 augustss
365 1.38 augustss void *
366 1.48 augustss usbd_get_buffer(xfer)
367 1.48 augustss usbd_xfer_handle xfer;
368 1.38 augustss {
369 1.48 augustss if (!(xfer->rqflags & URQ_DEV_DMABUF))
370 1.38 augustss return (0);
371 1.48 augustss return (KERNADDR(&xfer->dmabuf));
372 1.38 augustss }
373 1.38 augustss
374 1.48 augustss usbd_xfer_handle
375 1.50 augustss usbd_alloc_xfer(dev)
376 1.36 augustss usbd_device_handle dev;
377 1.1 augustss {
378 1.48 augustss usbd_xfer_handle xfer;
379 1.1 augustss
380 1.50 augustss xfer = SIMPLEQ_FIRST(&usbd_free_xfers);
381 1.48 augustss if (xfer != NULL)
382 1.50 augustss SIMPLEQ_REMOVE_HEAD(&usbd_free_xfers, xfer, next);
383 1.1 augustss else
384 1.48 augustss xfer = malloc(sizeof(*xfer), M_USB, M_NOWAIT);
385 1.48 augustss if (xfer == NULL)
386 1.1 augustss return (0);
387 1.48 augustss memset(xfer, 0, sizeof *xfer);
388 1.48 augustss xfer->device = dev;
389 1.50 augustss DPRINTFN(5,("usbd_alloc_xfer() = %p\n", xfer));
390 1.48 augustss return (xfer);
391 1.1 augustss }
392 1.1 augustss
393 1.1 augustss usbd_status
394 1.50 augustss usbd_free_xfer(xfer)
395 1.48 augustss usbd_xfer_handle xfer;
396 1.1 augustss {
397 1.50 augustss DPRINTFN(5,("usbd_free_xfer: %p\n", xfer));
398 1.48 augustss if (xfer->rqflags & (URQ_DEV_DMABUF | URQ_AUTO_DMABUF))
399 1.48 augustss usbd_free_buffer(xfer);
400 1.50 augustss SIMPLEQ_INSERT_HEAD(&usbd_free_xfers, xfer, next);
401 1.1 augustss return (USBD_NORMAL_COMPLETION);
402 1.1 augustss }
403 1.1 augustss
404 1.36 augustss void
405 1.50 augustss usbd_setup_xfer(xfer, pipe, priv, buffer, length, flags, timeout, callback)
406 1.48 augustss usbd_xfer_handle xfer;
407 1.1 augustss usbd_pipe_handle pipe;
408 1.1 augustss usbd_private_handle priv;
409 1.1 augustss void *buffer;
410 1.1 augustss u_int32_t length;
411 1.1 augustss u_int16_t flags;
412 1.1 augustss u_int32_t timeout;
413 1.48 augustss void (*callback) __P((usbd_xfer_handle,
414 1.1 augustss usbd_private_handle,
415 1.1 augustss usbd_status));
416 1.1 augustss {
417 1.48 augustss xfer->pipe = pipe;
418 1.48 augustss xfer->priv = priv;
419 1.48 augustss xfer->buffer = buffer;
420 1.48 augustss xfer->length = length;
421 1.48 augustss xfer->actlen = 0;
422 1.48 augustss xfer->flags = flags;
423 1.48 augustss xfer->timeout = timeout;
424 1.48 augustss xfer->status = USBD_NOT_STARTED;
425 1.48 augustss xfer->callback = callback;
426 1.48 augustss xfer->rqflags &= ~URQ_REQUEST;
427 1.48 augustss xfer->nframes = 0;
428 1.1 augustss }
429 1.1 augustss
430 1.36 augustss void
431 1.50 augustss usbd_setup_default_xfer(xfer, dev, priv, timeout, req, buffer,
432 1.1 augustss length, flags, callback)
433 1.48 augustss usbd_xfer_handle xfer;
434 1.1 augustss usbd_device_handle dev;
435 1.1 augustss usbd_private_handle priv;
436 1.1 augustss u_int32_t timeout;
437 1.1 augustss usb_device_request_t *req;
438 1.1 augustss void *buffer;
439 1.1 augustss u_int32_t length;
440 1.1 augustss u_int16_t flags;
441 1.48 augustss void (*callback) __P((usbd_xfer_handle,
442 1.1 augustss usbd_private_handle,
443 1.1 augustss usbd_status));
444 1.1 augustss {
445 1.48 augustss xfer->pipe = dev->default_pipe;
446 1.48 augustss xfer->priv = priv;
447 1.48 augustss xfer->buffer = buffer;
448 1.48 augustss xfer->length = length;
449 1.48 augustss xfer->actlen = 0;
450 1.48 augustss xfer->flags = flags;
451 1.48 augustss xfer->timeout = timeout;
452 1.48 augustss xfer->status = USBD_NOT_STARTED;
453 1.48 augustss xfer->callback = callback;
454 1.48 augustss xfer->request = *req;
455 1.48 augustss xfer->rqflags |= URQ_REQUEST;
456 1.48 augustss xfer->nframes = 0;
457 1.36 augustss }
458 1.36 augustss
459 1.36 augustss void
460 1.50 augustss usbd_setup_isoc_xfer(xfer, pipe, priv, frlengths, nframes, flags, callback)
461 1.48 augustss usbd_xfer_handle xfer;
462 1.36 augustss usbd_pipe_handle pipe;
463 1.36 augustss usbd_private_handle priv;
464 1.36 augustss u_int16_t *frlengths;
465 1.36 augustss u_int32_t nframes;
466 1.38 augustss u_int16_t flags;
467 1.36 augustss usbd_callback callback;
468 1.36 augustss {
469 1.48 augustss xfer->pipe = pipe;
470 1.48 augustss xfer->priv = priv;
471 1.48 augustss xfer->buffer = 0;
472 1.48 augustss xfer->length = 0;
473 1.48 augustss xfer->actlen = 0;
474 1.48 augustss xfer->flags = flags;
475 1.48 augustss xfer->timeout = USBD_NO_TIMEOUT;
476 1.48 augustss xfer->status = USBD_NOT_STARTED;
477 1.48 augustss xfer->callback = callback;
478 1.48 augustss xfer->rqflags &= ~URQ_REQUEST;
479 1.48 augustss xfer->frlengths = frlengths;
480 1.48 augustss xfer->nframes = nframes;
481 1.1 augustss }
482 1.1 augustss
483 1.31 augustss void
484 1.50 augustss usbd_get_xfer_status(xfer, priv, buffer, count, status)
485 1.48 augustss usbd_xfer_handle xfer;
486 1.1 augustss usbd_private_handle *priv;
487 1.1 augustss void **buffer;
488 1.1 augustss u_int32_t *count;
489 1.1 augustss usbd_status *status;
490 1.1 augustss {
491 1.48 augustss if (priv != NULL)
492 1.48 augustss *priv = xfer->priv;
493 1.48 augustss if (buffer != NULL)
494 1.48 augustss *buffer = xfer->buffer;
495 1.48 augustss if (count != NULL)
496 1.48 augustss *count = xfer->actlen;
497 1.48 augustss if (status != NULL)
498 1.48 augustss *status = xfer->status;
499 1.1 augustss }
500 1.1 augustss
501 1.1 augustss usb_config_descriptor_t *
502 1.1 augustss usbd_get_config_descriptor(dev)
503 1.1 augustss usbd_device_handle dev;
504 1.1 augustss {
505 1.53 augustss #ifdef DIAGNOSTIC
506 1.53 augustss if (dev == NULL) {
507 1.53 augustss printf("usbd_get_config_descriptor: dev == NULL\n");
508 1.53 augustss return (NULL);
509 1.53 augustss }
510 1.53 augustss #endif
511 1.1 augustss return (dev->cdesc);
512 1.1 augustss }
513 1.1 augustss
514 1.1 augustss usb_interface_descriptor_t *
515 1.1 augustss usbd_get_interface_descriptor(iface)
516 1.1 augustss usbd_interface_handle iface;
517 1.1 augustss {
518 1.53 augustss #ifdef DIAGNOSTIC
519 1.53 augustss if (iface == NULL) {
520 1.53 augustss printf("usbd_get_interface_descriptor: dev == NULL\n");
521 1.53 augustss return (NULL);
522 1.53 augustss }
523 1.53 augustss #endif
524 1.1 augustss return (iface->idesc);
525 1.1 augustss }
526 1.1 augustss
527 1.1 augustss usb_device_descriptor_t *
528 1.1 augustss usbd_get_device_descriptor(dev)
529 1.1 augustss usbd_device_handle dev;
530 1.1 augustss {
531 1.1 augustss return (&dev->ddesc);
532 1.1 augustss }
533 1.1 augustss
534 1.1 augustss usb_endpoint_descriptor_t *
535 1.1 augustss usbd_interface2endpoint_descriptor(iface, index)
536 1.1 augustss usbd_interface_handle iface;
537 1.1 augustss u_int8_t index;
538 1.1 augustss {
539 1.1 augustss if (index >= iface->idesc->bNumEndpoints)
540 1.12 augustss return (0);
541 1.1 augustss return (iface->endpoints[index].edesc);
542 1.1 augustss }
543 1.1 augustss
544 1.12 augustss usbd_status
545 1.1 augustss usbd_abort_pipe(pipe)
546 1.1 augustss usbd_pipe_handle pipe;
547 1.1 augustss {
548 1.48 augustss usbd_status err;
549 1.24 augustss int s;
550 1.1 augustss
551 1.26 augustss #ifdef DIAGNOSTIC
552 1.48 augustss if (pipe == NULL) {
553 1.26 augustss printf("usbd_close_pipe: pipe==NULL\n");
554 1.26 augustss return (USBD_NORMAL_COMPLETION);
555 1.26 augustss }
556 1.26 augustss #endif
557 1.1 augustss s = splusb();
558 1.48 augustss err = usbd_ar_pipe(pipe);
559 1.1 augustss splx(s);
560 1.48 augustss return (err);
561 1.1 augustss }
562 1.1 augustss
563 1.1 augustss usbd_status
564 1.1 augustss usbd_clear_endpoint_stall(pipe)
565 1.1 augustss usbd_pipe_handle pipe;
566 1.1 augustss {
567 1.1 augustss usbd_device_handle dev = pipe->device;
568 1.1 augustss usb_device_request_t req;
569 1.48 augustss usbd_status err;
570 1.1 augustss
571 1.22 augustss DPRINTFN(8, ("usbd_clear_endpoint_stall\n"));
572 1.33 augustss
573 1.33 augustss /*
574 1.33 augustss * Clearing en endpoint stall resets the enpoint toggle, so
575 1.33 augustss * do the same to the HC toggle.
576 1.33 augustss */
577 1.30 augustss pipe->methods->cleartoggle(pipe);
578 1.33 augustss
579 1.1 augustss req.bmRequestType = UT_WRITE_ENDPOINT;
580 1.1 augustss req.bRequest = UR_CLEAR_FEATURE;
581 1.15 augustss USETW(req.wValue, UF_ENDPOINT_HALT);
582 1.7 augustss USETW(req.wIndex, pipe->endpoint->edesc->bEndpointAddress);
583 1.1 augustss USETW(req.wLength, 0);
584 1.48 augustss err = usbd_do_request(dev, &req, 0);
585 1.1 augustss #if 0
586 1.1 augustss XXX should we do this?
587 1.51 augustss if (!err) {
588 1.1 augustss pipe->state = USBD_PIPE_ACTIVE;
589 1.1 augustss /* XXX activate pipe */
590 1.1 augustss }
591 1.1 augustss #endif
592 1.48 augustss return (err);
593 1.1 augustss }
594 1.1 augustss
595 1.1 augustss usbd_status
596 1.7 augustss usbd_clear_endpoint_stall_async(pipe)
597 1.7 augustss usbd_pipe_handle pipe;
598 1.7 augustss {
599 1.7 augustss usbd_device_handle dev = pipe->device;
600 1.7 augustss usb_device_request_t req;
601 1.48 augustss usbd_status err;
602 1.7 augustss
603 1.30 augustss pipe->methods->cleartoggle(pipe);
604 1.33 augustss
605 1.7 augustss req.bmRequestType = UT_WRITE_ENDPOINT;
606 1.7 augustss req.bRequest = UR_CLEAR_FEATURE;
607 1.15 augustss USETW(req.wValue, UF_ENDPOINT_HALT);
608 1.7 augustss USETW(req.wIndex, pipe->endpoint->edesc->bEndpointAddress);
609 1.7 augustss USETW(req.wLength, 0);
610 1.48 augustss err = usbd_do_request_async(dev, &req, 0);
611 1.48 augustss return (err);
612 1.7 augustss }
613 1.7 augustss
614 1.7 augustss usbd_status
615 1.1 augustss usbd_endpoint_count(iface, count)
616 1.1 augustss usbd_interface_handle iface;
617 1.1 augustss u_int8_t *count;
618 1.1 augustss {
619 1.1 augustss *count = iface->idesc->bNumEndpoints;
620 1.1 augustss return (USBD_NORMAL_COMPLETION);
621 1.1 augustss }
622 1.1 augustss
623 1.1 augustss usbd_status
624 1.1 augustss usbd_interface_count(dev, count)
625 1.1 augustss usbd_device_handle dev;
626 1.1 augustss u_int8_t *count;
627 1.1 augustss {
628 1.48 augustss if (dev->cdesc == NULL)
629 1.1 augustss return (USBD_NOT_CONFIGURED);
630 1.1 augustss *count = dev->cdesc->bNumInterface;
631 1.1 augustss return (USBD_NORMAL_COMPLETION);
632 1.1 augustss }
633 1.1 augustss
634 1.1 augustss usbd_status
635 1.1 augustss usbd_interface2device_handle(iface, dev)
636 1.1 augustss usbd_interface_handle iface;
637 1.1 augustss usbd_device_handle *dev;
638 1.1 augustss {
639 1.1 augustss *dev = iface->device;
640 1.1 augustss return (USBD_NORMAL_COMPLETION);
641 1.1 augustss }
642 1.1 augustss
643 1.1 augustss usbd_status
644 1.1 augustss usbd_device2interface_handle(dev, ifaceno, iface)
645 1.1 augustss usbd_device_handle dev;
646 1.1 augustss u_int8_t ifaceno;
647 1.1 augustss usbd_interface_handle *iface;
648 1.1 augustss {
649 1.48 augustss if (dev->cdesc == NULL)
650 1.1 augustss return (USBD_NOT_CONFIGURED);
651 1.1 augustss if (ifaceno >= dev->cdesc->bNumInterface)
652 1.1 augustss return (USBD_INVAL);
653 1.1 augustss *iface = &dev->ifaces[ifaceno];
654 1.1 augustss return (USBD_NORMAL_COMPLETION);
655 1.1 augustss }
656 1.1 augustss
657 1.36 augustss usbd_device_handle
658 1.36 augustss usbd_pipe2device_handle(pipe)
659 1.36 augustss usbd_pipe_handle pipe;
660 1.36 augustss {
661 1.36 augustss return (pipe->device);
662 1.36 augustss }
663 1.36 augustss
664 1.13 augustss /* XXXX use altno */
665 1.3 augustss usbd_status
666 1.13 augustss usbd_set_interface(iface, altidx)
667 1.3 augustss usbd_interface_handle iface;
668 1.13 augustss int altidx;
669 1.3 augustss {
670 1.3 augustss usb_device_request_t req;
671 1.48 augustss usbd_status err;
672 1.13 augustss
673 1.13 augustss if (LIST_FIRST(&iface->pipes) != 0)
674 1.13 augustss return (USBD_IN_USE);
675 1.13 augustss
676 1.16 augustss if (iface->endpoints)
677 1.16 augustss free(iface->endpoints, M_USB);
678 1.13 augustss iface->endpoints = 0;
679 1.13 augustss iface->idesc = 0;
680 1.13 augustss
681 1.48 augustss err = usbd_fill_iface_data(iface->device, iface->index, altidx);
682 1.48 augustss if (err)
683 1.48 augustss return (err);
684 1.3 augustss
685 1.3 augustss req.bmRequestType = UT_WRITE_INTERFACE;
686 1.3 augustss req.bRequest = UR_SET_INTERFACE;
687 1.13 augustss USETW(req.wValue, iface->idesc->bAlternateSetting);
688 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
689 1.3 augustss USETW(req.wLength, 0);
690 1.48 augustss return (usbd_do_request(iface->device, &req, 0));
691 1.12 augustss }
692 1.12 augustss
693 1.12 augustss int
694 1.13 augustss usbd_get_no_alts(cdesc, ifaceno)
695 1.13 augustss usb_config_descriptor_t *cdesc;
696 1.13 augustss int ifaceno;
697 1.12 augustss {
698 1.13 augustss char *p = (char *)cdesc;
699 1.13 augustss char *end = p + UGETW(cdesc->wTotalLength);
700 1.12 augustss usb_interface_descriptor_t *d;
701 1.12 augustss int n;
702 1.12 augustss
703 1.12 augustss for (n = 0; p < end; p += d->bLength) {
704 1.12 augustss d = (usb_interface_descriptor_t *)p;
705 1.12 augustss if (p + d->bLength <= end &&
706 1.12 augustss d->bDescriptorType == UDESC_INTERFACE &&
707 1.13 augustss d->bInterfaceNumber == ifaceno)
708 1.12 augustss n++;
709 1.12 augustss }
710 1.12 augustss return (n);
711 1.13 augustss }
712 1.13 augustss
713 1.13 augustss int
714 1.13 augustss usbd_get_interface_altindex(iface)
715 1.13 augustss usbd_interface_handle iface;
716 1.13 augustss {
717 1.13 augustss return (iface->altindex);
718 1.12 augustss }
719 1.12 augustss
720 1.12 augustss usbd_status
721 1.12 augustss usbd_get_interface(iface, aiface)
722 1.12 augustss usbd_interface_handle iface;
723 1.12 augustss u_int8_t *aiface;
724 1.12 augustss {
725 1.12 augustss usb_device_request_t req;
726 1.12 augustss
727 1.12 augustss req.bmRequestType = UT_READ_INTERFACE;
728 1.12 augustss req.bRequest = UR_GET_INTERFACE;
729 1.12 augustss USETW(req.wValue, 0);
730 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
731 1.12 augustss USETW(req.wLength, 1);
732 1.48 augustss return (usbd_do_request(iface->device, &req, aiface));
733 1.3 augustss }
734 1.1 augustss
735 1.1 augustss /*** Internal routines ***/
736 1.1 augustss
737 1.1 augustss /* Dequeue all pipe operations, called at splusb(). */
738 1.1 augustss static usbd_status
739 1.1 augustss usbd_ar_pipe(pipe)
740 1.1 augustss usbd_pipe_handle pipe;
741 1.1 augustss {
742 1.48 augustss usbd_xfer_handle xfer;
743 1.1 augustss
744 1.40 augustss SPLUSBCHECK;
745 1.40 augustss
746 1.25 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p\n", pipe));
747 1.28 augustss #ifdef USB_DEBUG
748 1.28 augustss if (usbdebug > 5)
749 1.28 augustss usbd_dump_queue(pipe);
750 1.28 augustss #endif
751 1.47 augustss pipe->repeat = 0;
752 1.48 augustss while ((xfer = SIMPLEQ_FIRST(&pipe->queue)) != NULL) {
753 1.48 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p xfer=%p (methods=%p)\n",
754 1.48 augustss pipe, xfer, pipe->methods));
755 1.28 augustss /* Make the HC abort it (and invoke the callback). */
756 1.48 augustss pipe->methods->abort(xfer);
757 1.33 augustss /* XXX only for non-0 usbd_clear_endpoint_stall(pipe); */
758 1.20 augustss }
759 1.1 augustss return (USBD_NORMAL_COMPLETION);
760 1.1 augustss }
761 1.1 augustss
762 1.40 augustss /* Called at splusb() */
763 1.31 augustss void
764 1.48 augustss usb_transfer_complete(xfer)
765 1.48 augustss usbd_xfer_handle xfer;
766 1.1 augustss {
767 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
768 1.48 augustss usb_dma_t *dmap = &xfer->dmabuf;
769 1.47 augustss int repeat = pipe->repeat;
770 1.31 augustss int polling;
771 1.31 augustss
772 1.40 augustss SPLUSBCHECK;
773 1.40 augustss
774 1.48 augustss DPRINTFN(5, ("usb_transfer_complete: pipe=%p xfer=%p status=%d "
775 1.48 augustss "actlen=%d\n", pipe, xfer, xfer->status, xfer->actlen));
776 1.5 augustss
777 1.23 augustss #ifdef DIAGNOSTIC
778 1.48 augustss if (pipe == NULL) {
779 1.48 augustss printf("usbd_transfer_cb: pipe==0, xfer=%p\n", xfer);
780 1.31 augustss return;
781 1.31 augustss }
782 1.23 augustss #endif
783 1.37 augustss polling = pipe->device->bus->use_polling;
784 1.31 augustss /* XXXX */
785 1.31 augustss if (polling)
786 1.31 augustss pipe->running = 0;
787 1.31 augustss
788 1.48 augustss if (!(xfer->flags & USBD_NO_COPY) && xfer->actlen != 0 &&
789 1.48 augustss usbd_xfer_isread(xfer)) {
790 1.43 augustss #ifdef DIAGNOSTIC
791 1.48 augustss if (xfer->actlen > xfer->length) {
792 1.43 augustss printf("usb_transfer_complete: actlen > len %d > %d\n",
793 1.48 augustss xfer->actlen, xfer->length);
794 1.48 augustss xfer->actlen = xfer->length;
795 1.43 augustss }
796 1.43 augustss #endif
797 1.48 augustss memcpy(xfer->buffer, KERNADDR(dmap), xfer->actlen);
798 1.43 augustss }
799 1.38 augustss
800 1.37 augustss /* if we allocated the buffer in usbd_transfer() we free it here. */
801 1.48 augustss if (xfer->rqflags & URQ_AUTO_DMABUF) {
802 1.47 augustss if (!repeat) {
803 1.37 augustss struct usbd_bus *bus = pipe->device->bus;
804 1.37 augustss bus->methods->freem(bus, dmap);
805 1.48 augustss xfer->rqflags &= ~URQ_AUTO_DMABUF;
806 1.37 augustss }
807 1.37 augustss }
808 1.37 augustss
809 1.48 augustss if (pipe->methods->done != NULL)
810 1.48 augustss pipe->methods->done(xfer);
811 1.31 augustss
812 1.47 augustss if (!repeat) {
813 1.47 augustss /* Remove request from queue. */
814 1.47 augustss #ifdef DIAGNOSTIC
815 1.48 augustss if (xfer != SIMPLEQ_FIRST(&pipe->queue))
816 1.47 augustss printf("usb_transfer_complete: bad dequeue %p != %p\n",
817 1.48 augustss xfer, SIMPLEQ_FIRST(&pipe->queue));
818 1.45 augustss #endif
819 1.48 augustss SIMPLEQ_REMOVE_HEAD(&pipe->queue, xfer, next);
820 1.47 augustss }
821 1.31 augustss
822 1.31 augustss /* Count completed transfers. */
823 1.5 augustss ++pipe->device->bus->stats.requests
824 1.5 augustss [pipe->endpoint->edesc->bmAttributes & UE_XFERTYPE];
825 1.1 augustss
826 1.48 augustss xfer->done = 1;
827 1.52 augustss if (!xfer->status && xfer->actlen < xfer->length &&
828 1.48 augustss !(xfer->flags & USBD_SHORT_XFER_OK)) {
829 1.48 augustss DPRINTFN(-1,("usbd_transfer_cb: short transfer %d<%d\n",
830 1.48 augustss xfer->actlen, xfer->length));
831 1.48 augustss xfer->status = USBD_SHORT_XFER;
832 1.1 augustss }
833 1.31 augustss
834 1.48 augustss if (xfer->callback)
835 1.48 augustss xfer->callback(xfer, xfer->priv, xfer->status);
836 1.31 augustss
837 1.48 augustss if ((xfer->flags & USBD_SYNCHRONOUS) && !polling)
838 1.48 augustss wakeup(xfer);
839 1.31 augustss
840 1.47 augustss if (!repeat) {
841 1.40 augustss /* XXX should we stop the queue on all errors? */
842 1.48 augustss if (xfer->status == USBD_CANCELLED ||
843 1.48 augustss xfer->status == USBD_TIMEOUT)
844 1.40 augustss pipe->running = 0;
845 1.40 augustss else
846 1.40 augustss usbd_start_next(pipe);
847 1.40 augustss }
848 1.1 augustss }
849 1.1 augustss
850 1.31 augustss usbd_status
851 1.48 augustss usb_insert_transfer(xfer)
852 1.48 augustss usbd_xfer_handle xfer;
853 1.1 augustss {
854 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
855 1.48 augustss usbd_status err;
856 1.37 augustss int s;
857 1.31 augustss
858 1.40 augustss DPRINTFN(5,("usb_insert_transfer: pipe=%p running=%d timeout=%d\n",
859 1.48 augustss pipe, pipe->running, xfer->timeout));
860 1.37 augustss s = splusb();
861 1.48 augustss SIMPLEQ_INSERT_TAIL(&pipe->queue, xfer, next);
862 1.31 augustss if (pipe->running)
863 1.48 augustss err = USBD_IN_PROGRESS;
864 1.37 augustss else {
865 1.37 augustss pipe->running = 1;
866 1.48 augustss err = USBD_NORMAL_COMPLETION;
867 1.37 augustss }
868 1.37 augustss splx(s);
869 1.48 augustss return (err);
870 1.1 augustss }
871 1.1 augustss
872 1.40 augustss /* Called at splusb() */
873 1.31 augustss void
874 1.31 augustss usbd_start_next(pipe)
875 1.31 augustss usbd_pipe_handle pipe;
876 1.31 augustss {
877 1.48 augustss usbd_xfer_handle xfer;
878 1.48 augustss usbd_status err;
879 1.40 augustss
880 1.40 augustss SPLUSBCHECK;
881 1.1 augustss
882 1.31 augustss #ifdef DIAGNOSTIC
883 1.48 augustss if (pipe == NULL) {
884 1.51 augustss printf("usbd_start_next: pipe == NULL\n");
885 1.31 augustss return;
886 1.31 augustss }
887 1.48 augustss if (pipe->methods == NULL || pipe->methods->start == NULL) {
888 1.51 augustss printf("usbd_start_next: pipe=%p no start method\n", pipe);
889 1.31 augustss return;
890 1.31 augustss }
891 1.31 augustss #endif
892 1.31 augustss
893 1.31 augustss /* Get next request in queue. */
894 1.48 augustss xfer = SIMPLEQ_FIRST(&pipe->queue);
895 1.51 augustss DPRINTFN(5, ("usbd_start_next: pipe=%p, xfer=%p\n", pipe, xfer));
896 1.51 augustss if (xfer == NULL) {
897 1.31 augustss pipe->running = 0;
898 1.51 augustss } else {
899 1.48 augustss err = pipe->methods->start(xfer);
900 1.48 augustss if (err != USBD_IN_PROGRESS) {
901 1.48 augustss printf("usbd_start_next: error=%d\n", err);
902 1.31 augustss pipe->running = 0;
903 1.31 augustss /* XXX do what? */
904 1.31 augustss }
905 1.1 augustss }
906 1.1 augustss }
907 1.1 augustss
908 1.1 augustss usbd_status
909 1.1 augustss usbd_do_request(dev, req, data)
910 1.1 augustss usbd_device_handle dev;
911 1.1 augustss usb_device_request_t *req;
912 1.1 augustss void *data;
913 1.1 augustss {
914 1.19 augustss return (usbd_do_request_flags(dev, req, data, 0, 0));
915 1.17 augustss }
916 1.17 augustss
917 1.17 augustss usbd_status
918 1.19 augustss usbd_do_request_flags(dev, req, data, flags, actlen)
919 1.17 augustss usbd_device_handle dev;
920 1.17 augustss usb_device_request_t *req;
921 1.17 augustss void *data;
922 1.17 augustss u_int16_t flags;
923 1.19 augustss int *actlen;
924 1.17 augustss {
925 1.48 augustss usbd_xfer_handle xfer;
926 1.48 augustss usbd_status err;
927 1.1 augustss
928 1.7 augustss #ifdef DIAGNOSTIC
929 1.51 augustss #if defined(__i386__) && defined(__FreeBSD__)
930 1.51 augustss KASSERT(intr_nesting_level == 0,
931 1.51 augustss ("ohci_abort_req in interrupt context"));
932 1.51 augustss #endif
933 1.39 augustss if (dev->bus->intr_context) {
934 1.7 augustss printf("usbd_do_request: not in process context\n");
935 1.37 augustss return (USBD_INVAL);
936 1.7 augustss }
937 1.7 augustss #endif
938 1.7 augustss
939 1.50 augustss xfer = usbd_alloc_xfer(dev);
940 1.48 augustss if (xfer == NULL)
941 1.1 augustss return (USBD_NOMEM);
942 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
943 1.37 augustss data, UGETW(req->wLength), flags, 0);
944 1.48 augustss err = usbd_sync_transfer(xfer);
945 1.1 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
946 1.48 augustss if (xfer->actlen > xfer->length)
947 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
948 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
949 1.48 augustss dev->address, xfer->request.bmRequestType,
950 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
951 1.48 augustss UGETW(xfer->request.wIndex),
952 1.48 augustss UGETW(xfer->request.wLength),
953 1.48 augustss xfer->length, xfer->actlen));
954 1.1 augustss #endif
955 1.48 augustss if (actlen != NULL)
956 1.48 augustss *actlen = xfer->actlen;
957 1.48 augustss if (err == USBD_STALLED) {
958 1.15 augustss /*
959 1.15 augustss * The control endpoint has stalled. Control endpoints
960 1.15 augustss * should not halt, but some may do so anyway so clear
961 1.15 augustss * any halt condition.
962 1.15 augustss */
963 1.15 augustss usb_device_request_t treq;
964 1.15 augustss usb_status_t status;
965 1.15 augustss u_int16_t s;
966 1.48 augustss usbd_status nerr;
967 1.15 augustss
968 1.15 augustss treq.bmRequestType = UT_READ_ENDPOINT;
969 1.15 augustss treq.bRequest = UR_GET_STATUS;
970 1.15 augustss USETW(treq.wValue, 0);
971 1.15 augustss USETW(treq.wIndex, 0);
972 1.15 augustss USETW(treq.wLength, sizeof(usb_status_t));
973 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
974 1.37 augustss &treq, &status,sizeof(usb_status_t),
975 1.36 augustss 0, 0);
976 1.48 augustss nerr = usbd_sync_transfer(xfer);
977 1.48 augustss if (nerr)
978 1.15 augustss goto bad;
979 1.15 augustss s = UGETW(status.wStatus);
980 1.15 augustss DPRINTF(("usbd_do_request: status = 0x%04x\n", s));
981 1.15 augustss if (!(s & UES_HALT))
982 1.15 augustss goto bad;
983 1.15 augustss treq.bmRequestType = UT_WRITE_ENDPOINT;
984 1.15 augustss treq.bRequest = UR_CLEAR_FEATURE;
985 1.15 augustss USETW(treq.wValue, UF_ENDPOINT_HALT);
986 1.15 augustss USETW(treq.wIndex, 0);
987 1.15 augustss USETW(treq.wLength, 0);
988 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
989 1.36 augustss &treq, &status, 0, 0, 0);
990 1.48 augustss nerr = usbd_sync_transfer(xfer);
991 1.48 augustss if (nerr)
992 1.15 augustss goto bad;
993 1.15 augustss }
994 1.15 augustss
995 1.15 augustss bad:
996 1.50 augustss usbd_free_xfer(xfer);
997 1.48 augustss return (err);
998 1.7 augustss }
999 1.7 augustss
1000 1.7 augustss void
1001 1.48 augustss usbd_do_request_async_cb(xfer, priv, status)
1002 1.48 augustss usbd_xfer_handle xfer;
1003 1.7 augustss usbd_private_handle priv;
1004 1.7 augustss usbd_status status;
1005 1.7 augustss {
1006 1.7 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
1007 1.48 augustss if (xfer->actlen > xfer->length)
1008 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
1009 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
1010 1.48 augustss xfer->pipe->device->address,
1011 1.48 augustss xfer->request.bmRequestType,
1012 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
1013 1.48 augustss UGETW(xfer->request.wIndex),
1014 1.48 augustss UGETW(xfer->request.wLength),
1015 1.48 augustss xfer->length, xfer->actlen));
1016 1.7 augustss #endif
1017 1.50 augustss usbd_free_xfer(xfer);
1018 1.7 augustss }
1019 1.7 augustss
1020 1.7 augustss /*
1021 1.7 augustss * Execute a request without waiting for completion.
1022 1.7 augustss * Can be used from interrupt context.
1023 1.7 augustss */
1024 1.7 augustss usbd_status
1025 1.7 augustss usbd_do_request_async(dev, req, data)
1026 1.7 augustss usbd_device_handle dev;
1027 1.7 augustss usb_device_request_t *req;
1028 1.7 augustss void *data;
1029 1.7 augustss {
1030 1.48 augustss usbd_xfer_handle xfer;
1031 1.48 augustss usbd_status err;
1032 1.7 augustss
1033 1.50 augustss xfer = usbd_alloc_xfer(dev);
1034 1.49 augustss if (xfer == NULL)
1035 1.7 augustss return (USBD_NOMEM);
1036 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
1037 1.48 augustss data, UGETW(req->wLength), 0, usbd_do_request_async_cb);
1038 1.48 augustss err = usbd_transfer(xfer);
1039 1.48 augustss if (err != USBD_IN_PROGRESS) {
1040 1.50 augustss usbd_free_xfer(xfer);
1041 1.48 augustss return (err);
1042 1.7 augustss }
1043 1.7 augustss return (USBD_NORMAL_COMPLETION);
1044 1.1 augustss }
1045 1.1 augustss
1046 1.1 augustss struct usbd_quirks *
1047 1.1 augustss usbd_get_quirks(dev)
1048 1.1 augustss usbd_device_handle dev;
1049 1.1 augustss {
1050 1.1 augustss return (dev->quirks);
1051 1.1 augustss }
1052 1.1 augustss
1053 1.1 augustss /* XXX do periodic free() of free list */
1054 1.1 augustss
1055 1.6 augustss /*
1056 1.6 augustss * Called from keyboard driver when in polling mode.
1057 1.6 augustss */
1058 1.6 augustss void
1059 1.6 augustss usbd_dopoll(iface)
1060 1.6 augustss usbd_interface_handle iface;
1061 1.6 augustss {
1062 1.36 augustss iface->device->bus->methods->do_poll(iface->device->bus);
1063 1.8 augustss }
1064 1.8 augustss
1065 1.8 augustss void
1066 1.54 augustss usbd_set_polling(dev, on)
1067 1.54 augustss usbd_device_handle dev;
1068 1.8 augustss int on;
1069 1.8 augustss {
1070 1.42 augustss if (on)
1071 1.54 augustss dev->bus->use_polling++;
1072 1.42 augustss else
1073 1.54 augustss dev->bus->use_polling--;
1074 1.6 augustss }
1075 1.12 augustss
1076 1.12 augustss
1077 1.12 augustss usb_endpoint_descriptor_t *
1078 1.12 augustss usbd_get_endpoint_descriptor(iface, address)
1079 1.12 augustss usbd_interface_handle iface;
1080 1.12 augustss u_int8_t address;
1081 1.12 augustss {
1082 1.12 augustss struct usbd_endpoint *ep;
1083 1.12 augustss int i;
1084 1.12 augustss
1085 1.12 augustss for (i = 0; i < iface->idesc->bNumEndpoints; i++) {
1086 1.12 augustss ep = &iface->endpoints[i];
1087 1.12 augustss if (ep->edesc->bEndpointAddress == address)
1088 1.12 augustss return (iface->endpoints[i].edesc);
1089 1.12 augustss }
1090 1.12 augustss return (0);
1091 1.12 augustss }
1092 1.12 augustss
1093 1.20 augustss #if defined(__FreeBSD__)
1094 1.20 augustss int
1095 1.20 augustss usbd_driver_load(module_t mod, int what, void *arg)
1096 1.20 augustss {
1097 1.45 augustss /* XXX should implement something like a function that removes all generic devices */
1098 1.45 augustss
1099 1.48 augustss return (0);
1100 1.20 augustss }
1101 1.20 augustss
1102 1.20 augustss #endif
1103