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