3 * Copyright (c) 2008 Hans Petter Selasky. All rights reserved.
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27 #include <sys/stdint.h>
28 #include <sys/param.h>
29 #include <sys/queue.h>
30 #include <sys/types.h>
31 #include <sys/systm.h>
32 #include <sys/kernel.h>
34 #include <sys/module.h>
36 #include <sys/mutex.h>
37 #include <sys/condvar.h>
38 #include <sys/sysctl.h>
39 #include <sys/unistd.h>
40 #include <sys/callout.h>
41 #include <sys/malloc.h>
45 #include <bus/u4b/usb.h>
46 #include <bus/u4b/usbdi.h>
47 #include <bus/u4b/usbdi_util.h>
49 #define USB_DEBUG_VAR usb_debug
51 #include <bus/u4b/usb_core.h>
52 #include <bus/u4b/usb_busdma.h>
53 #include <bus/u4b/usb_process.h>
54 #include <bus/u4b/usb_transfer.h>
55 #include <bus/u4b/usb_device.h>
56 #include <bus/u4b/usb_debug.h>
57 #include <bus/u4b/usb_util.h>
59 #include <bus/u4b/usb_controller.h>
60 #include <bus/u4b/usb_bus.h>
61 #include <bus/u4b/usb_pf.h>
63 struct usb_std_packet_size {
65 uint16_t min; /* inclusive */
66 uint16_t max; /* inclusive */
72 static usb_callback_t usb_request_callback;
74 static const struct usb_config usb_control_ep_cfg[USB_CTRL_XFER_MAX] = {
76 /* This transfer is used for generic control endpoint transfers */
80 .endpoint = 0x00, /* Control endpoint */
81 .direction = UE_DIR_ANY,
82 .bufsize = USB_EP0_BUFSIZE, /* bytes */
83 .flags = {.proxy_buffer = 1,},
84 .callback = &usb_request_callback,
85 .usb_mode = USB_MODE_DUAL, /* both modes */
88 /* This transfer is used for generic clear stall only */
92 .endpoint = 0x00, /* Control pipe */
93 .direction = UE_DIR_ANY,
94 .bufsize = sizeof(struct usb_device_request),
95 .callback = &usb_do_clear_stall_callback,
96 .timeout = 1000, /* 1 second */
97 .interval = 50, /* 50ms */
98 .usb_mode = USB_MODE_HOST,
102 /* function prototypes */
104 static void usbd_update_max_frame_size(struct usb_xfer *);
105 static void usbd_transfer_unsetup_sub(struct usb_xfer_root *, uint8_t);
106 static void usbd_control_transfer_init(struct usb_xfer *);
107 static int usbd_setup_ctrl_transfer(struct usb_xfer *);
108 static void usb_callback_proc(struct usb_proc_msg *);
109 static void usbd_callback_ss_done_defer(struct usb_xfer *);
110 static void usbd_callback_wrapper(struct usb_xfer_queue *);
111 static void usbd_transfer_start_cb(void *);
112 static uint8_t usbd_callback_wrapper_sub(struct usb_xfer *);
113 static void usbd_get_std_packet_size(struct usb_std_packet_size *ptr,
114 uint8_t type, enum usb_dev_speed speed);
116 /*------------------------------------------------------------------------*
117 * usb_request_callback
118 *------------------------------------------------------------------------*/
120 usb_request_callback(struct usb_xfer *xfer, usb_error_t error)
122 if (xfer->flags_int.usb_mode == USB_MODE_DEVICE)
123 usb_handle_request_callback(xfer, error);
125 usbd_do_request_callback(xfer, error);
128 /*------------------------------------------------------------------------*
129 * usbd_update_max_frame_size
131 * This function updates the maximum frame size, hence high speed USB
132 * can transfer multiple consecutive packets.
133 *------------------------------------------------------------------------*/
135 usbd_update_max_frame_size(struct usb_xfer *xfer)
137 /* compute maximum frame size */
138 /* this computation should not overflow 16-bit */
139 /* max = 15 * 1024 */
141 xfer->max_frame_size = xfer->max_packet_size * xfer->max_packet_count;
144 /*------------------------------------------------------------------------*
147 * The following function is called when we need to
148 * synchronize with DMA hardware.
151 * 0: no DMA delay required
152 * Else: milliseconds of DMA delay
153 *------------------------------------------------------------------------*/
155 usbd_get_dma_delay(struct usb_device *udev)
157 struct usb_bus_methods *mtod;
160 mtod = udev->bus->methods;
163 if (mtod->get_dma_delay) {
164 (mtod->get_dma_delay) (udev, &temp);
166 * Round up and convert to milliseconds. Note that we use
167 * 1024 milliseconds per second. to save a division.
175 /*------------------------------------------------------------------------*
176 * usbd_transfer_setup_sub_malloc
178 * This function will allocate one or more DMA'able memory chunks
179 * according to "size", "align" and "count" arguments. "ppc" is
180 * pointed to a linear array of USB page caches afterwards.
185 *------------------------------------------------------------------------*/
188 usbd_transfer_setup_sub_malloc(struct usb_setup_params *parm,
189 struct usb_page_cache **ppc, usb_size_t size, usb_size_t align,
192 struct usb_page_cache *pc;
203 USB_ASSERT(align > 1, ("Invalid alignment, 0x%08x\n",
205 USB_ASSERT(size > 0, ("Invalid size = 0\n"));
209 return (0); /* nothing to allocate */
212 * Make sure that the size is aligned properly.
214 size = -((-size) & (-align));
217 * Try multi-allocation chunks to reduce the number of DMA
218 * allocations, hence DMA allocations are slow.
220 if (size >= PAGE_SIZE) {
224 /* compute number of objects per page */
225 n_obj = (PAGE_SIZE / size);
227 * Compute number of DMA chunks, rounded up
230 n_dma_pc = ((count + n_obj - 1) / n_obj);
233 if (parm->buf == NULL) {
235 parm->dma_page_ptr += n_dma_pc;
236 parm->dma_page_cache_ptr += n_dma_pc;
237 parm->dma_page_ptr += count;
238 parm->xfer_page_cache_ptr += count;
241 for (x = 0; x != n_dma_pc; x++) {
242 /* need to initialize the page cache */
243 parm->dma_page_cache_ptr[x].tag_parent =
244 &parm->curr_xfer->xroot->dma_parent_tag;
246 for (x = 0; x != count; x++) {
247 /* need to initialize the page cache */
248 parm->xfer_page_cache_ptr[x].tag_parent =
249 &parm->curr_xfer->xroot->dma_parent_tag;
253 *ppc = parm->xfer_page_cache_ptr;
255 r = count; /* set remainder count */
256 z = n_obj * size; /* set allocation size */
257 pc = parm->xfer_page_cache_ptr;
258 pg = parm->dma_page_ptr;
260 for (x = 0; x != n_dma_pc; x++) {
263 /* compute last remainder */
267 if (usb_pc_alloc_mem(parm->dma_page_cache_ptr,
269 return (1); /* failure */
271 /* Set beginning of current buffer */
272 buf = parm->dma_page_cache_ptr->buffer;
273 /* Make room for one DMA page cache and one page */
274 parm->dma_page_cache_ptr++;
277 for (y = 0; (y != n_obj); y++, r--, pc++, pg++) {
279 /* Load sub-chunk into DMA */
280 if (usb_pc_dmamap_create(pc, size)) {
281 return (1); /* failure */
283 pc->buffer = USB_ADD_BYTES(buf, y * size);
286 lockmgr(pc->tag_parent->lock, LK_EXCLUSIVE);
287 if (usb_pc_load_mem(pc, size, 1 /* synchronous */ )) {
288 lockmgr(pc->tag_parent->lock, LK_RELEASE);
289 return (1); /* failure */
291 lockmgr(pc->tag_parent->lock, LK_RELEASE);
295 parm->xfer_page_cache_ptr = pc;
296 parm->dma_page_ptr = pg;
301 /*------------------------------------------------------------------------*
302 * usbd_transfer_setup_sub - transfer setup subroutine
304 * This function must be called from the "xfer_setup" callback of the
305 * USB Host or Device controller driver when setting up an USB
306 * transfer. This function will setup correct packet sizes, buffer
307 * sizes, flags and more, that are stored in the "usb_xfer"
309 *------------------------------------------------------------------------*/
311 usbd_transfer_setup_sub(struct usb_setup_params *parm)
317 struct usb_xfer *xfer = parm->curr_xfer;
318 const struct usb_config *setup = parm->curr_setup;
319 struct usb_endpoint_ss_comp_descriptor *ecomp;
320 struct usb_endpoint_descriptor *edesc;
321 struct usb_std_packet_size std_size;
322 usb_frcount_t n_frlengths;
323 usb_frcount_t n_frbuffers;
329 * Sanity check. The following parameters must be initialized before
330 * calling this function.
332 if ((parm->hc_max_packet_size == 0) ||
333 (parm->hc_max_packet_count == 0) ||
334 (parm->hc_max_frame_size == 0)) {
335 parm->err = USB_ERR_INVAL;
338 edesc = xfer->endpoint->edesc;
339 ecomp = xfer->endpoint->ecomp;
341 type = (edesc->bmAttributes & UE_XFERTYPE);
343 xfer->flags = setup->flags;
344 xfer->nframes = setup->frames;
345 xfer->timeout = setup->timeout;
346 xfer->callback = setup->callback;
347 xfer->interval = setup->interval;
348 xfer->endpointno = edesc->bEndpointAddress;
349 xfer->max_packet_size = UGETW(edesc->wMaxPacketSize);
350 xfer->max_packet_count = 1;
351 /* make a shadow copy: */
352 xfer->flags_int.usb_mode = parm->udev->flags.usb_mode;
354 parm->bufsize = setup->bufsize;
356 switch (parm->speed) {
361 xfer->max_packet_count += (xfer->max_packet_size >> 11) & 3;
363 /* check for invalid max packet count */
364 if (xfer->max_packet_count > 3)
365 xfer->max_packet_count = 3;
370 xfer->max_packet_size &= 0x7FF;
372 case USB_SPEED_SUPER:
373 xfer->max_packet_count += (xfer->max_packet_size >> 11) & 3;
376 xfer->max_packet_count += ecomp->bMaxBurst;
378 if ((xfer->max_packet_count == 0) ||
379 (xfer->max_packet_count > 16))
380 xfer->max_packet_count = 16;
384 xfer->max_packet_count = 1;
390 mult = (ecomp->bmAttributes & 3) + 1;
394 xfer->max_packet_count *= mult;
400 xfer->max_packet_size &= 0x7FF;
405 /* range check "max_packet_count" */
407 if (xfer->max_packet_count > parm->hc_max_packet_count) {
408 xfer->max_packet_count = parm->hc_max_packet_count;
410 /* filter "wMaxPacketSize" according to HC capabilities */
412 if ((xfer->max_packet_size > parm->hc_max_packet_size) ||
413 (xfer->max_packet_size == 0)) {
414 xfer->max_packet_size = parm->hc_max_packet_size;
416 /* filter "wMaxPacketSize" according to standard sizes */
418 usbd_get_std_packet_size(&std_size, type, parm->speed);
420 if (std_size.range.min || std_size.range.max) {
422 if (xfer->max_packet_size < std_size.range.min) {
423 xfer->max_packet_size = std_size.range.min;
425 if (xfer->max_packet_size > std_size.range.max) {
426 xfer->max_packet_size = std_size.range.max;
430 if (xfer->max_packet_size >= std_size.fixed[3]) {
431 xfer->max_packet_size = std_size.fixed[3];
432 } else if (xfer->max_packet_size >= std_size.fixed[2]) {
433 xfer->max_packet_size = std_size.fixed[2];
434 } else if (xfer->max_packet_size >= std_size.fixed[1]) {
435 xfer->max_packet_size = std_size.fixed[1];
437 /* only one possibility left */
438 xfer->max_packet_size = std_size.fixed[0];
442 /* compute "max_frame_size" */
444 usbd_update_max_frame_size(xfer);
446 /* check interrupt interval and transfer pre-delay */
448 if (type == UE_ISOCHRONOUS) {
450 uint16_t frame_limit;
452 xfer->interval = 0; /* not used, must be zero */
453 xfer->flags_int.isochronous_xfr = 1; /* set flag */
455 if (xfer->timeout == 0) {
457 * set a default timeout in
458 * case something goes wrong!
460 xfer->timeout = 1000 / 4;
462 switch (parm->speed) {
465 frame_limit = USB_MAX_FS_ISOC_FRAMES_PER_XFER;
469 frame_limit = USB_MAX_HS_ISOC_FRAMES_PER_XFER;
470 xfer->fps_shift = edesc->bInterval;
471 if (xfer->fps_shift > 0)
473 if (xfer->fps_shift > 3)
475 if (xfer->flags.pre_scale_frames != 0)
476 xfer->nframes <<= (3 - xfer->fps_shift);
480 if (xfer->nframes > frame_limit) {
482 * this is not going to work
485 parm->err = USB_ERR_INVAL;
488 if (xfer->nframes == 0) {
490 * this is not a valid value
492 parm->err = USB_ERR_ZERO_NFRAMES;
498 * If a value is specified use that else check the
499 * endpoint descriptor!
501 if (type == UE_INTERRUPT) {
505 if (xfer->interval == 0) {
507 xfer->interval = edesc->bInterval;
509 switch (parm->speed) {
515 if (xfer->interval < 4)
517 else if (xfer->interval > 16)
518 xfer->interval = (1 << (16 - 4));
521 (1 << (xfer->interval - 4));
526 if (xfer->interval == 0) {
528 * One millisecond is the smallest
529 * interval we support:
537 while ((temp != 0) && (temp < xfer->interval)) {
542 switch (parm->speed) {
547 xfer->fps_shift += 3;
554 * NOTE: we do not allow "max_packet_size" or "max_frame_size"
555 * to be equal to zero when setting up USB transfers, hence
556 * this leads to alot of extra code in the USB kernel.
559 if ((xfer->max_frame_size == 0) ||
560 (xfer->max_packet_size == 0)) {
564 if ((parm->bufsize <= MIN_PKT) &&
565 (type != UE_CONTROL) &&
569 xfer->max_packet_size = MIN_PKT;
570 xfer->max_packet_count = 1;
571 parm->bufsize = 0; /* automatic setup length */
572 usbd_update_max_frame_size(xfer);
575 parm->err = USB_ERR_ZERO_MAXP;
584 * check if we should setup a default
588 if (parm->bufsize == 0) {
590 parm->bufsize = xfer->max_frame_size;
592 if (type == UE_ISOCHRONOUS) {
593 parm->bufsize *= xfer->nframes;
597 * check if we are about to setup a proxy
601 if (xfer->flags.proxy_buffer) {
603 /* round bufsize up */
605 parm->bufsize += (xfer->max_frame_size - 1);
607 if (parm->bufsize < xfer->max_frame_size) {
608 /* length wrapped around */
609 parm->err = USB_ERR_INVAL;
612 /* subtract remainder */
614 parm->bufsize -= (parm->bufsize % xfer->max_frame_size);
616 /* add length of USB device request structure, if any */
618 if (type == UE_CONTROL) {
619 parm->bufsize += REQ_SIZE; /* SETUP message */
622 xfer->max_data_length = parm->bufsize;
624 /* Setup "n_frlengths" and "n_frbuffers" */
626 if (type == UE_ISOCHRONOUS) {
627 n_frlengths = xfer->nframes;
631 if (type == UE_CONTROL) {
632 xfer->flags_int.control_xfr = 1;
633 if (xfer->nframes == 0) {
634 if (parm->bufsize <= REQ_SIZE) {
636 * there will never be any data
645 if (xfer->nframes == 0) {
650 n_frlengths = xfer->nframes;
651 n_frbuffers = xfer->nframes;
655 * check if we have room for the
656 * USB device request structure:
659 if (type == UE_CONTROL) {
661 if (xfer->max_data_length < REQ_SIZE) {
662 /* length wrapped around or too small bufsize */
663 parm->err = USB_ERR_INVAL;
666 xfer->max_data_length -= REQ_SIZE;
669 * Setup "frlengths" and shadow "frlengths" for keeping the
670 * initial frame lengths when a USB transfer is complete. This
671 * information is useful when computing isochronous offsets.
673 xfer->frlengths = parm->xfer_length_ptr;
674 parm->xfer_length_ptr += 2 * n_frlengths;
676 /* setup "frbuffers" */
677 xfer->frbuffers = parm->xfer_page_cache_ptr;
678 parm->xfer_page_cache_ptr += n_frbuffers;
680 /* initialize max frame count */
681 xfer->max_frame_count = xfer->nframes;
684 * check if we need to setup
688 if (!xfer->flags.ext_buffer) {
691 parm->size[0] += ((-parm->size[0]) & (USB_HOST_ALIGN - 1));
696 USB_ADD_BYTES(parm->buf, parm->size[0]);
698 usbd_xfer_set_frame_offset(xfer, 0, 0);
700 if ((type == UE_CONTROL) && (n_frbuffers > 1)) {
701 usbd_xfer_set_frame_offset(xfer, REQ_SIZE, 1);
704 parm->size[0] += parm->bufsize;
706 /* align data again */
707 parm->size[0] += ((-parm->size[0]) & (USB_HOST_ALIGN - 1));
710 * Compute maximum buffer size
713 if (parm->bufsize_max < parm->bufsize) {
714 parm->bufsize_max = parm->bufsize;
717 if (xfer->flags_int.bdma_enable) {
719 * Setup "dma_page_ptr".
721 * Proof for formula below:
723 * Assume there are three USB frames having length "a", "b" and
724 * "c". These USB frames will at maximum need "z"
725 * "usb_page" structures. "z" is given by:
727 * z = ((a / USB_PAGE_SIZE) + 2) + ((b / USB_PAGE_SIZE) + 2) +
728 * ((c / USB_PAGE_SIZE) + 2);
730 * Constraining "a", "b" and "c" like this:
732 * (a + b + c) <= parm->bufsize
736 * z <= ((parm->bufsize / USB_PAGE_SIZE) + (3*2));
738 * Here is the general formula:
740 xfer->dma_page_ptr = parm->dma_page_ptr;
741 parm->dma_page_ptr += (2 * n_frbuffers);
742 parm->dma_page_ptr += (parm->bufsize / USB_PAGE_SIZE);
746 /* correct maximum data length */
747 xfer->max_data_length = 0;
749 /* subtract USB frame remainder from "hc_max_frame_size" */
751 xfer->max_hc_frame_size =
752 (parm->hc_max_frame_size -
753 (parm->hc_max_frame_size % xfer->max_frame_size));
755 if (xfer->max_hc_frame_size == 0) {
756 parm->err = USB_ERR_INVAL;
760 /* initialize frame buffers */
763 for (x = 0; x != n_frbuffers; x++) {
764 xfer->frbuffers[x].tag_parent =
765 &xfer->xroot->dma_parent_tag;
767 if (xfer->flags_int.bdma_enable &&
768 (parm->bufsize_max > 0)) {
770 if (usb_pc_dmamap_create(
772 parm->bufsize_max)) {
773 parm->err = USB_ERR_NOMEM;
783 * Set some dummy values so that we avoid division by zero:
785 xfer->max_hc_frame_size = 1;
786 xfer->max_frame_size = 1;
787 xfer->max_packet_size = 1;
788 xfer->max_data_length = 0;
790 xfer->max_frame_count = 0;
794 /*------------------------------------------------------------------------*
795 * usbd_transfer_setup - setup an array of USB transfers
797 * NOTE: You must always call "usbd_transfer_unsetup" after calling
798 * "usbd_transfer_setup" if success was returned.
800 * The idea is that the USB device driver should pre-allocate all its
801 * transfers by one call to this function.
806 *------------------------------------------------------------------------*/
808 usbd_transfer_setup(struct usb_device *udev,
809 const uint8_t *ifaces, struct usb_xfer **ppxfer,
810 const struct usb_config *setup_start, uint16_t n_setup,
811 void *priv_sc, struct lock *xfer_lock)
813 struct usb_xfer dummy;
814 struct usb_setup_params parm;
815 const struct usb_config *setup_end = setup_start + n_setup;
816 const struct usb_config *setup;
817 struct usb_endpoint *ep;
818 struct usb_xfer_root *info;
819 struct usb_xfer *xfer;
829 WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL,
830 "usbd_transfer_setup can sleep!");
833 /* do some checking first */
836 DPRINTFN(6, "setup array has zero length!\n");
837 return (USB_ERR_INVAL);
840 DPRINTFN(6, "ifaces array is NULL!\n");
841 return (USB_ERR_INVAL);
843 if (xfer_lock == NULL) {
844 DPRINTFN(6, "using global lock\n");
847 for (setup = setup_start, n = 0;
848 setup != setup_end; setup++, n++) {
849 if (setup->bufsize == (usb_frlength_t)-1) {
850 parm.err = USB_ERR_BAD_BUFSIZE;
851 DPRINTF("invalid bufsize\n");
853 if (setup->callback == NULL) {
854 parm.err = USB_ERR_NO_CALLBACK;
855 DPRINTF("no callback\n");
863 memset(&parm, 0, sizeof(parm));
866 parm.speed = usbd_get_speed(udev);
867 parm.hc_max_packet_count = 1;
869 if (parm.speed >= USB_SPEED_MAX) {
870 parm.err = USB_ERR_INVAL;
873 /* setup all transfers */
879 * Initialize the "usb_xfer_root" structure,
880 * which is common for all our USB transfers.
882 info = USB_ADD_BYTES(buf, 0);
884 info->memory_base = buf;
885 info->memory_size = parm.size[0];
888 info->dma_page_cache_start = USB_ADD_BYTES(buf, parm.size[4]);
889 info->dma_page_cache_end = USB_ADD_BYTES(buf, parm.size[5]);
891 info->xfer_page_cache_start = USB_ADD_BYTES(buf, parm.size[5]);
892 info->xfer_page_cache_end = USB_ADD_BYTES(buf, parm.size[2]);
894 cv_init(&info->cv_drain, "WDRAIN");
896 info->xfer_lock = xfer_lock;
898 usb_dma_tag_setup(&info->dma_parent_tag,
899 parm.dma_tag_p, udev->bus->dma_parent_tag[0].tag,
900 xfer_lock, &usb_bdma_done_event, 32, parm.dma_tag_max);
903 info->bus = udev->bus;
906 TAILQ_INIT(&info->done_q.head);
907 info->done_q.command = &usbd_callback_wrapper;
909 TAILQ_INIT(&info->dma_q.head);
910 info->dma_q.command = &usb_bdma_work_loop;
912 info->done_m[0].hdr.pm_callback = &usb_callback_proc;
913 info->done_m[0].xroot = info;
914 info->done_m[1].hdr.pm_callback = &usb_callback_proc;
915 info->done_m[1].xroot = info;
918 * In device side mode control endpoint
919 * requests need to run from a separate
920 * context, else there is a chance of
923 if (setup_start == usb_control_ep_cfg)
925 &udev->bus->control_xfer_proc;
928 &udev->bus->non_giant_callback_proc;
934 parm.size[0] += sizeof(info[0]);
936 for (setup = setup_start, n = 0;
937 setup != setup_end; setup++, n++) {
939 /* skip USB transfers without callbacks: */
940 if (setup->callback == NULL) {
943 /* see if there is a matching endpoint */
944 ep = usbd_get_endpoint(udev,
945 ifaces[setup->if_index], setup);
947 if ((ep == NULL) || (ep->methods == NULL)) {
948 if (setup->flags.no_pipe_ok)
950 if ((setup->usb_mode != USB_MODE_DUAL) &&
951 (setup->usb_mode != udev->flags.usb_mode))
953 parm.err = USB_ERR_NO_PIPE;
957 /* align data properly */
958 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
960 /* store current setup pointer */
961 parm.curr_setup = setup;
965 * Common initialization of the
966 * "usb_xfer" structure.
968 xfer = USB_ADD_BYTES(buf, parm.size[0]);
969 xfer->address = udev->address;
970 xfer->priv_sc = priv_sc;
973 usb_callout_init_mtx(&xfer->timeout_handle,
974 &udev->bus->bus_lock, 0);
977 * Setup a dummy xfer, hence we are
978 * writing to the "usb_xfer"
979 * structure pointed to by "xfer"
980 * before we have allocated any
984 memset(&dummy, 0, sizeof(dummy));
988 /* set transfer endpoint pointer */
991 parm.size[0] += sizeof(xfer[0]);
992 parm.methods = xfer->endpoint->methods;
993 parm.curr_xfer = xfer;
996 * Call the Host or Device controller transfer
999 (udev->bus->methods->xfer_setup) (&parm);
1001 /* check for error */
1007 * Increment the endpoint refcount. This
1008 * basically prevents setting a new
1009 * configuration and alternate setting
1010 * when USB transfers are in use on
1011 * the given interface. Search the USB
1012 * code for "endpoint->refcount_alloc" if you
1013 * want more information.
1015 USB_BUS_LOCK(info->bus);
1016 if (xfer->endpoint->refcount_alloc >= USB_EP_REF_MAX)
1017 parm.err = USB_ERR_INVAL;
1019 xfer->endpoint->refcount_alloc++;
1021 if (xfer->endpoint->refcount_alloc == 0)
1022 panic("usbd_transfer_setup(): Refcount wrapped to zero\n");
1023 USB_BUS_UNLOCK(info->bus);
1026 * Whenever we set ppxfer[] then we
1027 * also need to increment the
1030 info->setup_refcount++;
1033 * Transfer is successfully setup and
1039 /* check for error */
1044 if (buf || parm.err) {
1047 if (refcount == 0) {
1048 /* no transfers - nothing to do ! */
1051 /* align data properly */
1052 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
1054 /* store offset temporarily */
1055 parm.size[1] = parm.size[0];
1058 * The number of DMA tags required depends on
1059 * the number of endpoints. The current estimate
1060 * for maximum number of DMA tags per endpoint
1063 parm.dma_tag_max += 2 * MIN(n_setup, USB_EP_MAX);
1066 * DMA tags for QH, TD, Data and more.
1068 parm.dma_tag_max += 8;
1070 parm.dma_tag_p += parm.dma_tag_max;
1072 parm.size[0] += ((uint8_t *)parm.dma_tag_p) -
1075 /* align data properly */
1076 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
1078 /* store offset temporarily */
1079 parm.size[3] = parm.size[0];
1081 parm.size[0] += ((uint8_t *)parm.dma_page_ptr) -
1084 /* align data properly */
1085 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
1087 /* store offset temporarily */
1088 parm.size[4] = parm.size[0];
1090 parm.size[0] += ((uint8_t *)parm.dma_page_cache_ptr) -
1093 /* store end offset temporarily */
1094 parm.size[5] = parm.size[0];
1096 parm.size[0] += ((uint8_t *)parm.xfer_page_cache_ptr) -
1099 /* store end offset temporarily */
1101 parm.size[2] = parm.size[0];
1103 /* align data properly */
1104 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
1106 parm.size[6] = parm.size[0];
1108 parm.size[0] += ((uint8_t *)parm.xfer_length_ptr) -
1111 /* align data properly */
1112 parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1));
1114 /* allocate zeroed memory */
1115 buf = kmalloc(parm.size[0], M_USB, M_WAITOK | M_ZERO);
1118 parm.err = USB_ERR_NOMEM;
1119 DPRINTFN(0, "cannot allocate memory block for "
1120 "configuration (%d bytes)\n",
1124 parm.dma_tag_p = USB_ADD_BYTES(buf, parm.size[1]);
1125 parm.dma_page_ptr = USB_ADD_BYTES(buf, parm.size[3]);
1126 parm.dma_page_cache_ptr = USB_ADD_BYTES(buf, parm.size[4]);
1127 parm.xfer_page_cache_ptr = USB_ADD_BYTES(buf, parm.size[5]);
1128 parm.xfer_length_ptr = USB_ADD_BYTES(buf, parm.size[6]);
1133 if (info->setup_refcount == 0) {
1135 * "usbd_transfer_unsetup_sub" will unlock
1136 * the bus mutex before returning !
1138 USB_BUS_LOCK(info->bus);
1140 /* something went wrong */
1141 usbd_transfer_unsetup_sub(info, 0);
1145 usbd_transfer_unsetup(ppxfer, n_setup);
1150 /*------------------------------------------------------------------------*
1151 * usbd_transfer_unsetup_sub - factored out code
1152 *------------------------------------------------------------------------*/
1154 usbd_transfer_unsetup_sub(struct usb_xfer_root *info, uint8_t needs_delay)
1157 struct usb_page_cache *pc;
1160 USB_BUS_LOCK_ASSERT(info->bus);
1162 /* wait for any outstanding DMA operations */
1166 temp = usbd_get_dma_delay(info->udev);
1168 usb_pause_mtx(&info->bus->bus_lock,
1169 USB_MS_TO_TICKS(temp));
1173 /* make sure that our done messages are not queued anywhere */
1174 usb_proc_mwait(info->done_p, &info->done_m[0], &info->done_m[1]);
1176 USB_BUS_UNLOCK(info->bus);
1179 /* free DMA'able memory, if any */
1180 pc = info->dma_page_cache_start;
1181 while (pc != info->dma_page_cache_end) {
1182 usb_pc_free_mem(pc);
1186 /* free DMA maps in all "xfer->frbuffers" */
1187 pc = info->xfer_page_cache_start;
1188 while (pc != info->xfer_page_cache_end) {
1189 usb_pc_dmamap_destroy(pc);
1193 /* free all DMA tags */
1194 usb_dma_tag_unsetup(&info->dma_parent_tag);
1197 cv_destroy(&info->cv_drain);
1200 * free the "memory_base" last, hence the "info" structure is
1201 * contained within the "memory_base"!
1203 kfree(info->memory_base, M_USB);
1206 /*------------------------------------------------------------------------*
1207 * usbd_transfer_unsetup - unsetup/free an array of USB transfers
1209 * NOTE: All USB transfers in progress will get called back passing
1210 * the error code "USB_ERR_CANCELLED" before this function
1212 *------------------------------------------------------------------------*/
1214 usbd_transfer_unsetup(struct usb_xfer **pxfer, uint16_t n_setup)
1216 struct usb_xfer *xfer;
1217 struct usb_xfer_root *info;
1218 uint8_t needs_delay = 0;
1221 WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL,
1222 "usbd_transfer_unsetup can sleep!");
1226 xfer = pxfer[n_setup];
1233 USB_XFER_LOCK(xfer);
1234 USB_BUS_LOCK(info->bus);
1237 * HINT: when you start/stop a transfer, it might be a
1238 * good idea to directly use the "pxfer[]" structure:
1240 * usbd_transfer_start(sc->pxfer[0]);
1241 * usbd_transfer_stop(sc->pxfer[0]);
1243 * That way, if your code has many parts that will not
1244 * stop running under the same lock, in other words
1245 * "xfer_mtx", the usbd_transfer_start and
1246 * usbd_transfer_stop functions will simply return
1247 * when they detect a NULL pointer argument.
1249 * To avoid any races we clear the "pxfer[]" pointer
1250 * while holding the private mutex of the driver:
1252 pxfer[n_setup] = NULL;
1254 USB_BUS_UNLOCK(info->bus);
1255 USB_XFER_UNLOCK(xfer);
1257 usbd_transfer_drain(xfer);
1260 if (xfer->flags_int.bdma_enable)
1264 * NOTE: default endpoint does not have an
1265 * interface, even if endpoint->iface_index == 0
1267 USB_BUS_LOCK(info->bus);
1268 xfer->endpoint->refcount_alloc--;
1269 USB_BUS_UNLOCK(info->bus);
1271 usb_callout_drain(&xfer->timeout_handle);
1273 USB_BUS_LOCK(info->bus);
1276 USB_ASSERT(info->setup_refcount != 0, ("Invalid setup "
1277 "reference count\n"));
1280 info->setup_refcount--;
1282 if (info->setup_refcount == 0) {
1283 usbd_transfer_unsetup_sub(info,
1286 USB_BUS_UNLOCK(info->bus);
1291 /*------------------------------------------------------------------------*
1292 * usbd_control_transfer_init - factored out code
1294 * In USB Device Mode we have to wait for the SETUP packet which
1295 * containst the "struct usb_device_request" structure, before we can
1296 * transfer any data. In USB Host Mode we already have the SETUP
1297 * packet at the moment the USB transfer is started. This leads us to
1298 * having to setup the USB transfer at two different places in
1299 * time. This function just contains factored out control transfer
1300 * initialisation code, so that we don't duplicate the code.
1301 *------------------------------------------------------------------------*/
1303 usbd_control_transfer_init(struct usb_xfer *xfer)
1305 struct usb_device_request req;
1307 /* copy out the USB request header */
1309 usbd_copy_out(xfer->frbuffers, 0, &req, sizeof(req));
1311 /* setup remainder */
1313 xfer->flags_int.control_rem = UGETW(req.wLength);
1315 /* copy direction to endpoint variable */
1317 xfer->endpointno &= ~(UE_DIR_IN | UE_DIR_OUT);
1319 (req.bmRequestType & UT_READ) ? UE_DIR_IN : UE_DIR_OUT;
1322 /*------------------------------------------------------------------------*
1323 * usbd_setup_ctrl_transfer
1325 * This function handles initialisation of control transfers. Control
1326 * transfers are special in that regard that they can both transmit
1332 *------------------------------------------------------------------------*/
1334 usbd_setup_ctrl_transfer(struct usb_xfer *xfer)
1338 /* Check for control endpoint stall */
1339 if (xfer->flags.stall_pipe && xfer->flags_int.control_act) {
1340 /* the control transfer is no longer active */
1341 xfer->flags_int.control_stall = 1;
1342 xfer->flags_int.control_act = 0;
1344 /* don't stall control transfer by default */
1345 xfer->flags_int.control_stall = 0;
1348 /* Check for invalid number of frames */
1349 if (xfer->nframes > 2) {
1351 * If you need to split a control transfer, you
1352 * have to do one part at a time. Only with
1353 * non-control transfers you can do multiple
1356 DPRINTFN(0, "Too many frames: %u\n",
1357 (unsigned int)xfer->nframes);
1362 * Check if there is a control
1363 * transfer in progress:
1365 if (xfer->flags_int.control_act) {
1367 if (xfer->flags_int.control_hdr) {
1369 /* clear send header flag */
1371 xfer->flags_int.control_hdr = 0;
1373 /* setup control transfer */
1374 if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) {
1375 usbd_control_transfer_init(xfer);
1378 /* get data length */
1384 /* the size of the SETUP structure is hardcoded ! */
1386 if (xfer->frlengths[0] != sizeof(struct usb_device_request)) {
1387 DPRINTFN(0, "Wrong framelength %u != %zu\n",
1388 xfer->frlengths[0], sizeof(struct
1389 usb_device_request));
1392 /* check USB mode */
1393 if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) {
1395 /* check number of frames */
1396 if (xfer->nframes != 1) {
1398 * We need to receive the setup
1399 * message first so that we know the
1402 DPRINTF("Misconfigured transfer\n");
1406 * Set a dummy "control_rem" value. This
1407 * variable will be overwritten later by a
1408 * call to "usbd_control_transfer_init()" !
1410 xfer->flags_int.control_rem = 0xFFFF;
1413 /* setup "endpoint" and "control_rem" */
1415 usbd_control_transfer_init(xfer);
1418 /* set transfer-header flag */
1420 xfer->flags_int.control_hdr = 1;
1422 /* get data length */
1424 len = (xfer->sumlen - sizeof(struct usb_device_request));
1427 /* check if there is a length mismatch */
1429 if (len > xfer->flags_int.control_rem) {
1430 DPRINTFN(0, "Length (%d) greater than "
1431 "remaining length (%d)\n", len,
1432 xfer->flags_int.control_rem);
1435 /* check if we are doing a short transfer */
1437 if (xfer->flags.force_short_xfer) {
1438 xfer->flags_int.control_rem = 0;
1440 if ((len != xfer->max_data_length) &&
1441 (len != xfer->flags_int.control_rem) &&
1442 (xfer->nframes != 1)) {
1443 DPRINTFN(0, "Short control transfer without "
1444 "force_short_xfer set\n");
1447 xfer->flags_int.control_rem -= len;
1450 /* the status part is executed when "control_act" is 0 */
1452 if ((xfer->flags_int.control_rem > 0) ||
1453 (xfer->flags.manual_status)) {
1454 /* don't execute the STATUS stage yet */
1455 xfer->flags_int.control_act = 1;
1458 if ((!xfer->flags_int.control_hdr) &&
1459 (xfer->nframes == 1)) {
1461 * This is not a valid operation!
1463 DPRINTFN(0, "Invalid parameter "
1468 /* time to execute the STATUS stage */
1469 xfer->flags_int.control_act = 0;
1471 return (0); /* success */
1474 return (1); /* failure */
1477 /*------------------------------------------------------------------------*
1478 * usbd_transfer_submit - start USB hardware for the given transfer
1480 * This function should only be called from the USB callback.
1481 *------------------------------------------------------------------------*/
1483 usbd_transfer_submit(struct usb_xfer *xfer)
1485 struct usb_xfer_root *info;
1486 struct usb_bus *bus;
1492 DPRINTF("xfer=%p, endpoint=%p, nframes=%d, dir=%s\n",
1493 xfer, xfer->endpoint, xfer->nframes, USB_GET_DATA_ISREAD(xfer) ?
1497 if (USB_DEBUG_VAR > 0) {
1500 usb_dump_endpoint(xfer->endpoint);
1502 USB_BUS_UNLOCK(bus);
1506 USB_XFER_LOCK_ASSERT(xfer);
1507 USB_BUS_LOCK_ASSERT_NOTOWNED(bus);
1509 /* Only open the USB transfer once! */
1510 if (!xfer->flags_int.open) {
1511 xfer->flags_int.open = 1;
1516 (xfer->endpoint->methods->open) (xfer);
1517 USB_BUS_UNLOCK(bus);
1519 /* set "transferring" flag */
1520 xfer->flags_int.transferring = 1;
1523 /* increment power reference */
1524 usbd_transfer_power_ref(xfer, 1);
1527 * Check if the transfer is waiting on a queue, most
1528 * frequently the "done_q":
1530 if (xfer->wait_queue) {
1532 usbd_transfer_dequeue(xfer);
1533 USB_BUS_UNLOCK(bus);
1535 /* clear "did_dma_delay" flag */
1536 xfer->flags_int.did_dma_delay = 0;
1538 /* clear "did_close" flag */
1539 xfer->flags_int.did_close = 0;
1542 /* clear "bdma_setup" flag */
1543 xfer->flags_int.bdma_setup = 0;
1545 /* by default we cannot cancel any USB transfer immediately */
1546 xfer->flags_int.can_cancel_immed = 0;
1548 /* clear lengths and frame counts by default */
1553 /* clear any previous errors */
1556 /* Check if the device is still alive */
1557 if (info->udev->state < USB_STATE_POWERED) {
1560 * Must return cancelled error code else
1561 * device drivers can hang.
1563 usbd_transfer_done(xfer, USB_ERR_CANCELLED);
1564 USB_BUS_UNLOCK(bus);
1569 if (xfer->nframes == 0) {
1570 if (xfer->flags.stall_pipe) {
1572 * Special case - want to stall without transferring
1575 DPRINTF("xfer=%p nframes=0: stall "
1576 "or clear stall!\n", xfer);
1578 xfer->flags_int.can_cancel_immed = 1;
1579 /* start the transfer */
1580 usb_command_wrapper(&xfer->endpoint->endpoint_q, xfer);
1581 USB_BUS_UNLOCK(bus);
1585 usbd_transfer_done(xfer, USB_ERR_INVAL);
1586 USB_BUS_UNLOCK(bus);
1589 /* compute some variables */
1591 for (x = 0; x != xfer->nframes; x++) {
1592 /* make a copy of the frlenghts[] */
1593 xfer->frlengths[x + xfer->max_frame_count] = xfer->frlengths[x];
1594 /* compute total transfer length */
1595 xfer->sumlen += xfer->frlengths[x];
1596 if (xfer->sumlen < xfer->frlengths[x]) {
1597 /* length wrapped around */
1599 usbd_transfer_done(xfer, USB_ERR_INVAL);
1600 USB_BUS_UNLOCK(bus);
1605 /* clear some internal flags */
1607 xfer->flags_int.short_xfer_ok = 0;
1608 xfer->flags_int.short_frames_ok = 0;
1610 /* check if this is a control transfer */
1612 if (xfer->flags_int.control_xfr) {
1614 if (usbd_setup_ctrl_transfer(xfer)) {
1616 usbd_transfer_done(xfer, USB_ERR_STALLED);
1617 USB_BUS_UNLOCK(bus);
1622 * Setup filtered version of some transfer flags,
1623 * in case of data read direction
1625 if (USB_GET_DATA_ISREAD(xfer)) {
1627 if (xfer->flags.short_frames_ok) {
1628 xfer->flags_int.short_xfer_ok = 1;
1629 xfer->flags_int.short_frames_ok = 1;
1630 } else if (xfer->flags.short_xfer_ok) {
1631 xfer->flags_int.short_xfer_ok = 1;
1633 /* check for control transfer */
1634 if (xfer->flags_int.control_xfr) {
1636 * 1) Control transfers do not support
1637 * reception of multiple short USB
1638 * frames in host mode and device side
1639 * mode, with exception of:
1641 * 2) Due to sometimes buggy device
1642 * side firmware we need to do a
1643 * STATUS stage in case of short
1644 * control transfers in USB host mode.
1645 * The STATUS stage then becomes the
1646 * "alt_next" to the DATA stage.
1648 xfer->flags_int.short_frames_ok = 1;
1653 * Check if BUS-DMA support is enabled and try to load virtual
1654 * buffers into DMA, if any:
1657 if (xfer->flags_int.bdma_enable) {
1658 /* insert the USB transfer last in the BUS-DMA queue */
1659 usb_command_wrapper(&xfer->xroot->dma_q, xfer);
1664 * Enter the USB transfer into the Host Controller or
1665 * Device Controller schedule:
1667 usbd_pipe_enter(xfer);
1670 /*------------------------------------------------------------------------*
1671 * usbd_pipe_enter - factored out code
1672 *------------------------------------------------------------------------*/
1674 usbd_pipe_enter(struct usb_xfer *xfer)
1676 struct usb_endpoint *ep;
1679 USB_XFER_LOCK_ASSERT(xfer, MA_OWNED);
1682 USB_BUS_LOCK(xfer->xroot->bus);
1684 ep = xfer->endpoint;
1688 /* enter the transfer */
1689 (ep->methods->enter) (xfer);
1691 xfer->flags_int.can_cancel_immed = 1;
1693 /* check for transfer error */
1695 /* some error has happened */
1696 usbd_transfer_done(xfer, 0);
1697 USB_BUS_UNLOCK(xfer->xroot->bus);
1701 /* start the transfer */
1702 usb_command_wrapper(&ep->endpoint_q, xfer);
1703 USB_BUS_UNLOCK(xfer->xroot->bus);
1706 /*------------------------------------------------------------------------*
1707 * usbd_transfer_start - start an USB transfer
1709 * NOTE: Calling this function more than one time will only
1710 * result in a single transfer start, until the USB transfer
1712 *------------------------------------------------------------------------*/
1714 usbd_transfer_start(struct usb_xfer *xfer)
1717 /* transfer is gone */
1721 USB_XFER_LOCK_ASSERT(xfer, MA_OWNED);
1724 /* mark the USB transfer started */
1726 if (!xfer->flags_int.started) {
1727 /* lock the BUS lock to avoid races updating flags_int */
1728 USB_BUS_LOCK(xfer->xroot->bus);
1729 xfer->flags_int.started = 1;
1730 USB_BUS_UNLOCK(xfer->xroot->bus);
1732 /* check if the USB transfer callback is already transferring */
1734 if (xfer->flags_int.transferring) {
1737 USB_BUS_LOCK(xfer->xroot->bus);
1738 /* call the USB transfer callback */
1739 usbd_callback_ss_done_defer(xfer);
1740 USB_BUS_UNLOCK(xfer->xroot->bus);
1743 /*------------------------------------------------------------------------*
1744 * usbd_transfer_stop - stop an USB transfer
1746 * NOTE: Calling this function more than one time will only
1747 * result in a single transfer stop.
1748 * NOTE: When this function returns it is not safe to free nor
1749 * reuse any DMA buffers. See "usbd_transfer_drain()".
1750 *------------------------------------------------------------------------*/
1752 usbd_transfer_stop(struct usb_xfer *xfer)
1754 struct usb_endpoint *ep;
1757 /* transfer is gone */
1761 USB_XFER_LOCK_ASSERT(xfer, MA_OWNED);
1764 /* check if the USB transfer was ever opened */
1766 if (!xfer->flags_int.open) {
1767 if (xfer->flags_int.started) {
1768 /* nothing to do except clearing the "started" flag */
1769 /* lock the BUS lock to avoid races updating flags_int */
1770 USB_BUS_LOCK(xfer->xroot->bus);
1771 xfer->flags_int.started = 0;
1772 USB_BUS_UNLOCK(xfer->xroot->bus);
1776 /* try to stop the current USB transfer */
1778 USB_BUS_LOCK(xfer->xroot->bus);
1779 /* override any previous error */
1780 xfer->error = USB_ERR_CANCELLED;
1783 * Clear "open" and "started" when both private and USB lock
1784 * is locked so that we don't get a race updating "flags_int"
1786 xfer->flags_int.open = 0;
1787 xfer->flags_int.started = 0;
1790 * Check if we can cancel the USB transfer immediately.
1792 if (xfer->flags_int.transferring) {
1793 if (xfer->flags_int.can_cancel_immed &&
1794 (!xfer->flags_int.did_close)) {
1797 * The following will lead to an USB_ERR_CANCELLED
1798 * error code being passed to the USB callback.
1800 (xfer->endpoint->methods->close) (xfer);
1801 /* only close once */
1802 xfer->flags_int.did_close = 1;
1804 /* need to wait for the next done callback */
1809 /* close here and now */
1810 (xfer->endpoint->methods->close) (xfer);
1813 * Any additional DMA delay is done by
1814 * "usbd_transfer_unsetup()".
1818 * Special case. Check if we need to restart a blocked
1821 ep = xfer->endpoint;
1824 * If the current USB transfer is completing we need
1825 * to start the next one:
1827 if (ep->endpoint_q.curr == xfer) {
1828 usb_command_wrapper(&ep->endpoint_q, NULL);
1832 USB_BUS_UNLOCK(xfer->xroot->bus);
1835 /*------------------------------------------------------------------------*
1836 * usbd_transfer_pending
1838 * This function will check if an USB transfer is pending which is a
1839 * little bit complicated!
1842 * 1: Pending: The USB transfer will receive a callback in the future.
1843 *------------------------------------------------------------------------*/
1845 usbd_transfer_pending(struct usb_xfer *xfer)
1847 struct usb_xfer_root *info;
1848 struct usb_xfer_queue *pq;
1851 /* transfer is gone */
1855 USB_XFER_LOCK_ASSERT(xfer, MA_OWNED);
1858 if (xfer->flags_int.transferring) {
1862 USB_BUS_LOCK(xfer->xroot->bus);
1863 if (xfer->wait_queue) {
1864 /* we are waiting on a queue somewhere */
1865 USB_BUS_UNLOCK(xfer->xroot->bus);
1871 if (pq->curr == xfer) {
1872 /* we are currently scheduled for callback */
1873 USB_BUS_UNLOCK(xfer->xroot->bus);
1876 /* we are not pending */
1877 USB_BUS_UNLOCK(xfer->xroot->bus);
1881 /*------------------------------------------------------------------------*
1882 * usbd_transfer_drain
1884 * This function will stop the USB transfer and wait for any
1885 * additional BUS-DMA and HW-DMA operations to complete. Buffers that
1886 * are loaded into DMA can safely be freed or reused after that this
1887 * function has returned.
1888 *------------------------------------------------------------------------*/
1890 usbd_transfer_drain(struct usb_xfer *xfer)
1893 WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL,
1894 "usbd_transfer_drain can sleep!");
1898 /* transfer is gone */
1901 USB_XFER_LOCK_ASSERT_NOTOWNED(xfer);
1902 USB_XFER_LOCK(xfer);
1904 usbd_transfer_stop(xfer);
1906 while (usbd_transfer_pending(xfer) ||
1907 xfer->flags_int.doing_callback) {
1910 * It is allowed that the callback can drop its
1911 * transfer mutex. In that case checking only
1912 * "usbd_transfer_pending()" is not enough to tell if
1913 * the USB transfer is fully drained. We also need to
1914 * check the internal "doing_callback" flag.
1916 xfer->flags_int.draining = 1;
1919 * Wait until the current outstanding USB
1920 * transfer is complete !
1922 cv_wait(&xfer->xroot->cv_drain, xfer->xroot->xfer_lock);
1924 USB_XFER_UNLOCK(xfer);
1927 struct usb_page_cache *
1928 usbd_xfer_get_frame(struct usb_xfer *xfer, usb_frcount_t frindex)
1930 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
1932 return (&xfer->frbuffers[frindex]);
1935 /*------------------------------------------------------------------------*
1936 * usbd_xfer_get_fps_shift
1938 * The following function is only useful for isochronous transfers. It
1939 * returns how many times the frame execution rate has been shifted
1945 *------------------------------------------------------------------------*/
1947 usbd_xfer_get_fps_shift(struct usb_xfer *xfer)
1949 return (xfer->fps_shift);
1953 usbd_xfer_frame_len(struct usb_xfer *xfer, usb_frcount_t frindex)
1955 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
1957 return (xfer->frlengths[frindex]);
1960 /*------------------------------------------------------------------------*
1961 * usbd_xfer_set_frame_data
1963 * This function sets the pointer of the buffer that should
1964 * loaded directly into DMA for the given USB frame. Passing "ptr"
1965 * equal to NULL while the corresponding "frlength" is greater
1966 * than zero gives undefined results!
1967 *------------------------------------------------------------------------*/
1969 usbd_xfer_set_frame_data(struct usb_xfer *xfer, usb_frcount_t frindex,
1970 void *ptr, usb_frlength_t len)
1972 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
1974 /* set virtual address to load and length */
1975 xfer->frbuffers[frindex].buffer = ptr;
1976 usbd_xfer_set_frame_len(xfer, frindex, len);
1980 usbd_xfer_frame_data(struct usb_xfer *xfer, usb_frcount_t frindex,
1981 void **ptr, int *len)
1983 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
1986 *ptr = xfer->frbuffers[frindex].buffer;
1988 *len = xfer->frlengths[frindex];
1991 /*------------------------------------------------------------------------*
1992 * usbd_xfer_old_frame_length
1994 * This function returns the framelength of the given frame at the
1995 * time the transfer was submitted. This function can be used to
1996 * compute the starting data pointer of the next isochronous frame
1997 * when an isochronous transfer has completed.
1998 *------------------------------------------------------------------------*/
2000 usbd_xfer_old_frame_length(struct usb_xfer *xfer, usb_frcount_t frindex)
2002 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
2004 return (xfer->frlengths[frindex + xfer->max_frame_count]);
2008 usbd_xfer_status(struct usb_xfer *xfer, int *actlen, int *sumlen, int *aframes,
2012 *actlen = xfer->actlen;
2014 *sumlen = xfer->sumlen;
2015 if (aframes != NULL)
2016 *aframes = xfer->aframes;
2017 if (nframes != NULL)
2018 *nframes = xfer->nframes;
2021 /*------------------------------------------------------------------------*
2022 * usbd_xfer_set_frame_offset
2024 * This function sets the frame data buffer offset relative to the beginning
2025 * of the USB DMA buffer allocated for this USB transfer.
2026 *------------------------------------------------------------------------*/
2028 usbd_xfer_set_frame_offset(struct usb_xfer *xfer, usb_frlength_t offset,
2029 usb_frcount_t frindex)
2031 KASSERT(!xfer->flags.ext_buffer, ("Cannot offset data frame "
2032 "when the USB buffer is external\n"));
2033 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
2035 /* set virtual address to load */
2036 xfer->frbuffers[frindex].buffer =
2037 USB_ADD_BYTES(xfer->local_buffer, offset);
2041 usbd_xfer_set_interval(struct usb_xfer *xfer, int i)
2047 usbd_xfer_set_timeout(struct usb_xfer *xfer, int t)
2053 usbd_xfer_set_frames(struct usb_xfer *xfer, usb_frcount_t n)
2059 usbd_xfer_max_frames(struct usb_xfer *xfer)
2061 return (xfer->max_frame_count);
2065 usbd_xfer_max_len(struct usb_xfer *xfer)
2067 return (xfer->max_data_length);
2071 usbd_xfer_max_framelen(struct usb_xfer *xfer)
2073 return (xfer->max_frame_size);
2077 usbd_xfer_set_frame_len(struct usb_xfer *xfer, usb_frcount_t frindex,
2080 KASSERT(frindex < xfer->max_frame_count, ("frame index overflow"));
2082 xfer->frlengths[frindex] = len;
2085 /*------------------------------------------------------------------------*
2086 * usb_callback_proc - factored out code
2088 * This function performs USB callbacks.
2089 *------------------------------------------------------------------------*/
2091 usb_callback_proc(struct usb_proc_msg *_pm)
2093 struct usb_done_msg *pm = (void *)_pm;
2094 struct usb_xfer_root *info = pm->xroot;
2096 /* Change locking order */
2097 USB_BUS_UNLOCK(info->bus);
2100 * We exploit the fact that the mutex is the same for all
2101 * callbacks that will be called from this thread:
2103 lockmgr(info->xfer_lock, LK_EXCLUSIVE);
2104 USB_BUS_LOCK(info->bus);
2106 /* Continue where we lost track */
2107 usb_command_wrapper(&info->done_q,
2110 lockmgr(info->xfer_lock, LK_RELEASE);
2113 /*------------------------------------------------------------------------*
2114 * usbd_callback_ss_done_defer
2116 * This function will defer the start, stop and done callback to the
2118 *------------------------------------------------------------------------*/
2120 usbd_callback_ss_done_defer(struct usb_xfer *xfer)
2122 struct usb_xfer_root *info = xfer->xroot;
2123 struct usb_xfer_queue *pq = &info->done_q;
2125 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2127 if (pq->curr != xfer) {
2128 usbd_transfer_enqueue(pq, xfer);
2130 if (!pq->recurse_1) {
2133 * We have to postpone the callback due to the fact we
2134 * will have a Lock Order Reversal, LOR, if we try to
2137 if (usb_proc_msignal(info->done_p,
2138 &info->done_m[0], &info->done_m[1])) {
2142 /* clear second recurse flag */
2149 /*------------------------------------------------------------------------*
2150 * usbd_callback_wrapper
2152 * This is a wrapper for USB callbacks. This wrapper does some
2153 * auto-magic things like figuring out if we can call the callback
2154 * directly from the current context or if we need to wakeup the
2155 * interrupt process.
2156 *------------------------------------------------------------------------*/
2158 usbd_callback_wrapper(struct usb_xfer_queue *pq)
2160 struct usb_xfer *xfer = pq->curr;
2161 struct usb_xfer_root *info = xfer->xroot;
2163 USB_BUS_LOCK_ASSERT(info->bus);
2164 #if 0 /* XXX: This is probably to prevent deadlocks */
2165 if (!lockstatus(info->xfer_mtx, curthread) && !SCHEDULER_STOPPED()) {
2167 if (!lockstatus(info->xfer_lock, curthread)) {
2169 * Cases that end up here:
2171 * 5) HW interrupt done callback or other source.
2173 DPRINTFN(3, "case 5\n");
2176 * We have to postpone the callback due to the fact we
2177 * will have a Lock Order Reversal, LOR, if we try to
2180 if (usb_proc_msignal(info->done_p,
2181 &info->done_m[0], &info->done_m[1])) {
2187 * Cases that end up here:
2189 * 1) We are starting a transfer
2190 * 2) We are prematurely calling back a transfer
2191 * 3) We are stopping a transfer
2192 * 4) We are doing an ordinary callback
2194 DPRINTFN(3, "case 1-4\n");
2195 /* get next USB transfer in the queue */
2196 info->done_q.curr = NULL;
2198 /* set flag in case of drain */
2199 xfer->flags_int.doing_callback = 1;
2201 USB_BUS_UNLOCK(info->bus);
2202 USB_BUS_LOCK_ASSERT_NOTOWNED(info->bus);
2204 /* set correct USB state for callback */
2205 if (!xfer->flags_int.transferring) {
2206 xfer->usb_state = USB_ST_SETUP;
2207 if (!xfer->flags_int.started) {
2208 /* we got stopped before we even got started */
2209 USB_BUS_LOCK(info->bus);
2214 if (usbd_callback_wrapper_sub(xfer)) {
2215 /* the callback has been deferred */
2216 USB_BUS_LOCK(info->bus);
2220 /* decrement power reference */
2221 usbd_transfer_power_ref(xfer, -1);
2223 xfer->flags_int.transferring = 0;
2226 xfer->usb_state = USB_ST_ERROR;
2228 /* set transferred state */
2229 xfer->usb_state = USB_ST_TRANSFERRED;
2231 /* sync DMA memory, if any */
2232 if (xfer->flags_int.bdma_enable &&
2233 (!xfer->flags_int.bdma_no_post_sync)) {
2234 usb_bdma_post_sync(xfer);
2241 if (xfer->usb_state != USB_ST_SETUP)
2242 usbpf_xfertap(xfer, USBPF_XFERTAP_DONE);
2244 /* call processing routine */
2245 (xfer->callback) (xfer, xfer->error);
2247 /* pickup the USB mutex again */
2248 USB_BUS_LOCK(info->bus);
2251 * Check if we got started after that we got cancelled, but
2252 * before we managed to do the callback.
2254 if ((!xfer->flags_int.open) &&
2255 (xfer->flags_int.started) &&
2256 (xfer->usb_state == USB_ST_ERROR)) {
2257 /* clear flag in case of drain */
2258 xfer->flags_int.doing_callback = 0;
2259 /* try to loop, but not recursivly */
2260 usb_command_wrapper(&info->done_q, xfer);
2265 /* clear flag in case of drain */
2266 xfer->flags_int.doing_callback = 0;
2269 * Check if we are draining.
2271 if (xfer->flags_int.draining &&
2272 (!xfer->flags_int.transferring)) {
2273 /* "usbd_transfer_drain()" is waiting for end of transfer */
2274 xfer->flags_int.draining = 0;
2275 cv_broadcast(&info->cv_drain);
2278 /* do the next callback, if any */
2279 usb_command_wrapper(&info->done_q,
2283 /*------------------------------------------------------------------------*
2284 * usb_dma_delay_done_cb
2286 * This function is called when the DMA delay has been exectuded, and
2287 * will make sure that the callback is called to complete the USB
2288 * transfer. This code path is ususally only used when there is an USB
2289 * error like USB_ERR_CANCELLED.
2290 *------------------------------------------------------------------------*/
2292 usb_dma_delay_done_cb(struct usb_xfer *xfer)
2294 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2296 DPRINTFN(3, "Completed %p\n", xfer);
2298 /* queue callback for execution, again */
2299 usbd_transfer_done(xfer, 0);
2302 /*------------------------------------------------------------------------*
2303 * usbd_transfer_dequeue
2305 * - This function is used to remove an USB transfer from a USB
2308 * - This function can be called multiple times in a row.
2309 *------------------------------------------------------------------------*/
2311 usbd_transfer_dequeue(struct usb_xfer *xfer)
2313 struct usb_xfer_queue *pq;
2315 pq = xfer->wait_queue;
2317 TAILQ_REMOVE(&pq->head, xfer, wait_entry);
2318 xfer->wait_queue = NULL;
2322 /*------------------------------------------------------------------------*
2323 * usbd_transfer_enqueue
2325 * - This function is used to insert an USB transfer into a USB *
2328 * - This function can be called multiple times in a row.
2329 *------------------------------------------------------------------------*/
2331 usbd_transfer_enqueue(struct usb_xfer_queue *pq, struct usb_xfer *xfer)
2334 * Insert the USB transfer into the queue, if it is not
2335 * already on a USB transfer queue:
2337 if (xfer->wait_queue == NULL) {
2338 xfer->wait_queue = pq;
2339 TAILQ_INSERT_TAIL(&pq->head, xfer, wait_entry);
2343 /*------------------------------------------------------------------------*
2344 * usbd_transfer_done
2346 * - This function is used to remove an USB transfer from the busdma,
2347 * pipe or interrupt queue.
2349 * - This function is used to queue the USB transfer on the done
2352 * - This function is used to stop any USB transfer timeouts.
2353 *------------------------------------------------------------------------*/
2355 usbd_transfer_done(struct usb_xfer *xfer, usb_error_t error)
2357 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2359 DPRINTF("err=%s\n", usbd_errstr(error));
2362 * If we are not transferring then just return.
2363 * This can happen during transfer cancel.
2365 if (!xfer->flags_int.transferring) {
2366 DPRINTF("not transferring\n");
2367 /* end of control transfer, if any */
2368 xfer->flags_int.control_act = 0;
2371 /* only set transfer error if not already set */
2373 xfer->error = error;
2375 /* stop any callouts */
2376 usb_callout_stop(&xfer->timeout_handle);
2379 * If we are waiting on a queue, just remove the USB transfer
2380 * from the queue, if any. We should have the required locks
2381 * locked to do the remove when this function is called.
2383 usbd_transfer_dequeue(xfer);
2386 if (lockstatus(xfer->xroot->xfer_lock, curthread)) {
2387 struct usb_xfer_queue *pq;
2390 * If the private USB lock is not locked, then we assume
2391 * that the BUS-DMA load stage has been passed:
2393 pq = &xfer->xroot->dma_q;
2395 if (pq->curr == xfer) {
2396 /* start the next BUS-DMA load, if any */
2397 usb_command_wrapper(pq, NULL);
2401 /* keep some statistics */
2403 xfer->xroot->bus->stats_err.uds_requests
2404 [xfer->endpoint->edesc->bmAttributes & UE_XFERTYPE]++;
2406 xfer->xroot->bus->stats_ok.uds_requests
2407 [xfer->endpoint->edesc->bmAttributes & UE_XFERTYPE]++;
2410 /* call the USB transfer callback */
2411 usbd_callback_ss_done_defer(xfer);
2414 /*------------------------------------------------------------------------*
2415 * usbd_transfer_start_cb
2417 * This function is called to start the USB transfer when
2418 * "xfer->interval" is greater than zero, and and the endpoint type is
2420 *------------------------------------------------------------------------*/
2422 usbd_transfer_start_cb(void *arg)
2424 struct usb_xfer *xfer = arg;
2425 struct usb_endpoint *ep = xfer->endpoint;
2427 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2432 usbpf_xfertap(xfer, USBPF_XFERTAP_SUBMIT);
2434 /* start USB transfer, if no error */
2435 if (xfer->error == 0)
2436 (ep->methods->start) (xfer);
2438 xfer->flags_int.can_cancel_immed = 1;
2440 /* check for error */
2442 /* some error has happened */
2443 usbd_transfer_done(xfer, 0);
2447 /*------------------------------------------------------------------------*
2448 * usbd_xfer_set_stall
2450 * This function is used to set the stall flag outside the
2451 * callback. This function is NULL safe.
2452 *------------------------------------------------------------------------*/
2454 usbd_xfer_set_stall(struct usb_xfer *xfer)
2460 USB_XFER_LOCK_ASSERT(xfer);
2462 /* avoid any races by locking the USB mutex */
2463 USB_BUS_LOCK(xfer->xroot->bus);
2464 xfer->flags.stall_pipe = 1;
2465 USB_BUS_UNLOCK(xfer->xroot->bus);
2469 usbd_xfer_is_stalled(struct usb_xfer *xfer)
2471 return (xfer->endpoint->is_stalled);
2474 /*------------------------------------------------------------------------*
2475 * usbd_transfer_clear_stall
2477 * This function is used to clear the stall flag outside the
2478 * callback. This function is NULL safe.
2479 *------------------------------------------------------------------------*/
2481 usbd_transfer_clear_stall(struct usb_xfer *xfer)
2487 USB_XFER_LOCK_ASSERT(xfer);
2489 /* avoid any races by locking the USB mutex */
2490 USB_BUS_LOCK(xfer->xroot->bus);
2492 xfer->flags.stall_pipe = 0;
2494 USB_BUS_UNLOCK(xfer->xroot->bus);
2497 /*------------------------------------------------------------------------*
2500 * This function is used to add an USB transfer to the pipe transfer list.
2501 *------------------------------------------------------------------------*/
2503 usbd_pipe_start(struct usb_xfer_queue *pq)
2505 struct usb_endpoint *ep;
2506 struct usb_xfer *xfer;
2510 ep = xfer->endpoint;
2512 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2515 * If the endpoint is already stalled we do nothing !
2517 if (ep->is_stalled) {
2521 * Check if we are supposed to stall the endpoint:
2523 if (xfer->flags.stall_pipe) {
2524 struct usb_device *udev;
2525 struct usb_xfer_root *info;
2527 /* clear stall command */
2528 xfer->flags.stall_pipe = 0;
2530 /* get pointer to USB device */
2535 * Only stall BULK and INTERRUPT endpoints.
2537 type = (ep->edesc->bmAttributes & UE_XFERTYPE);
2538 if ((type == UE_BULK) ||
2539 (type == UE_INTERRUPT)) {
2544 if (udev->flags.usb_mode == USB_MODE_DEVICE) {
2545 (udev->bus->methods->set_stall) (
2546 udev, NULL, ep, &did_stall);
2547 } else if (udev->ctrl_xfer[1]) {
2548 info = udev->ctrl_xfer[1]->xroot;
2550 &info->bus->non_giant_callback_proc,
2551 &udev->cs_msg[0], &udev->cs_msg[1]);
2553 /* should not happen */
2554 DPRINTFN(0, "No stall handler\n");
2557 * Check if we should stall. Some USB hardware
2558 * handles set- and clear-stall in hardware.
2562 * The transfer will be continued when
2563 * the clear-stall control endpoint
2564 * message is received.
2569 } else if (type == UE_ISOCHRONOUS) {
2572 * Make sure any FIFO overflow or other FIFO
2573 * error conditions go away by resetting the
2574 * endpoint FIFO through the clear stall
2577 if (udev->flags.usb_mode == USB_MODE_DEVICE) {
2578 (udev->bus->methods->clear_stall) (udev, ep);
2582 /* Set or clear stall complete - special case */
2583 if (xfer->nframes == 0) {
2584 /* we are complete */
2586 usbd_transfer_done(xfer, 0);
2592 * 1) Start the first transfer queued.
2594 * 2) Re-start the current USB transfer.
2597 * Check if there should be any
2598 * pre transfer start delay:
2600 if (xfer->interval > 0) {
2601 type = (ep->edesc->bmAttributes & UE_XFERTYPE);
2602 if ((type == UE_BULK) ||
2603 (type == UE_CONTROL)) {
2604 usbd_transfer_timeout_ms(xfer,
2605 &usbd_transfer_start_cb,
2613 usbpf_xfertap(xfer, USBPF_XFERTAP_SUBMIT);
2615 /* start USB transfer, if no error */
2616 if (xfer->error == 0)
2617 (ep->methods->start) (xfer);
2619 xfer->flags_int.can_cancel_immed = 1;
2621 /* check for error */
2623 /* some error has happened */
2624 usbd_transfer_done(xfer, 0);
2628 /*------------------------------------------------------------------------*
2629 * usbd_transfer_timeout_ms
2631 * This function is used to setup a timeout on the given USB
2632 * transfer. If the timeout has been deferred the callback given by
2633 * "cb" will get called after "ms" milliseconds.
2634 *------------------------------------------------------------------------*/
2636 usbd_transfer_timeout_ms(struct usb_xfer *xfer,
2637 void (*cb) (void *arg), usb_timeout_t ms)
2639 USB_BUS_LOCK_ASSERT(xfer->xroot->bus);
2642 usb_callout_reset(&xfer->timeout_handle,
2643 USB_MS_TO_TICKS(ms), cb, xfer);
2646 /*------------------------------------------------------------------------*
2647 * usbd_callback_wrapper_sub
2649 * - This function will update variables in an USB transfer after
2650 * that the USB transfer is complete.
2652 * - This function is used to start the next USB transfer on the
2653 * ep transfer queue, if any.
2655 * NOTE: In some special cases the USB transfer will not be removed from
2656 * the pipe queue, but remain first. To enforce USB transfer removal call
2657 * this function passing the error code "USB_ERR_CANCELLED".
2661 * Else: The callback has been deferred.
2662 *------------------------------------------------------------------------*/
2664 usbd_callback_wrapper_sub(struct usb_xfer *xfer)
2666 struct usb_endpoint *ep;
2667 struct usb_bus *bus;
2670 bus = xfer->xroot->bus;
2672 if ((!xfer->flags_int.open) &&
2673 (!xfer->flags_int.did_close)) {
2676 (xfer->endpoint->methods->close) (xfer);
2677 USB_BUS_UNLOCK(bus);
2678 /* only close once */
2679 xfer->flags_int.did_close = 1;
2680 return (1); /* wait for new callback */
2683 * If we have a non-hardware induced error we
2684 * need to do the DMA delay!
2686 if (xfer->error != 0 && !xfer->flags_int.did_dma_delay &&
2687 (xfer->error == USB_ERR_CANCELLED ||
2688 xfer->error == USB_ERR_TIMEOUT ||
2689 bus->methods->start_dma_delay != NULL)) {
2693 /* only delay once */
2694 xfer->flags_int.did_dma_delay = 1;
2696 /* we can not cancel this delay */
2697 xfer->flags_int.can_cancel_immed = 0;
2699 temp = usbd_get_dma_delay(xfer->xroot->udev);
2701 DPRINTFN(3, "DMA delay, %u ms, "
2702 "on %p\n", temp, xfer);
2707 * Some hardware solutions have dedicated
2708 * events when it is safe to free DMA'ed
2709 * memory. For the other hardware platforms we
2710 * use a static delay.
2712 if (bus->methods->start_dma_delay != NULL) {
2713 (bus->methods->start_dma_delay) (xfer);
2715 usbd_transfer_timeout_ms(xfer,
2716 (void *)&usb_dma_delay_done_cb, temp);
2718 USB_BUS_UNLOCK(bus);
2719 return (1); /* wait for new callback */
2722 /* check actual number of frames */
2723 if (xfer->aframes > xfer->nframes) {
2724 if (xfer->error == 0) {
2725 panic("%s: actual number of frames, %d, is "
2726 "greater than initial number of frames, %d\n",
2727 __FUNCTION__, xfer->aframes, xfer->nframes);
2729 /* just set some valid value */
2730 xfer->aframes = xfer->nframes;
2733 /* compute actual length */
2736 for (x = 0; x != xfer->aframes; x++) {
2737 xfer->actlen += xfer->frlengths[x];
2741 * Frames that were not transferred get zero actual length in
2742 * case the USB device driver does not check the actual number
2743 * of frames transferred, "xfer->aframes":
2745 for (; x < xfer->nframes; x++) {
2746 usbd_xfer_set_frame_len(xfer, x, 0);
2749 /* check actual length */
2750 if (xfer->actlen > xfer->sumlen) {
2751 if (xfer->error == 0) {
2752 panic("%s: actual length, %d, is greater than "
2753 "initial length, %d\n",
2754 __FUNCTION__, xfer->actlen, xfer->sumlen);
2756 /* just set some valid value */
2757 xfer->actlen = xfer->sumlen;
2760 DPRINTFN(1, "xfer=%p endpoint=%p sts=%d alen=%d, slen=%d, afrm=%d, nfrm=%d\n",
2761 xfer, xfer->endpoint, xfer->error, xfer->actlen, xfer->sumlen,
2762 xfer->aframes, xfer->nframes);
2765 /* end of control transfer, if any */
2766 xfer->flags_int.control_act = 0;
2768 /* check if we should block the execution queue */
2769 if ((xfer->error != USB_ERR_CANCELLED) &&
2770 (xfer->flags.pipe_bof)) {
2771 DPRINTFN(2, "xfer=%p: Block On Failure "
2772 "on endpoint=%p\n", xfer, xfer->endpoint);
2776 /* check for short transfers */
2777 if (xfer->actlen < xfer->sumlen) {
2779 /* end of control transfer, if any */
2780 xfer->flags_int.control_act = 0;
2782 if (!xfer->flags_int.short_xfer_ok) {
2783 xfer->error = USB_ERR_SHORT_XFER;
2784 if (xfer->flags.pipe_bof) {
2785 DPRINTFN(2, "xfer=%p: Block On Failure on "
2786 "Short Transfer on endpoint %p.\n",
2787 xfer, xfer->endpoint);
2793 * Check if we are in the middle of a
2796 if (xfer->flags_int.control_act) {
2797 DPRINTFN(5, "xfer=%p: Control transfer "
2798 "active on endpoint=%p\n", xfer, xfer->endpoint);
2804 ep = xfer->endpoint;
2807 * If the current USB transfer is completing we need to start the
2811 if (ep->endpoint_q.curr == xfer) {
2812 usb_command_wrapper(&ep->endpoint_q, NULL);
2814 if (ep->endpoint_q.curr || TAILQ_FIRST(&ep->endpoint_q.head)) {
2815 /* there is another USB transfer waiting */
2817 /* this is the last USB transfer */
2818 /* clear isochronous sync flag */
2819 xfer->endpoint->is_synced = 0;
2822 USB_BUS_UNLOCK(bus);
2827 /*------------------------------------------------------------------------*
2828 * usb_command_wrapper
2830 * This function is used to execute commands non-recursivly on an USB
2832 *------------------------------------------------------------------------*/
2834 usb_command_wrapper(struct usb_xfer_queue *pq, struct usb_xfer *xfer)
2838 * If the transfer is not already processing,
2841 if (pq->curr != xfer) {
2842 usbd_transfer_enqueue(pq, xfer);
2843 if (pq->curr != NULL) {
2844 /* something is already processing */
2845 DPRINTFN(6, "busy %p\n", pq->curr);
2850 /* Get next element in queue */
2854 if (!pq->recurse_1) {
2858 /* set both recurse flags */
2862 if (pq->curr == NULL) {
2863 xfer = TAILQ_FIRST(&pq->head);
2865 TAILQ_REMOVE(&pq->head, xfer,
2867 xfer->wait_queue = NULL;
2873 DPRINTFN(6, "cb %p (enter)\n", pq->curr);
2875 DPRINTFN(6, "cb %p (leave)\n", pq->curr);
2877 } while (!pq->recurse_2);
2879 /* clear first recurse flag */
2883 /* clear second recurse flag */
2888 /*------------------------------------------------------------------------*
2889 * usbd_ctrl_transfer_setup
2891 * This function is used to setup the default USB control endpoint
2893 *------------------------------------------------------------------------*/
2895 usbd_ctrl_transfer_setup(struct usb_device *udev)
2897 struct usb_xfer *xfer;
2899 uint8_t iface_index;
2901 /* check for root HUB */
2902 if (udev->parent_hub == NULL)
2906 xfer = udev->ctrl_xfer[0];
2908 USB_XFER_LOCK(xfer);
2910 ((xfer->address == udev->address) &&
2911 (udev->ctrl_ep_desc.wMaxPacketSize[0] ==
2912 udev->ddesc.bMaxPacketSize));
2913 if (udev->flags.usb_mode == USB_MODE_DEVICE) {
2916 * NOTE: checking "xfer->address" and
2917 * starting the USB transfer must be
2920 usbd_transfer_start(xfer);
2923 USB_XFER_UNLOCK(xfer);
2930 * All parameters are exactly the same like before.
2936 * Update wMaxPacketSize for the default control endpoint:
2938 udev->ctrl_ep_desc.wMaxPacketSize[0] =
2939 udev->ddesc.bMaxPacketSize;
2942 * Unsetup any existing USB transfer:
2944 usbd_transfer_unsetup(udev->ctrl_xfer, USB_CTRL_XFER_MAX);
2947 * Reset clear stall error counter.
2949 udev->clear_stall_errors = 0;
2952 * Try to setup a new USB transfer for the
2953 * default control endpoint:
2956 if (usbd_transfer_setup(udev, &iface_index,
2957 udev->ctrl_xfer, usb_control_ep_cfg, USB_CTRL_XFER_MAX, NULL,
2958 &udev->device_lock)) {
2959 DPRINTFN(0, "could not setup default "
2966 /*------------------------------------------------------------------------*
2967 * usbd_clear_data_toggle - factored out code
2969 * NOTE: the intention of this function is not to reset the hardware
2971 *------------------------------------------------------------------------*/
2973 usbd_clear_stall_locked(struct usb_device *udev, struct usb_endpoint *ep)
2975 USB_BUS_LOCK_ASSERT(udev->bus);
2977 /* check that we have a valid case */
2978 if (udev->flags.usb_mode == USB_MODE_HOST &&
2979 udev->parent_hub != NULL &&
2980 udev->bus->methods->clear_stall != NULL &&
2981 ep->methods != NULL) {
2982 (udev->bus->methods->clear_stall) (udev, ep);
2986 /*------------------------------------------------------------------------*
2987 * usbd_clear_data_toggle - factored out code
2989 * NOTE: the intention of this function is not to reset the hardware
2990 * data toggle on the USB device side.
2991 *------------------------------------------------------------------------*/
2993 usbd_clear_data_toggle(struct usb_device *udev, struct usb_endpoint *ep)
2995 DPRINTFN(5, "udev=%p endpoint=%p\n", udev, ep);
2997 USB_BUS_LOCK(udev->bus);
2998 ep->toggle_next = 0;
2999 /* some hardware needs a callback to clear the data toggle */
3000 usbd_clear_stall_locked(udev, ep);
3001 USB_BUS_UNLOCK(udev->bus);
3004 /*------------------------------------------------------------------------*
3005 * usbd_clear_stall_callback - factored out clear stall callback
3008 * xfer1: Clear Stall Control Transfer
3009 * xfer2: Stalled USB Transfer
3011 * This function is NULL safe.
3017 * Clear stall config example:
3019 * static const struct usb_config my_clearstall = {
3020 * .type = UE_CONTROL,
3022 * .direction = UE_DIR_ANY,
3023 * .interval = 50, //50 milliseconds
3024 * .bufsize = sizeof(struct usb_device_request),
3025 * .timeout = 1000, //1.000 seconds
3026 * .callback = &my_clear_stall_callback, // **
3027 * .usb_mode = USB_MODE_HOST,
3030 * ** "my_clear_stall_callback" calls "usbd_clear_stall_callback"
3031 * passing the correct parameters.
3032 *------------------------------------------------------------------------*/
3034 usbd_clear_stall_callback(struct usb_xfer *xfer1,
3035 struct usb_xfer *xfer2)
3037 struct usb_device_request req;
3039 if (xfer2 == NULL) {
3040 /* looks like we are tearing down */
3041 DPRINTF("NULL input parameter\n");
3044 USB_XFER_LOCK_ASSERT(xfer1);
3045 USB_XFER_LOCK_ASSERT(xfer2);
3047 switch (USB_GET_STATE(xfer1)) {
3051 * pre-clear the data toggle to DATA0 ("umass.c" and
3052 * "ata-usb.c" depends on this)
3055 usbd_clear_data_toggle(xfer2->xroot->udev, xfer2->endpoint);
3057 /* setup a clear-stall packet */
3059 req.bmRequestType = UT_WRITE_ENDPOINT;
3060 req.bRequest = UR_CLEAR_FEATURE;
3061 USETW(req.wValue, UF_ENDPOINT_HALT);
3062 req.wIndex[0] = xfer2->endpoint->edesc->bEndpointAddress;
3064 USETW(req.wLength, 0);
3067 * "usbd_transfer_setup_sub()" will ensure that
3068 * we have sufficient room in the buffer for
3069 * the request structure!
3072 /* copy in the transfer */
3074 usbd_copy_in(xfer1->frbuffers, 0, &req, sizeof(req));
3077 xfer1->frlengths[0] = sizeof(req);
3080 usbd_transfer_submit(xfer1);
3083 case USB_ST_TRANSFERRED:
3086 default: /* Error */
3087 if (xfer1->error == USB_ERR_CANCELLED) {
3092 return (1); /* Clear Stall Finished */
3095 /*------------------------------------------------------------------------*
3096 * usbd_transfer_poll
3098 * The following function gets called from the USB keyboard driver and
3099 * UMASS when the system has paniced.
3101 * NOTE: It is currently not possible to resume normal operation on
3102 * the USB controller which has been polled, due to clearing of the
3103 * "up_dsleep" and "up_msleep" flags.
3104 *------------------------------------------------------------------------*/
3106 usbd_transfer_poll(struct usb_xfer **ppxfer, uint16_t max)
3108 struct usb_xfer *xfer;
3109 struct usb_xfer_root *xroot;
3110 struct usb_device *udev;
3111 struct usb_proc_msg *pm;
3116 for (n = 0; n != max; n++) {
3117 /* Extra checks to avoid panic */
3120 continue; /* no USB transfer */
3121 xroot = xfer->xroot;
3123 continue; /* no USB root */
3126 continue; /* no USB device */
3127 if (udev->bus == NULL)
3128 continue; /* no BUS structure */
3129 if (udev->bus->methods == NULL)
3130 continue; /* no BUS methods */
3131 if (udev->bus->methods->xfer_poll == NULL)
3132 continue; /* no poll method */
3134 /* make sure that the BUS mutex is not locked */
3137 while (lockstatus(&xroot->udev->bus->bus_lock, curthread) && !SCHEDULER_STOPPED()) {
3139 while (lockstatus(&xroot->udev->bus->bus_lock, curthread)) {
3140 lockmgr(&xroot->udev->bus->bus_lock, LK_RELEASE);
3144 /* make sure that the transfer mutex is not locked */
3147 while (lockstatus(xroot->xfer_lock, curthread) && !SCHEDULER_STOPPED()) {
3149 while (lockstatus(xroot->xfer_lock, curthread)) {
3150 lockmgr(xroot->xfer_lock, LK_RELEASE);
3154 /* Make sure cv_signal() and cv_broadcast() is not called */
3155 udev->bus->control_xfer_proc.up_msleep = 0;
3156 udev->bus->explore_proc.up_msleep = 0;
3157 udev->bus->giant_callback_proc.up_msleep = 0;
3158 udev->bus->non_giant_callback_proc.up_msleep = 0;
3160 /* poll USB hardware */
3161 (udev->bus->methods->xfer_poll) (udev->bus);
3163 USB_BUS_LOCK(xroot->bus);
3165 /* check for clear stall */
3166 if (udev->ctrl_xfer[1] != NULL) {
3168 /* poll clear stall start */
3169 pm = &udev->cs_msg[0].hdr;
3170 (pm->pm_callback) (pm);
3171 /* poll clear stall done thread */
3172 pm = &udev->ctrl_xfer[1]->
3173 xroot->done_m[0].hdr;
3174 (pm->pm_callback) (pm);
3177 /* poll done thread */
3178 pm = &xroot->done_m[0].hdr;
3179 (pm->pm_callback) (pm);
3181 USB_BUS_UNLOCK(xroot->bus);
3183 /* restore transfer mutex */
3185 lockmgr(xroot->xfer_lock, LK_EXCLUSIVE);
3187 /* restore BUS mutex */
3189 lockmgr(&xroot->udev->bus->bus_lock, LK_EXCLUSIVE);
3194 usbd_get_std_packet_size(struct usb_std_packet_size *ptr,
3195 uint8_t type, enum usb_dev_speed speed)
3197 static const uint16_t intr_range_max[USB_SPEED_MAX] = {
3198 [USB_SPEED_LOW] = 8,
3199 [USB_SPEED_FULL] = 64,
3200 [USB_SPEED_HIGH] = 1024,
3201 [USB_SPEED_VARIABLE] = 1024,
3202 [USB_SPEED_SUPER] = 1024,
3205 static const uint16_t isoc_range_max[USB_SPEED_MAX] = {
3206 [USB_SPEED_LOW] = 0, /* invalid */
3207 [USB_SPEED_FULL] = 1023,
3208 [USB_SPEED_HIGH] = 1024,
3209 [USB_SPEED_VARIABLE] = 3584,
3210 [USB_SPEED_SUPER] = 1024,
3213 static const uint16_t control_min[USB_SPEED_MAX] = {
3214 [USB_SPEED_LOW] = 8,
3215 [USB_SPEED_FULL] = 8,
3216 [USB_SPEED_HIGH] = 64,
3217 [USB_SPEED_VARIABLE] = 512,
3218 [USB_SPEED_SUPER] = 512,
3221 static const uint16_t bulk_min[USB_SPEED_MAX] = {
3222 [USB_SPEED_LOW] = 8,
3223 [USB_SPEED_FULL] = 8,
3224 [USB_SPEED_HIGH] = 512,
3225 [USB_SPEED_VARIABLE] = 512,
3226 [USB_SPEED_SUPER] = 1024,
3231 memset(ptr, 0, sizeof(*ptr));
3235 ptr->range.max = intr_range_max[speed];
3237 case UE_ISOCHRONOUS:
3238 ptr->range.max = isoc_range_max[speed];
3241 if (type == UE_BULK)
3242 temp = bulk_min[speed];
3243 else /* UE_CONTROL */
3244 temp = control_min[speed];
3246 /* default is fixed */
3247 ptr->fixed[0] = temp;
3248 ptr->fixed[1] = temp;
3249 ptr->fixed[2] = temp;
3250 ptr->fixed[3] = temp;
3252 if (speed == USB_SPEED_FULL) {
3253 /* multiple sizes */
3258 if ((speed == USB_SPEED_VARIABLE) &&
3259 (type == UE_BULK)) {
3260 /* multiple sizes */
3261 ptr->fixed[2] = 1024;
3262 ptr->fixed[3] = 1536;
3269 usbd_xfer_softc(struct usb_xfer *xfer)
3271 return (xfer->priv_sc);
3275 usbd_xfer_get_priv(struct usb_xfer *xfer)
3277 return (xfer->priv_fifo);
3281 usbd_xfer_set_priv(struct usb_xfer *xfer, void *ptr)
3283 xfer->priv_fifo = ptr;
3287 usbd_xfer_state(struct usb_xfer *xfer)
3289 return (xfer->usb_state);
3293 usbd_xfer_set_flag(struct usb_xfer *xfer, int flag)
3296 case USB_FORCE_SHORT_XFER:
3297 xfer->flags.force_short_xfer = 1;
3299 case USB_SHORT_XFER_OK:
3300 xfer->flags.short_xfer_ok = 1;
3302 case USB_MULTI_SHORT_OK:
3303 xfer->flags.short_frames_ok = 1;
3305 case USB_MANUAL_STATUS:
3306 xfer->flags.manual_status = 1;
3312 usbd_xfer_clr_flag(struct usb_xfer *xfer, int flag)
3315 case USB_FORCE_SHORT_XFER:
3316 xfer->flags.force_short_xfer = 0;
3318 case USB_SHORT_XFER_OK:
3319 xfer->flags.short_xfer_ok = 0;
3321 case USB_MULTI_SHORT_OK:
3322 xfer->flags.short_frames_ok = 0;
3324 case USB_MANUAL_STATUS:
3325 xfer->flags.manual_status = 0;
3331 * The following function returns in milliseconds when the isochronous
3332 * transfer was completed by the hardware. The returned value wraps
3333 * around 65536 milliseconds.
3336 usbd_xfer_get_timestamp(struct usb_xfer *xfer)
3338 return (xfer->isoc_time_complete);