usbdi.c revision 1.61 1 1.61 augustss /* $NetBSD: usbdi.c,v 1.61 2000/01/31 20:13:07 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.61 augustss void usbd_clear_endpoint_toggle(usbd_pipe_handle pipe); /* XXXXX */
611 1.61 augustss void
612 1.61 augustss usbd_clear_endpoint_toggle(pipe)
613 1.61 augustss usbd_pipe_handle pipe;
614 1.61 augustss {
615 1.61 augustss pipe->methods->cleartoggle(pipe);
616 1.61 augustss }
617 1.61 augustss
618 1.7 augustss usbd_status
619 1.1 augustss usbd_endpoint_count(iface, count)
620 1.1 augustss usbd_interface_handle iface;
621 1.1 augustss u_int8_t *count;
622 1.1 augustss {
623 1.1 augustss *count = iface->idesc->bNumEndpoints;
624 1.1 augustss return (USBD_NORMAL_COMPLETION);
625 1.1 augustss }
626 1.1 augustss
627 1.1 augustss usbd_status
628 1.1 augustss usbd_interface_count(dev, count)
629 1.1 augustss usbd_device_handle dev;
630 1.1 augustss u_int8_t *count;
631 1.1 augustss {
632 1.48 augustss if (dev->cdesc == NULL)
633 1.1 augustss return (USBD_NOT_CONFIGURED);
634 1.1 augustss *count = dev->cdesc->bNumInterface;
635 1.1 augustss return (USBD_NORMAL_COMPLETION);
636 1.1 augustss }
637 1.1 augustss
638 1.1 augustss usbd_status
639 1.1 augustss usbd_interface2device_handle(iface, dev)
640 1.1 augustss usbd_interface_handle iface;
641 1.1 augustss usbd_device_handle *dev;
642 1.1 augustss {
643 1.1 augustss *dev = iface->device;
644 1.1 augustss return (USBD_NORMAL_COMPLETION);
645 1.1 augustss }
646 1.1 augustss
647 1.1 augustss usbd_status
648 1.1 augustss usbd_device2interface_handle(dev, ifaceno, iface)
649 1.1 augustss usbd_device_handle dev;
650 1.1 augustss u_int8_t ifaceno;
651 1.1 augustss usbd_interface_handle *iface;
652 1.1 augustss {
653 1.48 augustss if (dev->cdesc == NULL)
654 1.1 augustss return (USBD_NOT_CONFIGURED);
655 1.1 augustss if (ifaceno >= dev->cdesc->bNumInterface)
656 1.1 augustss return (USBD_INVAL);
657 1.1 augustss *iface = &dev->ifaces[ifaceno];
658 1.1 augustss return (USBD_NORMAL_COMPLETION);
659 1.1 augustss }
660 1.1 augustss
661 1.36 augustss usbd_device_handle
662 1.36 augustss usbd_pipe2device_handle(pipe)
663 1.36 augustss usbd_pipe_handle pipe;
664 1.36 augustss {
665 1.36 augustss return (pipe->device);
666 1.36 augustss }
667 1.36 augustss
668 1.13 augustss /* XXXX use altno */
669 1.3 augustss usbd_status
670 1.13 augustss usbd_set_interface(iface, altidx)
671 1.3 augustss usbd_interface_handle iface;
672 1.13 augustss int altidx;
673 1.3 augustss {
674 1.3 augustss usb_device_request_t req;
675 1.48 augustss usbd_status err;
676 1.13 augustss
677 1.13 augustss if (LIST_FIRST(&iface->pipes) != 0)
678 1.13 augustss return (USBD_IN_USE);
679 1.13 augustss
680 1.16 augustss if (iface->endpoints)
681 1.16 augustss free(iface->endpoints, M_USB);
682 1.13 augustss iface->endpoints = 0;
683 1.13 augustss iface->idesc = 0;
684 1.13 augustss
685 1.48 augustss err = usbd_fill_iface_data(iface->device, iface->index, altidx);
686 1.48 augustss if (err)
687 1.48 augustss return (err);
688 1.3 augustss
689 1.3 augustss req.bmRequestType = UT_WRITE_INTERFACE;
690 1.3 augustss req.bRequest = UR_SET_INTERFACE;
691 1.13 augustss USETW(req.wValue, iface->idesc->bAlternateSetting);
692 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
693 1.3 augustss USETW(req.wLength, 0);
694 1.48 augustss return (usbd_do_request(iface->device, &req, 0));
695 1.12 augustss }
696 1.12 augustss
697 1.12 augustss int
698 1.13 augustss usbd_get_no_alts(cdesc, ifaceno)
699 1.13 augustss usb_config_descriptor_t *cdesc;
700 1.13 augustss int ifaceno;
701 1.12 augustss {
702 1.13 augustss char *p = (char *)cdesc;
703 1.13 augustss char *end = p + UGETW(cdesc->wTotalLength);
704 1.12 augustss usb_interface_descriptor_t *d;
705 1.12 augustss int n;
706 1.12 augustss
707 1.12 augustss for (n = 0; p < end; p += d->bLength) {
708 1.12 augustss d = (usb_interface_descriptor_t *)p;
709 1.12 augustss if (p + d->bLength <= end &&
710 1.12 augustss d->bDescriptorType == UDESC_INTERFACE &&
711 1.13 augustss d->bInterfaceNumber == ifaceno)
712 1.12 augustss n++;
713 1.12 augustss }
714 1.12 augustss return (n);
715 1.13 augustss }
716 1.13 augustss
717 1.13 augustss int
718 1.13 augustss usbd_get_interface_altindex(iface)
719 1.13 augustss usbd_interface_handle iface;
720 1.13 augustss {
721 1.13 augustss return (iface->altindex);
722 1.12 augustss }
723 1.12 augustss
724 1.12 augustss usbd_status
725 1.12 augustss usbd_get_interface(iface, aiface)
726 1.12 augustss usbd_interface_handle iface;
727 1.12 augustss u_int8_t *aiface;
728 1.12 augustss {
729 1.12 augustss usb_device_request_t req;
730 1.12 augustss
731 1.12 augustss req.bmRequestType = UT_READ_INTERFACE;
732 1.12 augustss req.bRequest = UR_GET_INTERFACE;
733 1.12 augustss USETW(req.wValue, 0);
734 1.16 augustss USETW(req.wIndex, iface->idesc->bInterfaceNumber);
735 1.12 augustss USETW(req.wLength, 1);
736 1.48 augustss return (usbd_do_request(iface->device, &req, aiface));
737 1.3 augustss }
738 1.1 augustss
739 1.1 augustss /*** Internal routines ***/
740 1.1 augustss
741 1.1 augustss /* Dequeue all pipe operations, called at splusb(). */
742 1.1 augustss static usbd_status
743 1.1 augustss usbd_ar_pipe(pipe)
744 1.1 augustss usbd_pipe_handle pipe;
745 1.1 augustss {
746 1.48 augustss usbd_xfer_handle xfer;
747 1.1 augustss
748 1.40 augustss SPLUSBCHECK;
749 1.40 augustss
750 1.25 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p\n", pipe));
751 1.28 augustss #ifdef USB_DEBUG
752 1.28 augustss if (usbdebug > 5)
753 1.28 augustss usbd_dump_queue(pipe);
754 1.28 augustss #endif
755 1.47 augustss pipe->repeat = 0;
756 1.48 augustss while ((xfer = SIMPLEQ_FIRST(&pipe->queue)) != NULL) {
757 1.48 augustss DPRINTFN(2,("usbd_ar_pipe: pipe=%p xfer=%p (methods=%p)\n",
758 1.48 augustss pipe, xfer, pipe->methods));
759 1.28 augustss /* Make the HC abort it (and invoke the callback). */
760 1.48 augustss pipe->methods->abort(xfer);
761 1.33 augustss /* XXX only for non-0 usbd_clear_endpoint_stall(pipe); */
762 1.20 augustss }
763 1.1 augustss return (USBD_NORMAL_COMPLETION);
764 1.1 augustss }
765 1.1 augustss
766 1.40 augustss /* Called at splusb() */
767 1.31 augustss void
768 1.48 augustss usb_transfer_complete(xfer)
769 1.48 augustss usbd_xfer_handle xfer;
770 1.1 augustss {
771 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
772 1.48 augustss usb_dma_t *dmap = &xfer->dmabuf;
773 1.47 augustss int repeat = pipe->repeat;
774 1.31 augustss int polling;
775 1.31 augustss
776 1.40 augustss SPLUSBCHECK;
777 1.40 augustss
778 1.48 augustss DPRINTFN(5, ("usb_transfer_complete: pipe=%p xfer=%p status=%d "
779 1.48 augustss "actlen=%d\n", pipe, xfer, xfer->status, xfer->actlen));
780 1.5 augustss
781 1.23 augustss #ifdef DIAGNOSTIC
782 1.48 augustss if (pipe == NULL) {
783 1.48 augustss printf("usbd_transfer_cb: pipe==0, xfer=%p\n", xfer);
784 1.31 augustss return;
785 1.31 augustss }
786 1.23 augustss #endif
787 1.37 augustss polling = pipe->device->bus->use_polling;
788 1.31 augustss /* XXXX */
789 1.31 augustss if (polling)
790 1.31 augustss pipe->running = 0;
791 1.31 augustss
792 1.48 augustss if (!(xfer->flags & USBD_NO_COPY) && xfer->actlen != 0 &&
793 1.48 augustss usbd_xfer_isread(xfer)) {
794 1.43 augustss #ifdef DIAGNOSTIC
795 1.48 augustss if (xfer->actlen > xfer->length) {
796 1.43 augustss printf("usb_transfer_complete: actlen > len %d > %d\n",
797 1.48 augustss xfer->actlen, xfer->length);
798 1.48 augustss xfer->actlen = xfer->length;
799 1.43 augustss }
800 1.43 augustss #endif
801 1.48 augustss memcpy(xfer->buffer, KERNADDR(dmap), xfer->actlen);
802 1.43 augustss }
803 1.38 augustss
804 1.37 augustss /* if we allocated the buffer in usbd_transfer() we free it here. */
805 1.48 augustss if (xfer->rqflags & URQ_AUTO_DMABUF) {
806 1.47 augustss if (!repeat) {
807 1.37 augustss struct usbd_bus *bus = pipe->device->bus;
808 1.37 augustss bus->methods->freem(bus, dmap);
809 1.48 augustss xfer->rqflags &= ~URQ_AUTO_DMABUF;
810 1.37 augustss }
811 1.37 augustss }
812 1.37 augustss
813 1.47 augustss if (!repeat) {
814 1.47 augustss /* Remove request from queue. */
815 1.47 augustss #ifdef DIAGNOSTIC
816 1.48 augustss if (xfer != SIMPLEQ_FIRST(&pipe->queue))
817 1.47 augustss printf("usb_transfer_complete: bad dequeue %p != %p\n",
818 1.48 augustss xfer, SIMPLEQ_FIRST(&pipe->queue));
819 1.45 augustss #endif
820 1.48 augustss SIMPLEQ_REMOVE_HEAD(&pipe->queue, xfer, next);
821 1.47 augustss }
822 1.61 augustss DPRINTFN(5,("usb_transfer_complete: repeat=%d new head=%p\n",
823 1.61 augustss repeat, SIMPLEQ_FIRST(&pipe->queue)));
824 1.31 augustss
825 1.31 augustss /* Count completed transfers. */
826 1.5 augustss ++pipe->device->bus->stats.requests
827 1.5 augustss [pipe->endpoint->edesc->bmAttributes & UE_XFERTYPE];
828 1.1 augustss
829 1.48 augustss xfer->done = 1;
830 1.52 augustss if (!xfer->status && xfer->actlen < xfer->length &&
831 1.48 augustss !(xfer->flags & USBD_SHORT_XFER_OK)) {
832 1.48 augustss DPRINTFN(-1,("usbd_transfer_cb: short transfer %d<%d\n",
833 1.48 augustss xfer->actlen, xfer->length));
834 1.48 augustss xfer->status = USBD_SHORT_XFER;
835 1.1 augustss }
836 1.31 augustss
837 1.48 augustss if (xfer->callback)
838 1.48 augustss xfer->callback(xfer, xfer->priv, xfer->status);
839 1.61 augustss
840 1.61 augustss #ifdef DIAGNOSTIC
841 1.61 augustss if (pipe->methods->done != NULL)
842 1.61 augustss pipe->methods->done(xfer);
843 1.61 augustss else
844 1.61 augustss printf("usb_transfer_complete: pipe->methods->done == NULL\n");
845 1.61 augustss #else
846 1.61 augustss pipe->methods->done(xfer);
847 1.61 augustss #endif
848 1.31 augustss
849 1.48 augustss if ((xfer->flags & USBD_SYNCHRONOUS) && !polling)
850 1.48 augustss wakeup(xfer);
851 1.31 augustss
852 1.47 augustss if (!repeat) {
853 1.40 augustss /* XXX should we stop the queue on all errors? */
854 1.48 augustss if (xfer->status == USBD_CANCELLED ||
855 1.48 augustss xfer->status == USBD_TIMEOUT)
856 1.40 augustss pipe->running = 0;
857 1.40 augustss else
858 1.40 augustss usbd_start_next(pipe);
859 1.40 augustss }
860 1.1 augustss }
861 1.1 augustss
862 1.31 augustss usbd_status
863 1.48 augustss usb_insert_transfer(xfer)
864 1.48 augustss usbd_xfer_handle xfer;
865 1.1 augustss {
866 1.48 augustss usbd_pipe_handle pipe = xfer->pipe;
867 1.48 augustss usbd_status err;
868 1.37 augustss int s;
869 1.31 augustss
870 1.40 augustss DPRINTFN(5,("usb_insert_transfer: pipe=%p running=%d timeout=%d\n",
871 1.48 augustss pipe, pipe->running, xfer->timeout));
872 1.37 augustss s = splusb();
873 1.48 augustss SIMPLEQ_INSERT_TAIL(&pipe->queue, xfer, next);
874 1.31 augustss if (pipe->running)
875 1.48 augustss err = USBD_IN_PROGRESS;
876 1.37 augustss else {
877 1.37 augustss pipe->running = 1;
878 1.48 augustss err = USBD_NORMAL_COMPLETION;
879 1.37 augustss }
880 1.37 augustss splx(s);
881 1.48 augustss return (err);
882 1.1 augustss }
883 1.1 augustss
884 1.40 augustss /* Called at splusb() */
885 1.31 augustss void
886 1.31 augustss usbd_start_next(pipe)
887 1.31 augustss usbd_pipe_handle pipe;
888 1.31 augustss {
889 1.48 augustss usbd_xfer_handle xfer;
890 1.48 augustss usbd_status err;
891 1.40 augustss
892 1.40 augustss SPLUSBCHECK;
893 1.1 augustss
894 1.31 augustss #ifdef DIAGNOSTIC
895 1.48 augustss if (pipe == NULL) {
896 1.51 augustss printf("usbd_start_next: pipe == NULL\n");
897 1.31 augustss return;
898 1.31 augustss }
899 1.48 augustss if (pipe->methods == NULL || pipe->methods->start == NULL) {
900 1.51 augustss printf("usbd_start_next: pipe=%p no start method\n", pipe);
901 1.31 augustss return;
902 1.31 augustss }
903 1.31 augustss #endif
904 1.31 augustss
905 1.31 augustss /* Get next request in queue. */
906 1.48 augustss xfer = SIMPLEQ_FIRST(&pipe->queue);
907 1.51 augustss DPRINTFN(5, ("usbd_start_next: pipe=%p, xfer=%p\n", pipe, xfer));
908 1.51 augustss if (xfer == NULL) {
909 1.31 augustss pipe->running = 0;
910 1.51 augustss } else {
911 1.48 augustss err = pipe->methods->start(xfer);
912 1.48 augustss if (err != USBD_IN_PROGRESS) {
913 1.48 augustss printf("usbd_start_next: error=%d\n", err);
914 1.31 augustss pipe->running = 0;
915 1.31 augustss /* XXX do what? */
916 1.31 augustss }
917 1.1 augustss }
918 1.1 augustss }
919 1.1 augustss
920 1.1 augustss usbd_status
921 1.1 augustss usbd_do_request(dev, req, data)
922 1.1 augustss usbd_device_handle dev;
923 1.1 augustss usb_device_request_t *req;
924 1.1 augustss void *data;
925 1.1 augustss {
926 1.19 augustss return (usbd_do_request_flags(dev, req, data, 0, 0));
927 1.17 augustss }
928 1.17 augustss
929 1.17 augustss usbd_status
930 1.19 augustss usbd_do_request_flags(dev, req, data, flags, actlen)
931 1.17 augustss usbd_device_handle dev;
932 1.17 augustss usb_device_request_t *req;
933 1.17 augustss void *data;
934 1.17 augustss u_int16_t flags;
935 1.19 augustss int *actlen;
936 1.17 augustss {
937 1.48 augustss usbd_xfer_handle xfer;
938 1.48 augustss usbd_status err;
939 1.1 augustss
940 1.7 augustss #ifdef DIAGNOSTIC
941 1.51 augustss #if defined(__i386__) && defined(__FreeBSD__)
942 1.51 augustss KASSERT(intr_nesting_level == 0,
943 1.51 augustss ("ohci_abort_req in interrupt context"));
944 1.51 augustss #endif
945 1.39 augustss if (dev->bus->intr_context) {
946 1.7 augustss printf("usbd_do_request: not in process context\n");
947 1.37 augustss return (USBD_INVAL);
948 1.7 augustss }
949 1.7 augustss #endif
950 1.7 augustss
951 1.50 augustss xfer = usbd_alloc_xfer(dev);
952 1.48 augustss if (xfer == NULL)
953 1.1 augustss return (USBD_NOMEM);
954 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
955 1.37 augustss data, UGETW(req->wLength), flags, 0);
956 1.48 augustss err = usbd_sync_transfer(xfer);
957 1.1 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
958 1.48 augustss if (xfer->actlen > xfer->length)
959 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
960 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
961 1.48 augustss dev->address, xfer->request.bmRequestType,
962 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
963 1.48 augustss UGETW(xfer->request.wIndex),
964 1.48 augustss UGETW(xfer->request.wLength),
965 1.48 augustss xfer->length, xfer->actlen));
966 1.1 augustss #endif
967 1.48 augustss if (actlen != NULL)
968 1.48 augustss *actlen = xfer->actlen;
969 1.48 augustss if (err == USBD_STALLED) {
970 1.15 augustss /*
971 1.15 augustss * The control endpoint has stalled. Control endpoints
972 1.15 augustss * should not halt, but some may do so anyway so clear
973 1.15 augustss * any halt condition.
974 1.15 augustss */
975 1.15 augustss usb_device_request_t treq;
976 1.15 augustss usb_status_t status;
977 1.15 augustss u_int16_t s;
978 1.48 augustss usbd_status nerr;
979 1.15 augustss
980 1.15 augustss treq.bmRequestType = UT_READ_ENDPOINT;
981 1.15 augustss treq.bRequest = UR_GET_STATUS;
982 1.15 augustss USETW(treq.wValue, 0);
983 1.15 augustss USETW(treq.wIndex, 0);
984 1.15 augustss USETW(treq.wLength, sizeof(usb_status_t));
985 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
986 1.37 augustss &treq, &status,sizeof(usb_status_t),
987 1.36 augustss 0, 0);
988 1.48 augustss nerr = usbd_sync_transfer(xfer);
989 1.48 augustss if (nerr)
990 1.15 augustss goto bad;
991 1.15 augustss s = UGETW(status.wStatus);
992 1.15 augustss DPRINTF(("usbd_do_request: status = 0x%04x\n", s));
993 1.15 augustss if (!(s & UES_HALT))
994 1.15 augustss goto bad;
995 1.15 augustss treq.bmRequestType = UT_WRITE_ENDPOINT;
996 1.15 augustss treq.bRequest = UR_CLEAR_FEATURE;
997 1.15 augustss USETW(treq.wValue, UF_ENDPOINT_HALT);
998 1.15 augustss USETW(treq.wIndex, 0);
999 1.15 augustss USETW(treq.wLength, 0);
1000 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT,
1001 1.36 augustss &treq, &status, 0, 0, 0);
1002 1.48 augustss nerr = usbd_sync_transfer(xfer);
1003 1.48 augustss if (nerr)
1004 1.15 augustss goto bad;
1005 1.15 augustss }
1006 1.15 augustss
1007 1.15 augustss bad:
1008 1.50 augustss usbd_free_xfer(xfer);
1009 1.48 augustss return (err);
1010 1.7 augustss }
1011 1.7 augustss
1012 1.7 augustss void
1013 1.48 augustss usbd_do_request_async_cb(xfer, priv, status)
1014 1.48 augustss usbd_xfer_handle xfer;
1015 1.7 augustss usbd_private_handle priv;
1016 1.7 augustss usbd_status status;
1017 1.7 augustss {
1018 1.7 augustss #if defined(USB_DEBUG) || defined(DIAGNOSTIC)
1019 1.48 augustss if (xfer->actlen > xfer->length)
1020 1.35 augustss DPRINTF(("usbd_do_request: overrun addr=%d type=0x%02x req=0x"
1021 1.35 augustss "%02x val=%d index=%d rlen=%d length=%d actlen=%d\n",
1022 1.48 augustss xfer->pipe->device->address,
1023 1.48 augustss xfer->request.bmRequestType,
1024 1.48 augustss xfer->request.bRequest, UGETW(xfer->request.wValue),
1025 1.48 augustss UGETW(xfer->request.wIndex),
1026 1.48 augustss UGETW(xfer->request.wLength),
1027 1.48 augustss xfer->length, xfer->actlen));
1028 1.7 augustss #endif
1029 1.50 augustss usbd_free_xfer(xfer);
1030 1.7 augustss }
1031 1.7 augustss
1032 1.7 augustss /*
1033 1.7 augustss * Execute a request without waiting for completion.
1034 1.7 augustss * Can be used from interrupt context.
1035 1.7 augustss */
1036 1.7 augustss usbd_status
1037 1.7 augustss usbd_do_request_async(dev, req, data)
1038 1.7 augustss usbd_device_handle dev;
1039 1.7 augustss usb_device_request_t *req;
1040 1.7 augustss void *data;
1041 1.7 augustss {
1042 1.48 augustss usbd_xfer_handle xfer;
1043 1.48 augustss usbd_status err;
1044 1.7 augustss
1045 1.50 augustss xfer = usbd_alloc_xfer(dev);
1046 1.49 augustss if (xfer == NULL)
1047 1.7 augustss return (USBD_NOMEM);
1048 1.50 augustss usbd_setup_default_xfer(xfer, dev, 0, USBD_DEFAULT_TIMEOUT, req,
1049 1.48 augustss data, UGETW(req->wLength), 0, usbd_do_request_async_cb);
1050 1.48 augustss err = usbd_transfer(xfer);
1051 1.48 augustss if (err != USBD_IN_PROGRESS) {
1052 1.50 augustss usbd_free_xfer(xfer);
1053 1.48 augustss return (err);
1054 1.7 augustss }
1055 1.7 augustss return (USBD_NORMAL_COMPLETION);
1056 1.1 augustss }
1057 1.1 augustss
1058 1.1 augustss struct usbd_quirks *
1059 1.1 augustss usbd_get_quirks(dev)
1060 1.1 augustss usbd_device_handle dev;
1061 1.1 augustss {
1062 1.1 augustss return (dev->quirks);
1063 1.1 augustss }
1064 1.1 augustss
1065 1.1 augustss /* XXX do periodic free() of free list */
1066 1.1 augustss
1067 1.6 augustss /*
1068 1.6 augustss * Called from keyboard driver when in polling mode.
1069 1.6 augustss */
1070 1.6 augustss void
1071 1.6 augustss usbd_dopoll(iface)
1072 1.6 augustss usbd_interface_handle iface;
1073 1.6 augustss {
1074 1.36 augustss iface->device->bus->methods->do_poll(iface->device->bus);
1075 1.8 augustss }
1076 1.8 augustss
1077 1.8 augustss void
1078 1.54 augustss usbd_set_polling(dev, on)
1079 1.54 augustss usbd_device_handle dev;
1080 1.8 augustss int on;
1081 1.8 augustss {
1082 1.42 augustss if (on)
1083 1.54 augustss dev->bus->use_polling++;
1084 1.42 augustss else
1085 1.54 augustss dev->bus->use_polling--;
1086 1.6 augustss }
1087 1.12 augustss
1088 1.12 augustss
1089 1.12 augustss usb_endpoint_descriptor_t *
1090 1.12 augustss usbd_get_endpoint_descriptor(iface, address)
1091 1.12 augustss usbd_interface_handle iface;
1092 1.12 augustss u_int8_t address;
1093 1.12 augustss {
1094 1.12 augustss struct usbd_endpoint *ep;
1095 1.12 augustss int i;
1096 1.12 augustss
1097 1.12 augustss for (i = 0; i < iface->idesc->bNumEndpoints; i++) {
1098 1.12 augustss ep = &iface->endpoints[i];
1099 1.12 augustss if (ep->edesc->bEndpointAddress == address)
1100 1.12 augustss return (iface->endpoints[i].edesc);
1101 1.12 augustss }
1102 1.12 augustss return (0);
1103 1.12 augustss }
1104 1.12 augustss
1105 1.20 augustss #if defined(__FreeBSD__)
1106 1.20 augustss int
1107 1.20 augustss usbd_driver_load(module_t mod, int what, void *arg)
1108 1.20 augustss {
1109 1.45 augustss /* XXX should implement something like a function that removes all generic devices */
1110 1.45 augustss
1111 1.48 augustss return (0);
1112 1.20 augustss }
1113 1.20 augustss
1114 1.20 augustss #endif
1115