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