102ac6454SAndrew Thompson /* $FreeBSD$ */ 202ac6454SAndrew Thompson /*- 302ac6454SAndrew Thompson * Copyright (c) 2008 Hans Petter Selasky. All rights reserved. 402ac6454SAndrew Thompson * 502ac6454SAndrew Thompson * Redistribution and use in source and binary forms, with or without 602ac6454SAndrew Thompson * modification, are permitted provided that the following conditions 702ac6454SAndrew Thompson * are met: 802ac6454SAndrew Thompson * 1. Redistributions of source code must retain the above copyright 902ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer. 1002ac6454SAndrew Thompson * 2. Redistributions in binary form must reproduce the above copyright 1102ac6454SAndrew Thompson * notice, this list of conditions and the following disclaimer in the 1202ac6454SAndrew Thompson * documentation and/or other materials provided with the distribution. 1302ac6454SAndrew Thompson * 1402ac6454SAndrew Thompson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1502ac6454SAndrew Thompson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1602ac6454SAndrew Thompson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1702ac6454SAndrew Thompson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1802ac6454SAndrew Thompson * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1902ac6454SAndrew Thompson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2002ac6454SAndrew Thompson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2102ac6454SAndrew Thompson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2202ac6454SAndrew Thompson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2302ac6454SAndrew Thompson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2402ac6454SAndrew Thompson * SUCH DAMAGE. 2502ac6454SAndrew Thompson */ 2602ac6454SAndrew Thompson 27ed6d949aSAndrew Thompson #include <sys/stdint.h> 28ed6d949aSAndrew Thompson #include <sys/stddef.h> 29ed6d949aSAndrew Thompson #include <sys/param.h> 30ed6d949aSAndrew Thompson #include <sys/queue.h> 31ed6d949aSAndrew Thompson #include <sys/types.h> 32ed6d949aSAndrew Thompson #include <sys/systm.h> 33ed6d949aSAndrew Thompson #include <sys/kernel.h> 34ed6d949aSAndrew Thompson #include <sys/bus.h> 35ed6d949aSAndrew Thompson #include <sys/module.h> 36ed6d949aSAndrew Thompson #include <sys/lock.h> 37ed6d949aSAndrew Thompson #include <sys/mutex.h> 38ed6d949aSAndrew Thompson #include <sys/condvar.h> 39ed6d949aSAndrew Thompson #include <sys/sysctl.h> 40ed6d949aSAndrew Thompson #include <sys/sx.h> 41ed6d949aSAndrew Thompson #include <sys/unistd.h> 42ed6d949aSAndrew Thompson #include <sys/callout.h> 43ed6d949aSAndrew Thompson #include <sys/malloc.h> 44ed6d949aSAndrew Thompson #include <sys/priv.h> 455d7380f8SAttilio Rao #include <sys/proc.h> 46ed6d949aSAndrew Thompson 4702ac6454SAndrew Thompson #include <dev/usb/usb.h> 48ed6d949aSAndrew Thompson #include <dev/usb/usbdi.h> 49ed6d949aSAndrew Thompson #include <dev/usb/usbdi_util.h> 5002ac6454SAndrew Thompson 51a593f6b8SAndrew Thompson #define USB_DEBUG_VAR usb_debug 5202ac6454SAndrew Thompson 5302ac6454SAndrew Thompson #include <dev/usb/usb_core.h> 5402ac6454SAndrew Thompson #include <dev/usb/usb_busdma.h> 5502ac6454SAndrew Thompson #include <dev/usb/usb_process.h> 5602ac6454SAndrew Thompson #include <dev/usb/usb_transfer.h> 5702ac6454SAndrew Thompson #include <dev/usb/usb_device.h> 5802ac6454SAndrew Thompson #include <dev/usb/usb_debug.h> 5902ac6454SAndrew Thompson #include <dev/usb/usb_util.h> 6002ac6454SAndrew Thompson 6102ac6454SAndrew Thompson #include <dev/usb/usb_controller.h> 6202ac6454SAndrew Thompson #include <dev/usb/usb_bus.h> 6318ec6525SWeongyo Jeong #include <dev/usb/usb_pf.h> 6402ac6454SAndrew Thompson 65a593f6b8SAndrew Thompson struct usb_std_packet_size { 6602ac6454SAndrew Thompson struct { 6702ac6454SAndrew Thompson uint16_t min; /* inclusive */ 6802ac6454SAndrew Thompson uint16_t max; /* inclusive */ 6902ac6454SAndrew Thompson } range; 7002ac6454SAndrew Thompson 7102ac6454SAndrew Thompson uint16_t fixed[4]; 7202ac6454SAndrew Thompson }; 7302ac6454SAndrew Thompson 74a593f6b8SAndrew Thompson static usb_callback_t usb_request_callback; 7502ac6454SAndrew Thompson 765b3bb704SAndrew Thompson static const struct usb_config usb_control_ep_cfg[USB_CTRL_XFER_MAX] = { 7702ac6454SAndrew Thompson 7802ac6454SAndrew Thompson /* This transfer is used for generic control endpoint transfers */ 7902ac6454SAndrew Thompson 8002ac6454SAndrew Thompson [0] = { 8102ac6454SAndrew Thompson .type = UE_CONTROL, 8202ac6454SAndrew Thompson .endpoint = 0x00, /* Control endpoint */ 8302ac6454SAndrew Thompson .direction = UE_DIR_ANY, 844eae601eSAndrew Thompson .bufsize = USB_EP0_BUFSIZE, /* bytes */ 854eae601eSAndrew Thompson .flags = {.proxy_buffer = 1,}, 86a593f6b8SAndrew Thompson .callback = &usb_request_callback, 87f29a0724SAndrew Thompson .usb_mode = USB_MODE_DUAL, /* both modes */ 8802ac6454SAndrew Thompson }, 8902ac6454SAndrew Thompson 9002ac6454SAndrew Thompson /* This transfer is used for generic clear stall only */ 9102ac6454SAndrew Thompson 9202ac6454SAndrew Thompson [1] = { 9302ac6454SAndrew Thompson .type = UE_CONTROL, 9402ac6454SAndrew Thompson .endpoint = 0x00, /* Control pipe */ 9502ac6454SAndrew Thompson .direction = UE_DIR_ANY, 96760bc48eSAndrew Thompson .bufsize = sizeof(struct usb_device_request), 97a593f6b8SAndrew Thompson .callback = &usb_do_clear_stall_callback, 984eae601eSAndrew Thompson .timeout = 1000, /* 1 second */ 994eae601eSAndrew Thompson .interval = 50, /* 50ms */ 1004eae601eSAndrew Thompson .usb_mode = USB_MODE_HOST, 10102ac6454SAndrew Thompson }, 10202ac6454SAndrew Thompson }; 10302ac6454SAndrew Thompson 10402ac6454SAndrew Thompson /* function prototypes */ 10502ac6454SAndrew Thompson 106a593f6b8SAndrew Thompson static void usbd_update_max_frame_size(struct usb_xfer *); 107a593f6b8SAndrew Thompson static void usbd_transfer_unsetup_sub(struct usb_xfer_root *, uint8_t); 108a593f6b8SAndrew Thompson static void usbd_control_transfer_init(struct usb_xfer *); 109ed6d949aSAndrew Thompson static int usbd_setup_ctrl_transfer(struct usb_xfer *); 110a593f6b8SAndrew Thompson static void usb_callback_proc(struct usb_proc_msg *); 111a593f6b8SAndrew Thompson static void usbd_callback_ss_done_defer(struct usb_xfer *); 112a593f6b8SAndrew Thompson static void usbd_callback_wrapper(struct usb_xfer_queue *); 113a593f6b8SAndrew Thompson static void usbd_transfer_start_cb(void *); 114a593f6b8SAndrew Thompson static uint8_t usbd_callback_wrapper_sub(struct usb_xfer *); 115a593f6b8SAndrew Thompson static void usbd_get_std_packet_size(struct usb_std_packet_size *ptr, 1168d2dd5ddSAndrew Thompson uint8_t type, enum usb_dev_speed speed); 1174eae601eSAndrew Thompson 1184eae601eSAndrew Thompson /*------------------------------------------------------------------------* 119a593f6b8SAndrew Thompson * usb_request_callback 1204eae601eSAndrew Thompson *------------------------------------------------------------------------*/ 1214eae601eSAndrew Thompson static void 122ed6d949aSAndrew Thompson usb_request_callback(struct usb_xfer *xfer, usb_error_t error) 1234eae601eSAndrew Thompson { 124f29a0724SAndrew Thompson if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) 125ed6d949aSAndrew Thompson usb_handle_request_callback(xfer, error); 1264eae601eSAndrew Thompson else 127ed6d949aSAndrew Thompson usbd_do_request_callback(xfer, error); 1284eae601eSAndrew Thompson } 12902ac6454SAndrew Thompson 13002ac6454SAndrew Thompson /*------------------------------------------------------------------------* 131a593f6b8SAndrew Thompson * usbd_update_max_frame_size 13202ac6454SAndrew Thompson * 13302ac6454SAndrew Thompson * This function updates the maximum frame size, hence high speed USB 13402ac6454SAndrew Thompson * can transfer multiple consecutive packets. 13502ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 13602ac6454SAndrew Thompson static void 137a593f6b8SAndrew Thompson usbd_update_max_frame_size(struct usb_xfer *xfer) 13802ac6454SAndrew Thompson { 13902ac6454SAndrew Thompson /* compute maximum frame size */ 140963169b4SHans Petter Selasky /* this computation should not overflow 16-bit */ 141963169b4SHans Petter Selasky /* max = 15 * 1024 */ 14202ac6454SAndrew Thompson 143963169b4SHans Petter Selasky xfer->max_frame_size = xfer->max_packet_size * xfer->max_packet_count; 14402ac6454SAndrew Thompson } 14502ac6454SAndrew Thompson 14602ac6454SAndrew Thompson /*------------------------------------------------------------------------* 147a593f6b8SAndrew Thompson * usbd_get_dma_delay 14802ac6454SAndrew Thompson * 14902ac6454SAndrew Thompson * The following function is called when we need to 15002ac6454SAndrew Thompson * synchronize with DMA hardware. 15102ac6454SAndrew Thompson * 15202ac6454SAndrew Thompson * Returns: 15302ac6454SAndrew Thompson * 0: no DMA delay required 15402ac6454SAndrew Thompson * Else: milliseconds of DMA delay 15502ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 156e0a69b51SAndrew Thompson usb_timeout_t 157527aa7b2SAndrew Thompson usbd_get_dma_delay(struct usb_device *udev) 15802ac6454SAndrew Thompson { 159527aa7b2SAndrew Thompson struct usb_bus_methods *mtod; 160527aa7b2SAndrew Thompson uint32_t temp; 16102ac6454SAndrew Thompson 162527aa7b2SAndrew Thompson mtod = udev->bus->methods; 163527aa7b2SAndrew Thompson temp = 0; 164527aa7b2SAndrew Thompson 165527aa7b2SAndrew Thompson if (mtod->get_dma_delay) { 166527aa7b2SAndrew Thompson (mtod->get_dma_delay) (udev, &temp); 16702ac6454SAndrew Thompson /* 16802ac6454SAndrew Thompson * Round up and convert to milliseconds. Note that we use 16902ac6454SAndrew Thompson * 1024 milliseconds per second. to save a division. 17002ac6454SAndrew Thompson */ 17102ac6454SAndrew Thompson temp += 0x3FF; 17202ac6454SAndrew Thompson temp /= 0x400; 17302ac6454SAndrew Thompson } 17402ac6454SAndrew Thompson return (temp); 17502ac6454SAndrew Thompson } 17602ac6454SAndrew Thompson 17702ac6454SAndrew Thompson /*------------------------------------------------------------------------* 178a593f6b8SAndrew Thompson * usbd_transfer_setup_sub_malloc 17902ac6454SAndrew Thompson * 18002ac6454SAndrew Thompson * This function will allocate one or more DMA'able memory chunks 18102ac6454SAndrew Thompson * according to "size", "align" and "count" arguments. "ppc" is 18202ac6454SAndrew Thompson * pointed to a linear array of USB page caches afterwards. 18302ac6454SAndrew Thompson * 18402ac6454SAndrew Thompson * Returns: 18502ac6454SAndrew Thompson * 0: Success 18602ac6454SAndrew Thompson * Else: Failure 18702ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 188bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 18902ac6454SAndrew Thompson uint8_t 190a593f6b8SAndrew Thompson usbd_transfer_setup_sub_malloc(struct usb_setup_params *parm, 191f9cb546cSAndrew Thompson struct usb_page_cache **ppc, usb_size_t size, usb_size_t align, 192f9cb546cSAndrew Thompson usb_size_t count) 19302ac6454SAndrew Thompson { 194760bc48eSAndrew Thompson struct usb_page_cache *pc; 195760bc48eSAndrew Thompson struct usb_page *pg; 19602ac6454SAndrew Thompson void *buf; 197f9cb546cSAndrew Thompson usb_size_t n_dma_pc; 198f9cb546cSAndrew Thompson usb_size_t n_obj; 199f9cb546cSAndrew Thompson usb_size_t x; 200f9cb546cSAndrew Thompson usb_size_t y; 201f9cb546cSAndrew Thompson usb_size_t r; 202f9cb546cSAndrew Thompson usb_size_t z; 20302ac6454SAndrew Thompson 204767cb2e2SAndrew Thompson USB_ASSERT(align > 1, ("Invalid alignment, 0x%08x\n", 20502ac6454SAndrew Thompson align)); 206767cb2e2SAndrew Thompson USB_ASSERT(size > 0, ("Invalid size = 0\n")); 20702ac6454SAndrew Thompson 20802ac6454SAndrew Thompson if (count == 0) { 20902ac6454SAndrew Thompson return (0); /* nothing to allocate */ 21002ac6454SAndrew Thompson } 21102ac6454SAndrew Thompson /* 21202ac6454SAndrew Thompson * Make sure that the size is aligned properly. 21302ac6454SAndrew Thompson */ 21402ac6454SAndrew Thompson size = -((-size) & (-align)); 21502ac6454SAndrew Thompson 21602ac6454SAndrew Thompson /* 21702ac6454SAndrew Thompson * Try multi-allocation chunks to reduce the number of DMA 21802ac6454SAndrew Thompson * allocations, hence DMA allocations are slow. 21902ac6454SAndrew Thompson */ 22002ac6454SAndrew Thompson if (size >= PAGE_SIZE) { 22102ac6454SAndrew Thompson n_dma_pc = count; 22202ac6454SAndrew Thompson n_obj = 1; 22302ac6454SAndrew Thompson } else { 22402ac6454SAndrew Thompson /* compute number of objects per page */ 22502ac6454SAndrew Thompson n_obj = (PAGE_SIZE / size); 22602ac6454SAndrew Thompson /* 22702ac6454SAndrew Thompson * Compute number of DMA chunks, rounded up 22802ac6454SAndrew Thompson * to nearest one: 22902ac6454SAndrew Thompson */ 23002ac6454SAndrew Thompson n_dma_pc = ((count + n_obj - 1) / n_obj); 23102ac6454SAndrew Thompson } 23202ac6454SAndrew Thompson 23302ac6454SAndrew Thompson if (parm->buf == NULL) { 23402ac6454SAndrew Thompson /* for the future */ 23502ac6454SAndrew Thompson parm->dma_page_ptr += n_dma_pc; 23602ac6454SAndrew Thompson parm->dma_page_cache_ptr += n_dma_pc; 23702ac6454SAndrew Thompson parm->dma_page_ptr += count; 23802ac6454SAndrew Thompson parm->xfer_page_cache_ptr += count; 23902ac6454SAndrew Thompson return (0); 24002ac6454SAndrew Thompson } 24102ac6454SAndrew Thompson for (x = 0; x != n_dma_pc; x++) { 24202ac6454SAndrew Thompson /* need to initialize the page cache */ 24302ac6454SAndrew Thompson parm->dma_page_cache_ptr[x].tag_parent = 24402ac6454SAndrew Thompson &parm->curr_xfer->xroot->dma_parent_tag; 24502ac6454SAndrew Thompson } 24602ac6454SAndrew Thompson for (x = 0; x != count; x++) { 24702ac6454SAndrew Thompson /* need to initialize the page cache */ 24802ac6454SAndrew Thompson parm->xfer_page_cache_ptr[x].tag_parent = 24902ac6454SAndrew Thompson &parm->curr_xfer->xroot->dma_parent_tag; 25002ac6454SAndrew Thompson } 25102ac6454SAndrew Thompson 25202ac6454SAndrew Thompson if (ppc) { 25302ac6454SAndrew Thompson *ppc = parm->xfer_page_cache_ptr; 25402ac6454SAndrew Thompson } 25502ac6454SAndrew Thompson r = count; /* set remainder count */ 25602ac6454SAndrew Thompson z = n_obj * size; /* set allocation size */ 25702ac6454SAndrew Thompson pc = parm->xfer_page_cache_ptr; 25802ac6454SAndrew Thompson pg = parm->dma_page_ptr; 25902ac6454SAndrew Thompson 26002ac6454SAndrew Thompson for (x = 0; x != n_dma_pc; x++) { 26102ac6454SAndrew Thompson 26202ac6454SAndrew Thompson if (r < n_obj) { 26302ac6454SAndrew Thompson /* compute last remainder */ 26402ac6454SAndrew Thompson z = r * size; 26502ac6454SAndrew Thompson n_obj = r; 26602ac6454SAndrew Thompson } 267a593f6b8SAndrew Thompson if (usb_pc_alloc_mem(parm->dma_page_cache_ptr, 26802ac6454SAndrew Thompson pg, z, align)) { 26902ac6454SAndrew Thompson return (1); /* failure */ 27002ac6454SAndrew Thompson } 27102ac6454SAndrew Thompson /* Set beginning of current buffer */ 27202ac6454SAndrew Thompson buf = parm->dma_page_cache_ptr->buffer; 27302ac6454SAndrew Thompson /* Make room for one DMA page cache and one page */ 27402ac6454SAndrew Thompson parm->dma_page_cache_ptr++; 27502ac6454SAndrew Thompson pg++; 27602ac6454SAndrew Thompson 27702ac6454SAndrew Thompson for (y = 0; (y != n_obj); y++, r--, pc++, pg++) { 27802ac6454SAndrew Thompson 27902ac6454SAndrew Thompson /* Load sub-chunk into DMA */ 280a593f6b8SAndrew Thompson if (usb_pc_dmamap_create(pc, size)) { 28102ac6454SAndrew Thompson return (1); /* failure */ 28202ac6454SAndrew Thompson } 28302ac6454SAndrew Thompson pc->buffer = USB_ADD_BYTES(buf, y * size); 28402ac6454SAndrew Thompson pc->page_start = pg; 28502ac6454SAndrew Thompson 28602ac6454SAndrew Thompson mtx_lock(pc->tag_parent->mtx); 287a593f6b8SAndrew Thompson if (usb_pc_load_mem(pc, size, 1 /* synchronous */ )) { 28802ac6454SAndrew Thompson mtx_unlock(pc->tag_parent->mtx); 28902ac6454SAndrew Thompson return (1); /* failure */ 29002ac6454SAndrew Thompson } 29102ac6454SAndrew Thompson mtx_unlock(pc->tag_parent->mtx); 29202ac6454SAndrew Thompson } 29302ac6454SAndrew Thompson } 29402ac6454SAndrew Thompson 29502ac6454SAndrew Thompson parm->xfer_page_cache_ptr = pc; 29602ac6454SAndrew Thompson parm->dma_page_ptr = pg; 29702ac6454SAndrew Thompson return (0); 29802ac6454SAndrew Thompson } 299bdc081c6SAndrew Thompson #endif 30002ac6454SAndrew Thompson 30102ac6454SAndrew Thompson /*------------------------------------------------------------------------* 302a593f6b8SAndrew Thompson * usbd_transfer_setup_sub - transfer setup subroutine 30302ac6454SAndrew Thompson * 30402ac6454SAndrew Thompson * This function must be called from the "xfer_setup" callback of the 30502ac6454SAndrew Thompson * USB Host or Device controller driver when setting up an USB 30602ac6454SAndrew Thompson * transfer. This function will setup correct packet sizes, buffer 307760bc48eSAndrew Thompson * sizes, flags and more, that are stored in the "usb_xfer" 30802ac6454SAndrew Thompson * structure. 30902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 31002ac6454SAndrew Thompson void 311a593f6b8SAndrew Thompson usbd_transfer_setup_sub(struct usb_setup_params *parm) 31202ac6454SAndrew Thompson { 31302ac6454SAndrew Thompson enum { 31402ac6454SAndrew Thompson REQ_SIZE = 8, 31502ac6454SAndrew Thompson MIN_PKT = 8, 31602ac6454SAndrew Thompson }; 317760bc48eSAndrew Thompson struct usb_xfer *xfer = parm->curr_xfer; 318760bc48eSAndrew Thompson const struct usb_config *setup = parm->curr_setup; 319963169b4SHans Petter Selasky struct usb_endpoint_ss_comp_descriptor *ecomp; 320760bc48eSAndrew Thompson struct usb_endpoint_descriptor *edesc; 321a593f6b8SAndrew Thompson struct usb_std_packet_size std_size; 322e0a69b51SAndrew Thompson usb_frcount_t n_frlengths; 323e0a69b51SAndrew Thompson usb_frcount_t n_frbuffers; 324e0a69b51SAndrew Thompson usb_frcount_t x; 32502ac6454SAndrew Thompson uint8_t type; 32602ac6454SAndrew Thompson uint8_t zmps; 32702ac6454SAndrew Thompson 32802ac6454SAndrew Thompson /* 32902ac6454SAndrew Thompson * Sanity check. The following parameters must be initialized before 33002ac6454SAndrew Thompson * calling this function. 33102ac6454SAndrew Thompson */ 33202ac6454SAndrew Thompson if ((parm->hc_max_packet_size == 0) || 33302ac6454SAndrew Thompson (parm->hc_max_packet_count == 0) || 33402ac6454SAndrew Thompson (parm->hc_max_frame_size == 0)) { 33502ac6454SAndrew Thompson parm->err = USB_ERR_INVAL; 33602ac6454SAndrew Thompson goto done; 33702ac6454SAndrew Thompson } 338ae60fdfbSAndrew Thompson edesc = xfer->endpoint->edesc; 339963169b4SHans Petter Selasky ecomp = xfer->endpoint->ecomp; 34002ac6454SAndrew Thompson 34102ac6454SAndrew Thompson type = (edesc->bmAttributes & UE_XFERTYPE); 34202ac6454SAndrew Thompson 3434eae601eSAndrew Thompson xfer->flags = setup->flags; 3444eae601eSAndrew Thompson xfer->nframes = setup->frames; 3454eae601eSAndrew Thompson xfer->timeout = setup->timeout; 3464eae601eSAndrew Thompson xfer->callback = setup->callback; 3474eae601eSAndrew Thompson xfer->interval = setup->interval; 348ae60fdfbSAndrew Thompson xfer->endpointno = edesc->bEndpointAddress; 34902ac6454SAndrew Thompson xfer->max_packet_size = UGETW(edesc->wMaxPacketSize); 35002ac6454SAndrew Thompson xfer->max_packet_count = 1; 35102ac6454SAndrew Thompson /* make a shadow copy: */ 352f29a0724SAndrew Thompson xfer->flags_int.usb_mode = parm->udev->flags.usb_mode; 35302ac6454SAndrew Thompson 3544eae601eSAndrew Thompson parm->bufsize = setup->bufsize; 35502ac6454SAndrew Thompson 356963169b4SHans Petter Selasky switch (parm->speed) { 357963169b4SHans Petter Selasky case USB_SPEED_HIGH: 358963169b4SHans Petter Selasky switch (type) { 359963169b4SHans Petter Selasky case UE_ISOCHRONOUS: 360963169b4SHans Petter Selasky case UE_INTERRUPT: 36102ac6454SAndrew Thompson xfer->max_packet_count += (xfer->max_packet_size >> 11) & 3; 362963169b4SHans Petter Selasky 363963169b4SHans Petter Selasky /* check for invalid max packet count */ 364963169b4SHans Petter Selasky if (xfer->max_packet_count > 3) 365963169b4SHans Petter Selasky xfer->max_packet_count = 3; 366963169b4SHans Petter Selasky break; 367963169b4SHans Petter Selasky default: 368963169b4SHans Petter Selasky break; 369963169b4SHans Petter Selasky } 37002ac6454SAndrew Thompson xfer->max_packet_size &= 0x7FF; 371963169b4SHans Petter Selasky break; 372963169b4SHans Petter Selasky case USB_SPEED_SUPER: 373963169b4SHans Petter Selasky xfer->max_packet_count += (xfer->max_packet_size >> 11) & 3; 374963169b4SHans Petter Selasky 375963169b4SHans Petter Selasky if (ecomp != NULL) 376963169b4SHans Petter Selasky xfer->max_packet_count += ecomp->bMaxBurst; 377963169b4SHans Petter Selasky 378963169b4SHans Petter Selasky if ((xfer->max_packet_count == 0) || 379963169b4SHans Petter Selasky (xfer->max_packet_count > 16)) 380963169b4SHans Petter Selasky xfer->max_packet_count = 16; 381963169b4SHans Petter Selasky 382963169b4SHans Petter Selasky switch (type) { 383963169b4SHans Petter Selasky case UE_CONTROL: 384963169b4SHans Petter Selasky xfer->max_packet_count = 1; 385963169b4SHans Petter Selasky break; 386963169b4SHans Petter Selasky case UE_ISOCHRONOUS: 387963169b4SHans Petter Selasky if (ecomp != NULL) { 388963169b4SHans Petter Selasky uint8_t mult; 389963169b4SHans Petter Selasky 390963169b4SHans Petter Selasky mult = (ecomp->bmAttributes & 3) + 1; 391963169b4SHans Petter Selasky if (mult > 3) 392963169b4SHans Petter Selasky mult = 3; 393963169b4SHans Petter Selasky 394963169b4SHans Petter Selasky xfer->max_packet_count *= mult; 395963169b4SHans Petter Selasky } 396963169b4SHans Petter Selasky break; 397963169b4SHans Petter Selasky default: 398963169b4SHans Petter Selasky break; 399963169b4SHans Petter Selasky } 400963169b4SHans Petter Selasky xfer->max_packet_size &= 0x7FF; 401963169b4SHans Petter Selasky break; 402963169b4SHans Petter Selasky default: 403963169b4SHans Petter Selasky break; 40402ac6454SAndrew Thompson } 40502ac6454SAndrew Thompson /* range check "max_packet_count" */ 40602ac6454SAndrew Thompson 40702ac6454SAndrew Thompson if (xfer->max_packet_count > parm->hc_max_packet_count) { 40802ac6454SAndrew Thompson xfer->max_packet_count = parm->hc_max_packet_count; 40902ac6454SAndrew Thompson } 41002ac6454SAndrew Thompson /* filter "wMaxPacketSize" according to HC capabilities */ 41102ac6454SAndrew Thompson 41202ac6454SAndrew Thompson if ((xfer->max_packet_size > parm->hc_max_packet_size) || 41302ac6454SAndrew Thompson (xfer->max_packet_size == 0)) { 41402ac6454SAndrew Thompson xfer->max_packet_size = parm->hc_max_packet_size; 41502ac6454SAndrew Thompson } 41602ac6454SAndrew Thompson /* filter "wMaxPacketSize" according to standard sizes */ 41702ac6454SAndrew Thompson 418a593f6b8SAndrew Thompson usbd_get_std_packet_size(&std_size, type, parm->speed); 41902ac6454SAndrew Thompson 42002ac6454SAndrew Thompson if (std_size.range.min || std_size.range.max) { 42102ac6454SAndrew Thompson 42202ac6454SAndrew Thompson if (xfer->max_packet_size < std_size.range.min) { 42302ac6454SAndrew Thompson xfer->max_packet_size = std_size.range.min; 42402ac6454SAndrew Thompson } 42502ac6454SAndrew Thompson if (xfer->max_packet_size > std_size.range.max) { 42602ac6454SAndrew Thompson xfer->max_packet_size = std_size.range.max; 42702ac6454SAndrew Thompson } 42802ac6454SAndrew Thompson } else { 42902ac6454SAndrew Thompson 43002ac6454SAndrew Thompson if (xfer->max_packet_size >= std_size.fixed[3]) { 43102ac6454SAndrew Thompson xfer->max_packet_size = std_size.fixed[3]; 43202ac6454SAndrew Thompson } else if (xfer->max_packet_size >= std_size.fixed[2]) { 43302ac6454SAndrew Thompson xfer->max_packet_size = std_size.fixed[2]; 43402ac6454SAndrew Thompson } else if (xfer->max_packet_size >= std_size.fixed[1]) { 43502ac6454SAndrew Thompson xfer->max_packet_size = std_size.fixed[1]; 43602ac6454SAndrew Thompson } else { 43702ac6454SAndrew Thompson /* only one possibility left */ 43802ac6454SAndrew Thompson xfer->max_packet_size = std_size.fixed[0]; 43902ac6454SAndrew Thompson } 44002ac6454SAndrew Thompson } 44102ac6454SAndrew Thompson 44202ac6454SAndrew Thompson /* compute "max_frame_size" */ 44302ac6454SAndrew Thompson 444a593f6b8SAndrew Thompson usbd_update_max_frame_size(xfer); 44502ac6454SAndrew Thompson 44602ac6454SAndrew Thompson /* check interrupt interval and transfer pre-delay */ 44702ac6454SAndrew Thompson 44802ac6454SAndrew Thompson if (type == UE_ISOCHRONOUS) { 44902ac6454SAndrew Thompson 450578d0effSAndrew Thompson uint16_t frame_limit; 45102ac6454SAndrew Thompson 45202ac6454SAndrew Thompson xfer->interval = 0; /* not used, must be zero */ 45302ac6454SAndrew Thompson xfer->flags_int.isochronous_xfr = 1; /* set flag */ 45402ac6454SAndrew Thompson 45502ac6454SAndrew Thompson if (xfer->timeout == 0) { 45602ac6454SAndrew Thompson /* 45702ac6454SAndrew Thompson * set a default timeout in 45802ac6454SAndrew Thompson * case something goes wrong! 45902ac6454SAndrew Thompson */ 46002ac6454SAndrew Thompson xfer->timeout = 1000 / 4; 46102ac6454SAndrew Thompson } 46202ac6454SAndrew Thompson switch (parm->speed) { 46302ac6454SAndrew Thompson case USB_SPEED_LOW: 46402ac6454SAndrew Thompson case USB_SPEED_FULL: 46502ac6454SAndrew Thompson frame_limit = USB_MAX_FS_ISOC_FRAMES_PER_XFER; 466883bb300SAndrew Thompson xfer->fps_shift = 0; 46702ac6454SAndrew Thompson break; 46802ac6454SAndrew Thompson default: 46902ac6454SAndrew Thompson frame_limit = USB_MAX_HS_ISOC_FRAMES_PER_XFER; 470883bb300SAndrew Thompson xfer->fps_shift = edesc->bInterval; 471883bb300SAndrew Thompson if (xfer->fps_shift > 0) 472883bb300SAndrew Thompson xfer->fps_shift--; 473883bb300SAndrew Thompson if (xfer->fps_shift > 3) 474883bb300SAndrew Thompson xfer->fps_shift = 3; 4751c497368SHans Petter Selasky if (xfer->flags.pre_scale_frames != 0) 4761c497368SHans Petter Selasky xfer->nframes <<= (3 - xfer->fps_shift); 47702ac6454SAndrew Thompson break; 47802ac6454SAndrew Thompson } 47902ac6454SAndrew Thompson 48002ac6454SAndrew Thompson if (xfer->nframes > frame_limit) { 48102ac6454SAndrew Thompson /* 48202ac6454SAndrew Thompson * this is not going to work 48302ac6454SAndrew Thompson * cross hardware 48402ac6454SAndrew Thompson */ 48502ac6454SAndrew Thompson parm->err = USB_ERR_INVAL; 48602ac6454SAndrew Thompson goto done; 48702ac6454SAndrew Thompson } 48802ac6454SAndrew Thompson if (xfer->nframes == 0) { 48902ac6454SAndrew Thompson /* 49002ac6454SAndrew Thompson * this is not a valid value 49102ac6454SAndrew Thompson */ 49202ac6454SAndrew Thompson parm->err = USB_ERR_ZERO_NFRAMES; 49302ac6454SAndrew Thompson goto done; 49402ac6454SAndrew Thompson } 49502ac6454SAndrew Thompson } else { 49602ac6454SAndrew Thompson 49702ac6454SAndrew Thompson /* 498963169b4SHans Petter Selasky * If a value is specified use that else check the 499963169b4SHans Petter Selasky * endpoint descriptor! 50002ac6454SAndrew Thompson */ 50102ac6454SAndrew Thompson if (type == UE_INTERRUPT) { 50202ac6454SAndrew Thompson 503963169b4SHans Petter Selasky uint32_t temp; 504963169b4SHans Petter Selasky 505963169b4SHans Petter Selasky if (xfer->interval == 0) { 506963169b4SHans Petter Selasky 50702ac6454SAndrew Thompson xfer->interval = edesc->bInterval; 50802ac6454SAndrew Thompson 50902ac6454SAndrew Thompson switch (parm->speed) { 510963169b4SHans Petter Selasky case USB_SPEED_LOW: 511963169b4SHans Petter Selasky case USB_SPEED_FULL: 512963169b4SHans Petter Selasky break; 513963169b4SHans Petter Selasky default: 51402ac6454SAndrew Thompson /* 125us -> 1ms */ 51502ac6454SAndrew Thompson if (xfer->interval < 4) 51602ac6454SAndrew Thompson xfer->interval = 1; 51702ac6454SAndrew Thompson else if (xfer->interval > 16) 51802ac6454SAndrew Thompson xfer->interval = (1 << (16 - 4)); 51902ac6454SAndrew Thompson else 52002ac6454SAndrew Thompson xfer->interval = 52102ac6454SAndrew Thompson (1 << (xfer->interval - 4)); 52202ac6454SAndrew Thompson break; 52302ac6454SAndrew Thompson } 524963169b4SHans Petter Selasky } 525963169b4SHans Petter Selasky 52602ac6454SAndrew Thompson if (xfer->interval == 0) { 52702ac6454SAndrew Thompson /* 52802ac6454SAndrew Thompson * One millisecond is the smallest 52902ac6454SAndrew Thompson * interval we support: 53002ac6454SAndrew Thompson */ 53102ac6454SAndrew Thompson xfer->interval = 1; 53202ac6454SAndrew Thompson } 533963169b4SHans Petter Selasky 534963169b4SHans Petter Selasky xfer->fps_shift = 0; 535963169b4SHans Petter Selasky temp = 1; 536963169b4SHans Petter Selasky 537963169b4SHans Petter Selasky while ((temp != 0) && (temp < xfer->interval)) { 538963169b4SHans Petter Selasky xfer->fps_shift++; 539963169b4SHans Petter Selasky temp *= 2; 540963169b4SHans Petter Selasky } 541963169b4SHans Petter Selasky 542963169b4SHans Petter Selasky switch (parm->speed) { 543963169b4SHans Petter Selasky case USB_SPEED_LOW: 544963169b4SHans Petter Selasky case USB_SPEED_FULL: 545963169b4SHans Petter Selasky break; 546963169b4SHans Petter Selasky default: 547963169b4SHans Petter Selasky xfer->fps_shift += 3; 548963169b4SHans Petter Selasky break; 54902ac6454SAndrew Thompson } 55002ac6454SAndrew Thompson } 55102ac6454SAndrew Thompson } 55202ac6454SAndrew Thompson 55302ac6454SAndrew Thompson /* 55402ac6454SAndrew Thompson * NOTE: we do not allow "max_packet_size" or "max_frame_size" 55502ac6454SAndrew Thompson * to be equal to zero when setting up USB transfers, hence 55602ac6454SAndrew Thompson * this leads to alot of extra code in the USB kernel. 55702ac6454SAndrew Thompson */ 55802ac6454SAndrew Thompson 55902ac6454SAndrew Thompson if ((xfer->max_frame_size == 0) || 56002ac6454SAndrew Thompson (xfer->max_packet_size == 0)) { 56102ac6454SAndrew Thompson 56202ac6454SAndrew Thompson zmps = 1; 56302ac6454SAndrew Thompson 56402ac6454SAndrew Thompson if ((parm->bufsize <= MIN_PKT) && 56502ac6454SAndrew Thompson (type != UE_CONTROL) && 56602ac6454SAndrew Thompson (type != UE_BULK)) { 56702ac6454SAndrew Thompson 56802ac6454SAndrew Thompson /* workaround */ 56902ac6454SAndrew Thompson xfer->max_packet_size = MIN_PKT; 57002ac6454SAndrew Thompson xfer->max_packet_count = 1; 57102ac6454SAndrew Thompson parm->bufsize = 0; /* automatic setup length */ 572a593f6b8SAndrew Thompson usbd_update_max_frame_size(xfer); 57302ac6454SAndrew Thompson 57402ac6454SAndrew Thompson } else { 57502ac6454SAndrew Thompson parm->err = USB_ERR_ZERO_MAXP; 57602ac6454SAndrew Thompson goto done; 57702ac6454SAndrew Thompson } 57802ac6454SAndrew Thompson 57902ac6454SAndrew Thompson } else { 58002ac6454SAndrew Thompson zmps = 0; 58102ac6454SAndrew Thompson } 58202ac6454SAndrew Thompson 58302ac6454SAndrew Thompson /* 58402ac6454SAndrew Thompson * check if we should setup a default 58502ac6454SAndrew Thompson * length: 58602ac6454SAndrew Thompson */ 58702ac6454SAndrew Thompson 58802ac6454SAndrew Thompson if (parm->bufsize == 0) { 58902ac6454SAndrew Thompson 59002ac6454SAndrew Thompson parm->bufsize = xfer->max_frame_size; 59102ac6454SAndrew Thompson 59202ac6454SAndrew Thompson if (type == UE_ISOCHRONOUS) { 59302ac6454SAndrew Thompson parm->bufsize *= xfer->nframes; 59402ac6454SAndrew Thompson } 59502ac6454SAndrew Thompson } 59602ac6454SAndrew Thompson /* 59702ac6454SAndrew Thompson * check if we are about to setup a proxy 59802ac6454SAndrew Thompson * type of buffer: 59902ac6454SAndrew Thompson */ 60002ac6454SAndrew Thompson 60102ac6454SAndrew Thompson if (xfer->flags.proxy_buffer) { 60202ac6454SAndrew Thompson 60302ac6454SAndrew Thompson /* round bufsize up */ 60402ac6454SAndrew Thompson 60502ac6454SAndrew Thompson parm->bufsize += (xfer->max_frame_size - 1); 60602ac6454SAndrew Thompson 60702ac6454SAndrew Thompson if (parm->bufsize < xfer->max_frame_size) { 60802ac6454SAndrew Thompson /* length wrapped around */ 60902ac6454SAndrew Thompson parm->err = USB_ERR_INVAL; 61002ac6454SAndrew Thompson goto done; 61102ac6454SAndrew Thompson } 61202ac6454SAndrew Thompson /* subtract remainder */ 61302ac6454SAndrew Thompson 61402ac6454SAndrew Thompson parm->bufsize -= (parm->bufsize % xfer->max_frame_size); 61502ac6454SAndrew Thompson 61602ac6454SAndrew Thompson /* add length of USB device request structure, if any */ 61702ac6454SAndrew Thompson 61802ac6454SAndrew Thompson if (type == UE_CONTROL) { 61902ac6454SAndrew Thompson parm->bufsize += REQ_SIZE; /* SETUP message */ 62002ac6454SAndrew Thompson } 62102ac6454SAndrew Thompson } 62202ac6454SAndrew Thompson xfer->max_data_length = parm->bufsize; 62302ac6454SAndrew Thompson 62402ac6454SAndrew Thompson /* Setup "n_frlengths" and "n_frbuffers" */ 62502ac6454SAndrew Thompson 62602ac6454SAndrew Thompson if (type == UE_ISOCHRONOUS) { 62702ac6454SAndrew Thompson n_frlengths = xfer->nframes; 62802ac6454SAndrew Thompson n_frbuffers = 1; 62902ac6454SAndrew Thompson } else { 63002ac6454SAndrew Thompson 63102ac6454SAndrew Thompson if (type == UE_CONTROL) { 63202ac6454SAndrew Thompson xfer->flags_int.control_xfr = 1; 63302ac6454SAndrew Thompson if (xfer->nframes == 0) { 63402ac6454SAndrew Thompson if (parm->bufsize <= REQ_SIZE) { 63502ac6454SAndrew Thompson /* 63602ac6454SAndrew Thompson * there will never be any data 63702ac6454SAndrew Thompson * stage 63802ac6454SAndrew Thompson */ 63902ac6454SAndrew Thompson xfer->nframes = 1; 64002ac6454SAndrew Thompson } else { 64102ac6454SAndrew Thompson xfer->nframes = 2; 64202ac6454SAndrew Thompson } 64302ac6454SAndrew Thompson } 64402ac6454SAndrew Thompson } else { 64502ac6454SAndrew Thompson if (xfer->nframes == 0) { 64602ac6454SAndrew Thompson xfer->nframes = 1; 64702ac6454SAndrew Thompson } 64802ac6454SAndrew Thompson } 64902ac6454SAndrew Thompson 65002ac6454SAndrew Thompson n_frlengths = xfer->nframes; 65102ac6454SAndrew Thompson n_frbuffers = xfer->nframes; 65202ac6454SAndrew Thompson } 65302ac6454SAndrew Thompson 65402ac6454SAndrew Thompson /* 65502ac6454SAndrew Thompson * check if we have room for the 65602ac6454SAndrew Thompson * USB device request structure: 65702ac6454SAndrew Thompson */ 65802ac6454SAndrew Thompson 65902ac6454SAndrew Thompson if (type == UE_CONTROL) { 66002ac6454SAndrew Thompson 66102ac6454SAndrew Thompson if (xfer->max_data_length < REQ_SIZE) { 66202ac6454SAndrew Thompson /* length wrapped around or too small bufsize */ 66302ac6454SAndrew Thompson parm->err = USB_ERR_INVAL; 66402ac6454SAndrew Thompson goto done; 66502ac6454SAndrew Thompson } 66602ac6454SAndrew Thompson xfer->max_data_length -= REQ_SIZE; 66702ac6454SAndrew Thompson } 66831a11691SHans Petter Selasky /* 66931a11691SHans Petter Selasky * Setup "frlengths" and shadow "frlengths" for keeping the 67031a11691SHans Petter Selasky * initial frame lengths when a USB transfer is complete. This 67131a11691SHans Petter Selasky * information is useful when computing isochronous offsets. 67231a11691SHans Petter Selasky */ 67302ac6454SAndrew Thompson xfer->frlengths = parm->xfer_length_ptr; 67431a11691SHans Petter Selasky parm->xfer_length_ptr += 2 * n_frlengths; 67502ac6454SAndrew Thompson 67602ac6454SAndrew Thompson /* setup "frbuffers" */ 67702ac6454SAndrew Thompson xfer->frbuffers = parm->xfer_page_cache_ptr; 67802ac6454SAndrew Thompson parm->xfer_page_cache_ptr += n_frbuffers; 67902ac6454SAndrew Thompson 680ed6d949aSAndrew Thompson /* initialize max frame count */ 681ed6d949aSAndrew Thompson xfer->max_frame_count = xfer->nframes; 682ed6d949aSAndrew Thompson 68302ac6454SAndrew Thompson /* 68402ac6454SAndrew Thompson * check if we need to setup 68502ac6454SAndrew Thompson * a local buffer: 68602ac6454SAndrew Thompson */ 68702ac6454SAndrew Thompson 68802ac6454SAndrew Thompson if (!xfer->flags.ext_buffer) { 68902ac6454SAndrew Thompson 69002ac6454SAndrew Thompson /* align data */ 69102ac6454SAndrew Thompson parm->size[0] += ((-parm->size[0]) & (USB_HOST_ALIGN - 1)); 69202ac6454SAndrew Thompson 69302ac6454SAndrew Thompson if (parm->buf) { 69402ac6454SAndrew Thompson 69502ac6454SAndrew Thompson xfer->local_buffer = 69602ac6454SAndrew Thompson USB_ADD_BYTES(parm->buf, parm->size[0]); 69702ac6454SAndrew Thompson 698ed6d949aSAndrew Thompson usbd_xfer_set_frame_offset(xfer, 0, 0); 69902ac6454SAndrew Thompson 70002ac6454SAndrew Thompson if ((type == UE_CONTROL) && (n_frbuffers > 1)) { 701ed6d949aSAndrew Thompson usbd_xfer_set_frame_offset(xfer, REQ_SIZE, 1); 70202ac6454SAndrew Thompson } 70302ac6454SAndrew Thompson } 70402ac6454SAndrew Thompson parm->size[0] += parm->bufsize; 70502ac6454SAndrew Thompson 70602ac6454SAndrew Thompson /* align data again */ 70702ac6454SAndrew Thompson parm->size[0] += ((-parm->size[0]) & (USB_HOST_ALIGN - 1)); 70802ac6454SAndrew Thompson } 70902ac6454SAndrew Thompson /* 71002ac6454SAndrew Thompson * Compute maximum buffer size 71102ac6454SAndrew Thompson */ 71202ac6454SAndrew Thompson 71302ac6454SAndrew Thompson if (parm->bufsize_max < parm->bufsize) { 71402ac6454SAndrew Thompson parm->bufsize_max = parm->bufsize; 71502ac6454SAndrew Thompson } 716bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 71702ac6454SAndrew Thompson if (xfer->flags_int.bdma_enable) { 71802ac6454SAndrew Thompson /* 71902ac6454SAndrew Thompson * Setup "dma_page_ptr". 72002ac6454SAndrew Thompson * 72102ac6454SAndrew Thompson * Proof for formula below: 72202ac6454SAndrew Thompson * 72302ac6454SAndrew Thompson * Assume there are three USB frames having length "a", "b" and 72402ac6454SAndrew Thompson * "c". These USB frames will at maximum need "z" 725760bc48eSAndrew Thompson * "usb_page" structures. "z" is given by: 72602ac6454SAndrew Thompson * 72702ac6454SAndrew Thompson * z = ((a / USB_PAGE_SIZE) + 2) + ((b / USB_PAGE_SIZE) + 2) + 72802ac6454SAndrew Thompson * ((c / USB_PAGE_SIZE) + 2); 72902ac6454SAndrew Thompson * 73002ac6454SAndrew Thompson * Constraining "a", "b" and "c" like this: 73102ac6454SAndrew Thompson * 73202ac6454SAndrew Thompson * (a + b + c) <= parm->bufsize 73302ac6454SAndrew Thompson * 73402ac6454SAndrew Thompson * We know that: 73502ac6454SAndrew Thompson * 73602ac6454SAndrew Thompson * z <= ((parm->bufsize / USB_PAGE_SIZE) + (3*2)); 73702ac6454SAndrew Thompson * 73802ac6454SAndrew Thompson * Here is the general formula: 73902ac6454SAndrew Thompson */ 74002ac6454SAndrew Thompson xfer->dma_page_ptr = parm->dma_page_ptr; 74102ac6454SAndrew Thompson parm->dma_page_ptr += (2 * n_frbuffers); 74202ac6454SAndrew Thompson parm->dma_page_ptr += (parm->bufsize / USB_PAGE_SIZE); 74302ac6454SAndrew Thompson } 744bdc081c6SAndrew Thompson #endif 74502ac6454SAndrew Thompson if (zmps) { 74602ac6454SAndrew Thompson /* correct maximum data length */ 74702ac6454SAndrew Thompson xfer->max_data_length = 0; 74802ac6454SAndrew Thompson } 74902ac6454SAndrew Thompson /* subtract USB frame remainder from "hc_max_frame_size" */ 75002ac6454SAndrew Thompson 751578d0effSAndrew Thompson xfer->max_hc_frame_size = 75202ac6454SAndrew Thompson (parm->hc_max_frame_size - 75302ac6454SAndrew Thompson (parm->hc_max_frame_size % xfer->max_frame_size)); 75402ac6454SAndrew Thompson 755578d0effSAndrew Thompson if (xfer->max_hc_frame_size == 0) { 75602ac6454SAndrew Thompson parm->err = USB_ERR_INVAL; 75702ac6454SAndrew Thompson goto done; 75802ac6454SAndrew Thompson } 75902ac6454SAndrew Thompson 76002ac6454SAndrew Thompson /* initialize frame buffers */ 76102ac6454SAndrew Thompson 76202ac6454SAndrew Thompson if (parm->buf) { 76302ac6454SAndrew Thompson for (x = 0; x != n_frbuffers; x++) { 76402ac6454SAndrew Thompson xfer->frbuffers[x].tag_parent = 76502ac6454SAndrew Thompson &xfer->xroot->dma_parent_tag; 766bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 76702ac6454SAndrew Thompson if (xfer->flags_int.bdma_enable && 76802ac6454SAndrew Thompson (parm->bufsize_max > 0)) { 76902ac6454SAndrew Thompson 770a593f6b8SAndrew Thompson if (usb_pc_dmamap_create( 77102ac6454SAndrew Thompson xfer->frbuffers + x, 77202ac6454SAndrew Thompson parm->bufsize_max)) { 77302ac6454SAndrew Thompson parm->err = USB_ERR_NOMEM; 77402ac6454SAndrew Thompson goto done; 77502ac6454SAndrew Thompson } 77602ac6454SAndrew Thompson } 777bdc081c6SAndrew Thompson #endif 77802ac6454SAndrew Thompson } 77902ac6454SAndrew Thompson } 78002ac6454SAndrew Thompson done: 78102ac6454SAndrew Thompson if (parm->err) { 78202ac6454SAndrew Thompson /* 78302ac6454SAndrew Thompson * Set some dummy values so that we avoid division by zero: 78402ac6454SAndrew Thompson */ 785578d0effSAndrew Thompson xfer->max_hc_frame_size = 1; 78602ac6454SAndrew Thompson xfer->max_frame_size = 1; 78702ac6454SAndrew Thompson xfer->max_packet_size = 1; 78802ac6454SAndrew Thompson xfer->max_data_length = 0; 78902ac6454SAndrew Thompson xfer->nframes = 0; 79002ac6454SAndrew Thompson xfer->max_frame_count = 0; 79102ac6454SAndrew Thompson } 79202ac6454SAndrew Thompson } 79302ac6454SAndrew Thompson 79402ac6454SAndrew Thompson /*------------------------------------------------------------------------* 795a593f6b8SAndrew Thompson * usbd_transfer_setup - setup an array of USB transfers 79602ac6454SAndrew Thompson * 797a593f6b8SAndrew Thompson * NOTE: You must always call "usbd_transfer_unsetup" after calling 798a593f6b8SAndrew Thompson * "usbd_transfer_setup" if success was returned. 79902ac6454SAndrew Thompson * 80002ac6454SAndrew Thompson * The idea is that the USB device driver should pre-allocate all its 80102ac6454SAndrew Thompson * transfers by one call to this function. 80202ac6454SAndrew Thompson * 80302ac6454SAndrew Thompson * Return values: 80402ac6454SAndrew Thompson * 0: Success 80502ac6454SAndrew Thompson * Else: Failure 80602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 807e0a69b51SAndrew Thompson usb_error_t 808a593f6b8SAndrew Thompson usbd_transfer_setup(struct usb_device *udev, 809760bc48eSAndrew Thompson const uint8_t *ifaces, struct usb_xfer **ppxfer, 810760bc48eSAndrew Thompson const struct usb_config *setup_start, uint16_t n_setup, 81102ac6454SAndrew Thompson void *priv_sc, struct mtx *xfer_mtx) 81202ac6454SAndrew Thompson { 813760bc48eSAndrew Thompson struct usb_xfer dummy; 814760bc48eSAndrew Thompson struct usb_setup_params parm; 815760bc48eSAndrew Thompson const struct usb_config *setup_end = setup_start + n_setup; 816760bc48eSAndrew Thompson const struct usb_config *setup; 817ae60fdfbSAndrew Thompson struct usb_endpoint *ep; 818760bc48eSAndrew Thompson struct usb_xfer_root *info; 819760bc48eSAndrew Thompson struct usb_xfer *xfer; 82002ac6454SAndrew Thompson void *buf = NULL; 82102ac6454SAndrew Thompson uint16_t n; 82202ac6454SAndrew Thompson uint16_t refcount; 82302ac6454SAndrew Thompson 82402ac6454SAndrew Thompson parm.err = 0; 82502ac6454SAndrew Thompson refcount = 0; 82602ac6454SAndrew Thompson info = NULL; 82702ac6454SAndrew Thompson 82802ac6454SAndrew Thompson WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL, 829a593f6b8SAndrew Thompson "usbd_transfer_setup can sleep!"); 83002ac6454SAndrew Thompson 83102ac6454SAndrew Thompson /* do some checking first */ 83202ac6454SAndrew Thompson 83302ac6454SAndrew Thompson if (n_setup == 0) { 83402ac6454SAndrew Thompson DPRINTFN(6, "setup array has zero length!\n"); 83502ac6454SAndrew Thompson return (USB_ERR_INVAL); 83602ac6454SAndrew Thompson } 83702ac6454SAndrew Thompson if (ifaces == 0) { 83802ac6454SAndrew Thompson DPRINTFN(6, "ifaces array is NULL!\n"); 83902ac6454SAndrew Thompson return (USB_ERR_INVAL); 84002ac6454SAndrew Thompson } 84102ac6454SAndrew Thompson if (xfer_mtx == NULL) { 84202ac6454SAndrew Thompson DPRINTFN(6, "using global lock\n"); 84302ac6454SAndrew Thompson xfer_mtx = &Giant; 84402ac6454SAndrew Thompson } 84502ac6454SAndrew Thompson /* sanity checks */ 84602ac6454SAndrew Thompson for (setup = setup_start, n = 0; 84702ac6454SAndrew Thompson setup != setup_end; setup++, n++) { 848e0a69b51SAndrew Thompson if (setup->bufsize == (usb_frlength_t)-1) { 84902ac6454SAndrew Thompson parm.err = USB_ERR_BAD_BUFSIZE; 85002ac6454SAndrew Thompson DPRINTF("invalid bufsize\n"); 85102ac6454SAndrew Thompson } 8524eae601eSAndrew Thompson if (setup->callback == NULL) { 85302ac6454SAndrew Thompson parm.err = USB_ERR_NO_CALLBACK; 85402ac6454SAndrew Thompson DPRINTF("no callback\n"); 85502ac6454SAndrew Thompson } 85602ac6454SAndrew Thompson ppxfer[n] = NULL; 85702ac6454SAndrew Thompson } 85802ac6454SAndrew Thompson 85902ac6454SAndrew Thompson if (parm.err) { 86002ac6454SAndrew Thompson goto done; 86102ac6454SAndrew Thompson } 862271ae033SHans Petter Selasky memset(&parm, 0, sizeof(parm)); 86302ac6454SAndrew Thompson 86402ac6454SAndrew Thompson parm.udev = udev; 865a593f6b8SAndrew Thompson parm.speed = usbd_get_speed(udev); 86602ac6454SAndrew Thompson parm.hc_max_packet_count = 1; 86702ac6454SAndrew Thompson 86802ac6454SAndrew Thompson if (parm.speed >= USB_SPEED_MAX) { 86902ac6454SAndrew Thompson parm.err = USB_ERR_INVAL; 87002ac6454SAndrew Thompson goto done; 87102ac6454SAndrew Thompson } 87202ac6454SAndrew Thompson /* setup all transfers */ 87302ac6454SAndrew Thompson 87402ac6454SAndrew Thompson while (1) { 87502ac6454SAndrew Thompson 87602ac6454SAndrew Thompson if (buf) { 87702ac6454SAndrew Thompson /* 878760bc48eSAndrew Thompson * Initialize the "usb_xfer_root" structure, 87902ac6454SAndrew Thompson * which is common for all our USB transfers. 88002ac6454SAndrew Thompson */ 88102ac6454SAndrew Thompson info = USB_ADD_BYTES(buf, 0); 88202ac6454SAndrew Thompson 88302ac6454SAndrew Thompson info->memory_base = buf; 88402ac6454SAndrew Thompson info->memory_size = parm.size[0]; 88502ac6454SAndrew Thompson 886bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 88702ac6454SAndrew Thompson info->dma_page_cache_start = USB_ADD_BYTES(buf, parm.size[4]); 88802ac6454SAndrew Thompson info->dma_page_cache_end = USB_ADD_BYTES(buf, parm.size[5]); 889bdc081c6SAndrew Thompson #endif 89002ac6454SAndrew Thompson info->xfer_page_cache_start = USB_ADD_BYTES(buf, parm.size[5]); 89102ac6454SAndrew Thompson info->xfer_page_cache_end = USB_ADD_BYTES(buf, parm.size[2]); 89202ac6454SAndrew Thompson 8938437751dSAndrew Thompson cv_init(&info->cv_drain, "WDRAIN"); 89402ac6454SAndrew Thompson 89502ac6454SAndrew Thompson info->xfer_mtx = xfer_mtx; 896bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 897a593f6b8SAndrew Thompson usb_dma_tag_setup(&info->dma_parent_tag, 89802ac6454SAndrew Thompson parm.dma_tag_p, udev->bus->dma_parent_tag[0].tag, 899a593f6b8SAndrew Thompson xfer_mtx, &usb_bdma_done_event, 32, parm.dma_tag_max); 900bdc081c6SAndrew Thompson #endif 90102ac6454SAndrew Thompson 90202ac6454SAndrew Thompson info->bus = udev->bus; 90302ac6454SAndrew Thompson info->udev = udev; 90402ac6454SAndrew Thompson 90502ac6454SAndrew Thompson TAILQ_INIT(&info->done_q.head); 906a593f6b8SAndrew Thompson info->done_q.command = &usbd_callback_wrapper; 907bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 90802ac6454SAndrew Thompson TAILQ_INIT(&info->dma_q.head); 909a593f6b8SAndrew Thompson info->dma_q.command = &usb_bdma_work_loop; 910bdc081c6SAndrew Thompson #endif 911a593f6b8SAndrew Thompson info->done_m[0].hdr.pm_callback = &usb_callback_proc; 91202ac6454SAndrew Thompson info->done_m[0].xroot = info; 913a593f6b8SAndrew Thompson info->done_m[1].hdr.pm_callback = &usb_callback_proc; 91402ac6454SAndrew Thompson info->done_m[1].xroot = info; 91502ac6454SAndrew Thompson 916672c9965SAndrew Thompson /* 917672c9965SAndrew Thompson * In device side mode control endpoint 918672c9965SAndrew Thompson * requests need to run from a separate 919672c9965SAndrew Thompson * context, else there is a chance of 920672c9965SAndrew Thompson * deadlock! 921672c9965SAndrew Thompson */ 922a593f6b8SAndrew Thompson if (setup_start == usb_control_ep_cfg) 923672c9965SAndrew Thompson info->done_p = 924672c9965SAndrew Thompson &udev->bus->control_xfer_proc; 925672c9965SAndrew Thompson else if (xfer_mtx == &Giant) 92602ac6454SAndrew Thompson info->done_p = 92702ac6454SAndrew Thompson &udev->bus->giant_callback_proc; 92802ac6454SAndrew Thompson else 92902ac6454SAndrew Thompson info->done_p = 93002ac6454SAndrew Thompson &udev->bus->non_giant_callback_proc; 93102ac6454SAndrew Thompson } 93202ac6454SAndrew Thompson /* reset sizes */ 93302ac6454SAndrew Thompson 93402ac6454SAndrew Thompson parm.size[0] = 0; 93502ac6454SAndrew Thompson parm.buf = buf; 93602ac6454SAndrew Thompson parm.size[0] += sizeof(info[0]); 93702ac6454SAndrew Thompson 93802ac6454SAndrew Thompson for (setup = setup_start, n = 0; 93902ac6454SAndrew Thompson setup != setup_end; setup++, n++) { 94002ac6454SAndrew Thompson 94102ac6454SAndrew Thompson /* skip USB transfers without callbacks: */ 9424eae601eSAndrew Thompson if (setup->callback == NULL) { 94302ac6454SAndrew Thompson continue; 94402ac6454SAndrew Thompson } 94502ac6454SAndrew Thompson /* see if there is a matching endpoint */ 946a593f6b8SAndrew Thompson ep = usbd_get_endpoint(udev, 94702ac6454SAndrew Thompson ifaces[setup->if_index], setup); 94802ac6454SAndrew Thompson 949ae60fdfbSAndrew Thompson if ((ep == NULL) || (ep->methods == NULL)) { 9504eae601eSAndrew Thompson if (setup->flags.no_pipe_ok) 95102ac6454SAndrew Thompson continue; 952f29a0724SAndrew Thompson if ((setup->usb_mode != USB_MODE_DUAL) && 953f29a0724SAndrew Thompson (setup->usb_mode != udev->flags.usb_mode)) 9544eae601eSAndrew Thompson continue; 95502ac6454SAndrew Thompson parm.err = USB_ERR_NO_PIPE; 95602ac6454SAndrew Thompson goto done; 95702ac6454SAndrew Thompson } 95802ac6454SAndrew Thompson 95902ac6454SAndrew Thompson /* align data properly */ 96002ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 96102ac6454SAndrew Thompson 9624eae601eSAndrew Thompson /* store current setup pointer */ 9634eae601eSAndrew Thompson parm.curr_setup = setup; 9644eae601eSAndrew Thompson 96502ac6454SAndrew Thompson if (buf) { 96602ac6454SAndrew Thompson /* 96702ac6454SAndrew Thompson * Common initialization of the 968760bc48eSAndrew Thompson * "usb_xfer" structure. 96902ac6454SAndrew Thompson */ 97002ac6454SAndrew Thompson xfer = USB_ADD_BYTES(buf, parm.size[0]); 97102ac6454SAndrew Thompson xfer->address = udev->address; 97202ac6454SAndrew Thompson xfer->priv_sc = priv_sc; 97302ac6454SAndrew Thompson xfer->xroot = info; 97402ac6454SAndrew Thompson 975a593f6b8SAndrew Thompson usb_callout_init_mtx(&xfer->timeout_handle, 97602ac6454SAndrew Thompson &udev->bus->bus_mtx, 0); 97702ac6454SAndrew Thompson } else { 97802ac6454SAndrew Thompson /* 97902ac6454SAndrew Thompson * Setup a dummy xfer, hence we are 980760bc48eSAndrew Thompson * writing to the "usb_xfer" 98102ac6454SAndrew Thompson * structure pointed to by "xfer" 98202ac6454SAndrew Thompson * before we have allocated any 98302ac6454SAndrew Thompson * memory: 98402ac6454SAndrew Thompson */ 98502ac6454SAndrew Thompson xfer = &dummy; 986271ae033SHans Petter Selasky memset(&dummy, 0, sizeof(dummy)); 98702ac6454SAndrew Thompson refcount++; 98802ac6454SAndrew Thompson } 98902ac6454SAndrew Thompson 990ae60fdfbSAndrew Thompson /* set transfer endpoint pointer */ 991ae60fdfbSAndrew Thompson xfer->endpoint = ep; 99202ac6454SAndrew Thompson 993bce32d7bSAndrew Thompson parm.size[0] += sizeof(xfer[0]); 994ae60fdfbSAndrew Thompson parm.methods = xfer->endpoint->methods; 995bce32d7bSAndrew Thompson parm.curr_xfer = xfer; 996bce32d7bSAndrew Thompson 997bce32d7bSAndrew Thompson /* 998bce32d7bSAndrew Thompson * Call the Host or Device controller transfer 999bce32d7bSAndrew Thompson * setup routine: 1000bce32d7bSAndrew Thompson */ 1001bce32d7bSAndrew Thompson (udev->bus->methods->xfer_setup) (&parm); 1002bce32d7bSAndrew Thompson 1003bce32d7bSAndrew Thompson /* check for error */ 1004bce32d7bSAndrew Thompson if (parm.err) 1005bce32d7bSAndrew Thompson goto done; 1006bce32d7bSAndrew Thompson 100702ac6454SAndrew Thompson if (buf) { 100802ac6454SAndrew Thompson /* 1009ae60fdfbSAndrew Thompson * Increment the endpoint refcount. This 101002ac6454SAndrew Thompson * basically prevents setting a new 101102ac6454SAndrew Thompson * configuration and alternate setting 101202ac6454SAndrew Thompson * when USB transfers are in use on 101302ac6454SAndrew Thompson * the given interface. Search the USB 1014f12c6c29SAndrew Thompson * code for "endpoint->refcount_alloc" if you 101502ac6454SAndrew Thompson * want more information. 101602ac6454SAndrew Thompson */ 1017f12c6c29SAndrew Thompson USB_BUS_LOCK(info->bus); 1018f12c6c29SAndrew Thompson if (xfer->endpoint->refcount_alloc >= USB_EP_REF_MAX) 1019f12c6c29SAndrew Thompson parm.err = USB_ERR_INVAL; 1020f12c6c29SAndrew Thompson 1021f12c6c29SAndrew Thompson xfer->endpoint->refcount_alloc++; 1022f12c6c29SAndrew Thompson 1023f12c6c29SAndrew Thompson if (xfer->endpoint->refcount_alloc == 0) 1024f12c6c29SAndrew Thompson panic("usbd_transfer_setup(): Refcount wrapped to zero\n"); 1025f12c6c29SAndrew Thompson USB_BUS_UNLOCK(info->bus); 102602ac6454SAndrew Thompson 102702ac6454SAndrew Thompson /* 1028bce32d7bSAndrew Thompson * Whenever we set ppxfer[] then we 1029bce32d7bSAndrew Thompson * also need to increment the 1030bce32d7bSAndrew Thompson * "setup_refcount": 103102ac6454SAndrew Thompson */ 1032bce32d7bSAndrew Thompson info->setup_refcount++; 103302ac6454SAndrew Thompson 1034bce32d7bSAndrew Thompson /* 1035bce32d7bSAndrew Thompson * Transfer is successfully setup and 1036bce32d7bSAndrew Thompson * can be used: 1037bce32d7bSAndrew Thompson */ 1038bce32d7bSAndrew Thompson ppxfer[n] = xfer; 103902ac6454SAndrew Thompson } 1040f12c6c29SAndrew Thompson 1041f12c6c29SAndrew Thompson /* check for error */ 1042f12c6c29SAndrew Thompson if (parm.err) 1043f12c6c29SAndrew Thompson goto done; 104402ac6454SAndrew Thompson } 104502ac6454SAndrew Thompson 104602ac6454SAndrew Thompson if (buf || parm.err) { 104702ac6454SAndrew Thompson goto done; 104802ac6454SAndrew Thompson } 104902ac6454SAndrew Thompson if (refcount == 0) { 105002ac6454SAndrew Thompson /* no transfers - nothing to do ! */ 105102ac6454SAndrew Thompson goto done; 105202ac6454SAndrew Thompson } 105302ac6454SAndrew Thompson /* align data properly */ 105402ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 105502ac6454SAndrew Thompson 105602ac6454SAndrew Thompson /* store offset temporarily */ 105702ac6454SAndrew Thompson parm.size[1] = parm.size[0]; 105802ac6454SAndrew Thompson 105902ac6454SAndrew Thompson /* 106002ac6454SAndrew Thompson * The number of DMA tags required depends on 106102ac6454SAndrew Thompson * the number of endpoints. The current estimate 106202ac6454SAndrew Thompson * for maximum number of DMA tags per endpoint 106302ac6454SAndrew Thompson * is two. 106402ac6454SAndrew Thompson */ 106502ac6454SAndrew Thompson parm.dma_tag_max += 2 * MIN(n_setup, USB_EP_MAX); 106602ac6454SAndrew Thompson 106702ac6454SAndrew Thompson /* 106802ac6454SAndrew Thompson * DMA tags for QH, TD, Data and more. 106902ac6454SAndrew Thompson */ 107002ac6454SAndrew Thompson parm.dma_tag_max += 8; 107102ac6454SAndrew Thompson 107202ac6454SAndrew Thompson parm.dma_tag_p += parm.dma_tag_max; 107302ac6454SAndrew Thompson 107402ac6454SAndrew Thompson parm.size[0] += ((uint8_t *)parm.dma_tag_p) - 107502ac6454SAndrew Thompson ((uint8_t *)0); 107602ac6454SAndrew Thompson 107702ac6454SAndrew Thompson /* align data properly */ 107802ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 107902ac6454SAndrew Thompson 108002ac6454SAndrew Thompson /* store offset temporarily */ 108102ac6454SAndrew Thompson parm.size[3] = parm.size[0]; 108202ac6454SAndrew Thompson 108302ac6454SAndrew Thompson parm.size[0] += ((uint8_t *)parm.dma_page_ptr) - 108402ac6454SAndrew Thompson ((uint8_t *)0); 108502ac6454SAndrew Thompson 108602ac6454SAndrew Thompson /* align data properly */ 108702ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 108802ac6454SAndrew Thompson 108902ac6454SAndrew Thompson /* store offset temporarily */ 109002ac6454SAndrew Thompson parm.size[4] = parm.size[0]; 109102ac6454SAndrew Thompson 109202ac6454SAndrew Thompson parm.size[0] += ((uint8_t *)parm.dma_page_cache_ptr) - 109302ac6454SAndrew Thompson ((uint8_t *)0); 109402ac6454SAndrew Thompson 109502ac6454SAndrew Thompson /* store end offset temporarily */ 109602ac6454SAndrew Thompson parm.size[5] = parm.size[0]; 109702ac6454SAndrew Thompson 109802ac6454SAndrew Thompson parm.size[0] += ((uint8_t *)parm.xfer_page_cache_ptr) - 109902ac6454SAndrew Thompson ((uint8_t *)0); 110002ac6454SAndrew Thompson 110102ac6454SAndrew Thompson /* store end offset temporarily */ 110202ac6454SAndrew Thompson 110302ac6454SAndrew Thompson parm.size[2] = parm.size[0]; 110402ac6454SAndrew Thompson 110502ac6454SAndrew Thompson /* align data properly */ 110602ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 110702ac6454SAndrew Thompson 110802ac6454SAndrew Thompson parm.size[6] = parm.size[0]; 110902ac6454SAndrew Thompson 111002ac6454SAndrew Thompson parm.size[0] += ((uint8_t *)parm.xfer_length_ptr) - 111102ac6454SAndrew Thompson ((uint8_t *)0); 111202ac6454SAndrew Thompson 111302ac6454SAndrew Thompson /* align data properly */ 111402ac6454SAndrew Thompson parm.size[0] += ((-parm.size[0]) & (USB_HOST_ALIGN - 1)); 111502ac6454SAndrew Thompson 111602ac6454SAndrew Thompson /* allocate zeroed memory */ 111702ac6454SAndrew Thompson buf = malloc(parm.size[0], M_USB, M_WAITOK | M_ZERO); 111802ac6454SAndrew Thompson 111902ac6454SAndrew Thompson if (buf == NULL) { 112002ac6454SAndrew Thompson parm.err = USB_ERR_NOMEM; 112102ac6454SAndrew Thompson DPRINTFN(0, "cannot allocate memory block for " 112202ac6454SAndrew Thompson "configuration (%d bytes)\n", 112302ac6454SAndrew Thompson parm.size[0]); 112402ac6454SAndrew Thompson goto done; 112502ac6454SAndrew Thompson } 112602ac6454SAndrew Thompson parm.dma_tag_p = USB_ADD_BYTES(buf, parm.size[1]); 112702ac6454SAndrew Thompson parm.dma_page_ptr = USB_ADD_BYTES(buf, parm.size[3]); 112802ac6454SAndrew Thompson parm.dma_page_cache_ptr = USB_ADD_BYTES(buf, parm.size[4]); 112902ac6454SAndrew Thompson parm.xfer_page_cache_ptr = USB_ADD_BYTES(buf, parm.size[5]); 113002ac6454SAndrew Thompson parm.xfer_length_ptr = USB_ADD_BYTES(buf, parm.size[6]); 113102ac6454SAndrew Thompson } 113202ac6454SAndrew Thompson 113302ac6454SAndrew Thompson done: 113402ac6454SAndrew Thompson if (buf) { 113502ac6454SAndrew Thompson if (info->setup_refcount == 0) { 113602ac6454SAndrew Thompson /* 1137a593f6b8SAndrew Thompson * "usbd_transfer_unsetup_sub" will unlock 113802ac6454SAndrew Thompson * the bus mutex before returning ! 113902ac6454SAndrew Thompson */ 114002ac6454SAndrew Thompson USB_BUS_LOCK(info->bus); 114102ac6454SAndrew Thompson 114202ac6454SAndrew Thompson /* something went wrong */ 1143a593f6b8SAndrew Thompson usbd_transfer_unsetup_sub(info, 0); 114402ac6454SAndrew Thompson } 114502ac6454SAndrew Thompson } 114602ac6454SAndrew Thompson if (parm.err) { 1147a593f6b8SAndrew Thompson usbd_transfer_unsetup(ppxfer, n_setup); 114802ac6454SAndrew Thompson } 114902ac6454SAndrew Thompson return (parm.err); 115002ac6454SAndrew Thompson } 115102ac6454SAndrew Thompson 115202ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1153a593f6b8SAndrew Thompson * usbd_transfer_unsetup_sub - factored out code 115402ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 115502ac6454SAndrew Thompson static void 1156a593f6b8SAndrew Thompson usbd_transfer_unsetup_sub(struct usb_xfer_root *info, uint8_t needs_delay) 115702ac6454SAndrew Thompson { 115888334428SHans Petter Selasky #if USB_HAVE_BUSDMA 1159760bc48eSAndrew Thompson struct usb_page_cache *pc; 116088334428SHans Petter Selasky #endif 116102ac6454SAndrew Thompson 116202ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(info->bus, MA_OWNED); 116302ac6454SAndrew Thompson 116402ac6454SAndrew Thompson /* wait for any outstanding DMA operations */ 116502ac6454SAndrew Thompson 116602ac6454SAndrew Thompson if (needs_delay) { 1167e0a69b51SAndrew Thompson usb_timeout_t temp; 1168527aa7b2SAndrew Thompson temp = usbd_get_dma_delay(info->udev); 1169527aa7b2SAndrew Thompson if (temp != 0) { 1170a593f6b8SAndrew Thompson usb_pause_mtx(&info->bus->bus_mtx, 117102ac6454SAndrew Thompson USB_MS_TO_TICKS(temp)); 117202ac6454SAndrew Thompson } 1173527aa7b2SAndrew Thompson } 117402ac6454SAndrew Thompson 117502ac6454SAndrew Thompson /* make sure that our done messages are not queued anywhere */ 1176a593f6b8SAndrew Thompson usb_proc_mwait(info->done_p, &info->done_m[0], &info->done_m[1]); 117702ac6454SAndrew Thompson 117802ac6454SAndrew Thompson USB_BUS_UNLOCK(info->bus); 117902ac6454SAndrew Thompson 1180bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 118102ac6454SAndrew Thompson /* free DMA'able memory, if any */ 118202ac6454SAndrew Thompson pc = info->dma_page_cache_start; 118302ac6454SAndrew Thompson while (pc != info->dma_page_cache_end) { 1184a593f6b8SAndrew Thompson usb_pc_free_mem(pc); 118502ac6454SAndrew Thompson pc++; 118602ac6454SAndrew Thompson } 118702ac6454SAndrew Thompson 118802ac6454SAndrew Thompson /* free DMA maps in all "xfer->frbuffers" */ 118902ac6454SAndrew Thompson pc = info->xfer_page_cache_start; 119002ac6454SAndrew Thompson while (pc != info->xfer_page_cache_end) { 1191a593f6b8SAndrew Thompson usb_pc_dmamap_destroy(pc); 119202ac6454SAndrew Thompson pc++; 119302ac6454SAndrew Thompson } 119402ac6454SAndrew Thompson 119502ac6454SAndrew Thompson /* free all DMA tags */ 1196a593f6b8SAndrew Thompson usb_dma_tag_unsetup(&info->dma_parent_tag); 1197bdc081c6SAndrew Thompson #endif 119802ac6454SAndrew Thompson 11998437751dSAndrew Thompson cv_destroy(&info->cv_drain); 120002ac6454SAndrew Thompson 120102ac6454SAndrew Thompson /* 120202ac6454SAndrew Thompson * free the "memory_base" last, hence the "info" structure is 120302ac6454SAndrew Thompson * contained within the "memory_base"! 120402ac6454SAndrew Thompson */ 120502ac6454SAndrew Thompson free(info->memory_base, M_USB); 120602ac6454SAndrew Thompson } 120702ac6454SAndrew Thompson 120802ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1209a593f6b8SAndrew Thompson * usbd_transfer_unsetup - unsetup/free an array of USB transfers 121002ac6454SAndrew Thompson * 121102ac6454SAndrew Thompson * NOTE: All USB transfers in progress will get called back passing 121202ac6454SAndrew Thompson * the error code "USB_ERR_CANCELLED" before this function 121302ac6454SAndrew Thompson * returns. 121402ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 121502ac6454SAndrew Thompson void 1216a593f6b8SAndrew Thompson usbd_transfer_unsetup(struct usb_xfer **pxfer, uint16_t n_setup) 121702ac6454SAndrew Thompson { 1218760bc48eSAndrew Thompson struct usb_xfer *xfer; 1219760bc48eSAndrew Thompson struct usb_xfer_root *info; 122002ac6454SAndrew Thompson uint8_t needs_delay = 0; 122102ac6454SAndrew Thompson 122202ac6454SAndrew Thompson WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL, 1223a593f6b8SAndrew Thompson "usbd_transfer_unsetup can sleep!"); 122402ac6454SAndrew Thompson 122502ac6454SAndrew Thompson while (n_setup--) { 122602ac6454SAndrew Thompson xfer = pxfer[n_setup]; 122702ac6454SAndrew Thompson 1228bce32d7bSAndrew Thompson if (xfer == NULL) 1229bce32d7bSAndrew Thompson continue; 1230bce32d7bSAndrew Thompson 1231bce32d7bSAndrew Thompson info = xfer->xroot; 1232bce32d7bSAndrew Thompson 123302ac6454SAndrew Thompson USB_XFER_LOCK(xfer); 1234bce32d7bSAndrew Thompson USB_BUS_LOCK(info->bus); 123502ac6454SAndrew Thompson 123602ac6454SAndrew Thompson /* 1237bce32d7bSAndrew Thompson * HINT: when you start/stop a transfer, it might be a 1238bce32d7bSAndrew Thompson * good idea to directly use the "pxfer[]" structure: 123902ac6454SAndrew Thompson * 1240a593f6b8SAndrew Thompson * usbd_transfer_start(sc->pxfer[0]); 1241a593f6b8SAndrew Thompson * usbd_transfer_stop(sc->pxfer[0]); 124202ac6454SAndrew Thompson * 1243bce32d7bSAndrew Thompson * That way, if your code has many parts that will not 1244bce32d7bSAndrew Thompson * stop running under the same lock, in other words 1245a593f6b8SAndrew Thompson * "xfer_mtx", the usbd_transfer_start and 1246a593f6b8SAndrew Thompson * usbd_transfer_stop functions will simply return 1247bce32d7bSAndrew Thompson * when they detect a NULL pointer argument. 124802ac6454SAndrew Thompson * 1249bce32d7bSAndrew Thompson * To avoid any races we clear the "pxfer[]" pointer 1250bce32d7bSAndrew Thompson * while holding the private mutex of the driver: 125102ac6454SAndrew Thompson */ 125202ac6454SAndrew Thompson pxfer[n_setup] = NULL; 125302ac6454SAndrew Thompson 1254bce32d7bSAndrew Thompson USB_BUS_UNLOCK(info->bus); 125502ac6454SAndrew Thompson USB_XFER_UNLOCK(xfer); 125602ac6454SAndrew Thompson 1257a593f6b8SAndrew Thompson usbd_transfer_drain(xfer); 125802ac6454SAndrew Thompson 1259bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 1260bce32d7bSAndrew Thompson if (xfer->flags_int.bdma_enable) 126102ac6454SAndrew Thompson needs_delay = 1; 1262bdc081c6SAndrew Thompson #endif 126302ac6454SAndrew Thompson /* 1264ae60fdfbSAndrew Thompson * NOTE: default endpoint does not have an 1265ae60fdfbSAndrew Thompson * interface, even if endpoint->iface_index == 0 126602ac6454SAndrew Thompson */ 1267f12c6c29SAndrew Thompson USB_BUS_LOCK(info->bus); 1268f12c6c29SAndrew Thompson xfer->endpoint->refcount_alloc--; 1269f12c6c29SAndrew Thompson USB_BUS_UNLOCK(info->bus); 127002ac6454SAndrew Thompson 1271a593f6b8SAndrew Thompson usb_callout_drain(&xfer->timeout_handle); 127202ac6454SAndrew Thompson 127302ac6454SAndrew Thompson USB_BUS_LOCK(info->bus); 127402ac6454SAndrew Thompson 1275bce32d7bSAndrew Thompson USB_ASSERT(info->setup_refcount != 0, ("Invalid setup " 1276767cb2e2SAndrew Thompson "reference count\n")); 127702ac6454SAndrew Thompson 127802ac6454SAndrew Thompson info->setup_refcount--; 127902ac6454SAndrew Thompson 128002ac6454SAndrew Thompson if (info->setup_refcount == 0) { 1281a593f6b8SAndrew Thompson usbd_transfer_unsetup_sub(info, 128202ac6454SAndrew Thompson needs_delay); 128302ac6454SAndrew Thompson } else { 128402ac6454SAndrew Thompson USB_BUS_UNLOCK(info->bus); 128502ac6454SAndrew Thompson } 128602ac6454SAndrew Thompson } 128702ac6454SAndrew Thompson } 128802ac6454SAndrew Thompson 128902ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1290a593f6b8SAndrew Thompson * usbd_control_transfer_init - factored out code 129102ac6454SAndrew Thompson * 129202ac6454SAndrew Thompson * In USB Device Mode we have to wait for the SETUP packet which 1293760bc48eSAndrew Thompson * containst the "struct usb_device_request" structure, before we can 129402ac6454SAndrew Thompson * transfer any data. In USB Host Mode we already have the SETUP 129502ac6454SAndrew Thompson * packet at the moment the USB transfer is started. This leads us to 129602ac6454SAndrew Thompson * having to setup the USB transfer at two different places in 129702ac6454SAndrew Thompson * time. This function just contains factored out control transfer 129802ac6454SAndrew Thompson * initialisation code, so that we don't duplicate the code. 129902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 130002ac6454SAndrew Thompson static void 1301a593f6b8SAndrew Thompson usbd_control_transfer_init(struct usb_xfer *xfer) 130202ac6454SAndrew Thompson { 1303760bc48eSAndrew Thompson struct usb_device_request req; 130402ac6454SAndrew Thompson 130502ac6454SAndrew Thompson /* copy out the USB request header */ 130602ac6454SAndrew Thompson 1307a593f6b8SAndrew Thompson usbd_copy_out(xfer->frbuffers, 0, &req, sizeof(req)); 130802ac6454SAndrew Thompson 130902ac6454SAndrew Thompson /* setup remainder */ 131002ac6454SAndrew Thompson 131102ac6454SAndrew Thompson xfer->flags_int.control_rem = UGETW(req.wLength); 131202ac6454SAndrew Thompson 131302ac6454SAndrew Thompson /* copy direction to endpoint variable */ 131402ac6454SAndrew Thompson 1315ae60fdfbSAndrew Thompson xfer->endpointno &= ~(UE_DIR_IN | UE_DIR_OUT); 1316ae60fdfbSAndrew Thompson xfer->endpointno |= 131702ac6454SAndrew Thompson (req.bmRequestType & UT_READ) ? UE_DIR_IN : UE_DIR_OUT; 131802ac6454SAndrew Thompson } 131902ac6454SAndrew Thompson 132002ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1321ed6d949aSAndrew Thompson * usbd_setup_ctrl_transfer 132202ac6454SAndrew Thompson * 132302ac6454SAndrew Thompson * This function handles initialisation of control transfers. Control 132402ac6454SAndrew Thompson * transfers are special in that regard that they can both transmit 132502ac6454SAndrew Thompson * and receive data. 132602ac6454SAndrew Thompson * 132702ac6454SAndrew Thompson * Return values: 132802ac6454SAndrew Thompson * 0: Success 132902ac6454SAndrew Thompson * Else: Failure 133002ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 1331ed6d949aSAndrew Thompson static int 1332ed6d949aSAndrew Thompson usbd_setup_ctrl_transfer(struct usb_xfer *xfer) 133302ac6454SAndrew Thompson { 1334e0a69b51SAndrew Thompson usb_frlength_t len; 133502ac6454SAndrew Thompson 133602ac6454SAndrew Thompson /* Check for control endpoint stall */ 1337476183dfSAndrew Thompson if (xfer->flags.stall_pipe && xfer->flags_int.control_act) { 1338476183dfSAndrew Thompson /* the control transfer is no longer active */ 1339476183dfSAndrew Thompson xfer->flags_int.control_stall = 1; 134002ac6454SAndrew Thompson xfer->flags_int.control_act = 0; 1341476183dfSAndrew Thompson } else { 1342476183dfSAndrew Thompson /* don't stall control transfer by default */ 1343476183dfSAndrew Thompson xfer->flags_int.control_stall = 0; 134402ac6454SAndrew Thompson } 1345e1ccac96SAndrew Thompson 1346e1ccac96SAndrew Thompson /* Check for invalid number of frames */ 1347e1ccac96SAndrew Thompson if (xfer->nframes > 2) { 1348e1ccac96SAndrew Thompson /* 1349e1ccac96SAndrew Thompson * If you need to split a control transfer, you 1350e1ccac96SAndrew Thompson * have to do one part at a time. Only with 1351e1ccac96SAndrew Thompson * non-control transfers you can do multiple 1352e1ccac96SAndrew Thompson * parts a time. 1353e1ccac96SAndrew Thompson */ 1354e1ccac96SAndrew Thompson DPRINTFN(0, "Too many frames: %u\n", 1355e1ccac96SAndrew Thompson (unsigned int)xfer->nframes); 1356e1ccac96SAndrew Thompson goto error; 1357e1ccac96SAndrew Thompson } 1358e1ccac96SAndrew Thompson 135902ac6454SAndrew Thompson /* 136002ac6454SAndrew Thompson * Check if there is a control 136102ac6454SAndrew Thompson * transfer in progress: 136202ac6454SAndrew Thompson */ 136302ac6454SAndrew Thompson if (xfer->flags_int.control_act) { 136402ac6454SAndrew Thompson 136502ac6454SAndrew Thompson if (xfer->flags_int.control_hdr) { 136602ac6454SAndrew Thompson 136702ac6454SAndrew Thompson /* clear send header flag */ 136802ac6454SAndrew Thompson 136902ac6454SAndrew Thompson xfer->flags_int.control_hdr = 0; 137002ac6454SAndrew Thompson 137102ac6454SAndrew Thompson /* setup control transfer */ 1372f29a0724SAndrew Thompson if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) { 1373a593f6b8SAndrew Thompson usbd_control_transfer_init(xfer); 137402ac6454SAndrew Thompson } 137502ac6454SAndrew Thompson } 137602ac6454SAndrew Thompson /* get data length */ 137702ac6454SAndrew Thompson 137802ac6454SAndrew Thompson len = xfer->sumlen; 137902ac6454SAndrew Thompson 138002ac6454SAndrew Thompson } else { 138102ac6454SAndrew Thompson 138202ac6454SAndrew Thompson /* the size of the SETUP structure is hardcoded ! */ 138302ac6454SAndrew Thompson 1384760bc48eSAndrew Thompson if (xfer->frlengths[0] != sizeof(struct usb_device_request)) { 138502ac6454SAndrew Thompson DPRINTFN(0, "Wrong framelength %u != %zu\n", 138602ac6454SAndrew Thompson xfer->frlengths[0], sizeof(struct 1387760bc48eSAndrew Thompson usb_device_request)); 138802ac6454SAndrew Thompson goto error; 138902ac6454SAndrew Thompson } 139002ac6454SAndrew Thompson /* check USB mode */ 1391f29a0724SAndrew Thompson if (xfer->flags_int.usb_mode == USB_MODE_DEVICE) { 139202ac6454SAndrew Thompson 139302ac6454SAndrew Thompson /* check number of frames */ 139402ac6454SAndrew Thompson if (xfer->nframes != 1) { 139502ac6454SAndrew Thompson /* 139602ac6454SAndrew Thompson * We need to receive the setup 139702ac6454SAndrew Thompson * message first so that we know the 139802ac6454SAndrew Thompson * data direction! 139902ac6454SAndrew Thompson */ 140002ac6454SAndrew Thompson DPRINTF("Misconfigured transfer\n"); 140102ac6454SAndrew Thompson goto error; 140202ac6454SAndrew Thompson } 140302ac6454SAndrew Thompson /* 140402ac6454SAndrew Thompson * Set a dummy "control_rem" value. This 140502ac6454SAndrew Thompson * variable will be overwritten later by a 1406a593f6b8SAndrew Thompson * call to "usbd_control_transfer_init()" ! 140702ac6454SAndrew Thompson */ 140802ac6454SAndrew Thompson xfer->flags_int.control_rem = 0xFFFF; 140902ac6454SAndrew Thompson } else { 141002ac6454SAndrew Thompson 141102ac6454SAndrew Thompson /* setup "endpoint" and "control_rem" */ 141202ac6454SAndrew Thompson 1413a593f6b8SAndrew Thompson usbd_control_transfer_init(xfer); 141402ac6454SAndrew Thompson } 141502ac6454SAndrew Thompson 141602ac6454SAndrew Thompson /* set transfer-header flag */ 141702ac6454SAndrew Thompson 141802ac6454SAndrew Thompson xfer->flags_int.control_hdr = 1; 141902ac6454SAndrew Thompson 142002ac6454SAndrew Thompson /* get data length */ 142102ac6454SAndrew Thompson 1422760bc48eSAndrew Thompson len = (xfer->sumlen - sizeof(struct usb_device_request)); 142302ac6454SAndrew Thompson } 142402ac6454SAndrew Thompson 142502ac6454SAndrew Thompson /* check if there is a length mismatch */ 142602ac6454SAndrew Thompson 142702ac6454SAndrew Thompson if (len > xfer->flags_int.control_rem) { 1428a8725281SAndrew Thompson DPRINTFN(0, "Length (%d) greater than " 1429767cb2e2SAndrew Thompson "remaining length (%d)\n", len, 1430a8725281SAndrew Thompson xfer->flags_int.control_rem); 143102ac6454SAndrew Thompson goto error; 143202ac6454SAndrew Thompson } 143302ac6454SAndrew Thompson /* check if we are doing a short transfer */ 143402ac6454SAndrew Thompson 143502ac6454SAndrew Thompson if (xfer->flags.force_short_xfer) { 143602ac6454SAndrew Thompson xfer->flags_int.control_rem = 0; 143702ac6454SAndrew Thompson } else { 143802ac6454SAndrew Thompson if ((len != xfer->max_data_length) && 143902ac6454SAndrew Thompson (len != xfer->flags_int.control_rem) && 144002ac6454SAndrew Thompson (xfer->nframes != 1)) { 144102ac6454SAndrew Thompson DPRINTFN(0, "Short control transfer without " 1442767cb2e2SAndrew Thompson "force_short_xfer set\n"); 144302ac6454SAndrew Thompson goto error; 144402ac6454SAndrew Thompson } 144502ac6454SAndrew Thompson xfer->flags_int.control_rem -= len; 144602ac6454SAndrew Thompson } 144702ac6454SAndrew Thompson 144802ac6454SAndrew Thompson /* the status part is executed when "control_act" is 0 */ 144902ac6454SAndrew Thompson 145002ac6454SAndrew Thompson if ((xfer->flags_int.control_rem > 0) || 145102ac6454SAndrew Thompson (xfer->flags.manual_status)) { 145202ac6454SAndrew Thompson /* don't execute the STATUS stage yet */ 145302ac6454SAndrew Thompson xfer->flags_int.control_act = 1; 145402ac6454SAndrew Thompson 145502ac6454SAndrew Thompson /* sanity check */ 145602ac6454SAndrew Thompson if ((!xfer->flags_int.control_hdr) && 145702ac6454SAndrew Thompson (xfer->nframes == 1)) { 145802ac6454SAndrew Thompson /* 145902ac6454SAndrew Thompson * This is not a valid operation! 146002ac6454SAndrew Thompson */ 146102ac6454SAndrew Thompson DPRINTFN(0, "Invalid parameter " 146202ac6454SAndrew Thompson "combination\n"); 146302ac6454SAndrew Thompson goto error; 146402ac6454SAndrew Thompson } 146502ac6454SAndrew Thompson } else { 146602ac6454SAndrew Thompson /* time to execute the STATUS stage */ 146702ac6454SAndrew Thompson xfer->flags_int.control_act = 0; 146802ac6454SAndrew Thompson } 146902ac6454SAndrew Thompson return (0); /* success */ 147002ac6454SAndrew Thompson 147102ac6454SAndrew Thompson error: 147202ac6454SAndrew Thompson return (1); /* failure */ 147302ac6454SAndrew Thompson } 147402ac6454SAndrew Thompson 147502ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1476a593f6b8SAndrew Thompson * usbd_transfer_submit - start USB hardware for the given transfer 147702ac6454SAndrew Thompson * 147802ac6454SAndrew Thompson * This function should only be called from the USB callback. 147902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 148002ac6454SAndrew Thompson void 1481a593f6b8SAndrew Thompson usbd_transfer_submit(struct usb_xfer *xfer) 148202ac6454SAndrew Thompson { 1483760bc48eSAndrew Thompson struct usb_xfer_root *info; 1484760bc48eSAndrew Thompson struct usb_bus *bus; 1485e0a69b51SAndrew Thompson usb_frcount_t x; 148602ac6454SAndrew Thompson 1487bd216778SAndrew Thompson info = xfer->xroot; 1488bd216778SAndrew Thompson bus = info->bus; 1489bd216778SAndrew Thompson 1490ae60fdfbSAndrew Thompson DPRINTF("xfer=%p, endpoint=%p, nframes=%d, dir=%s\n", 1491ae60fdfbSAndrew Thompson xfer, xfer->endpoint, xfer->nframes, USB_GET_DATA_ISREAD(xfer) ? 149202ac6454SAndrew Thompson "read" : "write"); 149302ac6454SAndrew Thompson 1494b850ecc1SAndrew Thompson #ifdef USB_DEBUG 149502ac6454SAndrew Thompson if (USB_DEBUG_VAR > 0) { 1496bd216778SAndrew Thompson USB_BUS_LOCK(bus); 149702ac6454SAndrew Thompson 1498a593f6b8SAndrew Thompson usb_dump_endpoint(xfer->endpoint); 149902ac6454SAndrew Thompson 1500bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 150102ac6454SAndrew Thompson } 150202ac6454SAndrew Thompson #endif 150302ac6454SAndrew Thompson 150402ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 1505bd216778SAndrew Thompson USB_BUS_LOCK_ASSERT(bus, MA_NOTOWNED); 150602ac6454SAndrew Thompson 150702ac6454SAndrew Thompson /* Only open the USB transfer once! */ 150802ac6454SAndrew Thompson if (!xfer->flags_int.open) { 150902ac6454SAndrew Thompson xfer->flags_int.open = 1; 151002ac6454SAndrew Thompson 151102ac6454SAndrew Thompson DPRINTF("open\n"); 151202ac6454SAndrew Thompson 1513bd216778SAndrew Thompson USB_BUS_LOCK(bus); 1514ae60fdfbSAndrew Thompson (xfer->endpoint->methods->open) (xfer); 1515bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 151602ac6454SAndrew Thompson } 151702ac6454SAndrew Thompson /* set "transferring" flag */ 151802ac6454SAndrew Thompson xfer->flags_int.transferring = 1; 151902ac6454SAndrew Thompson 15204eae601eSAndrew Thompson #if USB_HAVE_POWERD 152102ac6454SAndrew Thompson /* increment power reference */ 1522a593f6b8SAndrew Thompson usbd_transfer_power_ref(xfer, 1); 15234eae601eSAndrew Thompson #endif 152402ac6454SAndrew Thompson /* 152502ac6454SAndrew Thompson * Check if the transfer is waiting on a queue, most 152602ac6454SAndrew Thompson * frequently the "done_q": 152702ac6454SAndrew Thompson */ 152802ac6454SAndrew Thompson if (xfer->wait_queue) { 1529bd216778SAndrew Thompson USB_BUS_LOCK(bus); 1530a593f6b8SAndrew Thompson usbd_transfer_dequeue(xfer); 1531bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 153202ac6454SAndrew Thompson } 153302ac6454SAndrew Thompson /* clear "did_dma_delay" flag */ 153402ac6454SAndrew Thompson xfer->flags_int.did_dma_delay = 0; 153502ac6454SAndrew Thompson 153602ac6454SAndrew Thompson /* clear "did_close" flag */ 153702ac6454SAndrew Thompson xfer->flags_int.did_close = 0; 153802ac6454SAndrew Thompson 1539bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 154002ac6454SAndrew Thompson /* clear "bdma_setup" flag */ 154102ac6454SAndrew Thompson xfer->flags_int.bdma_setup = 0; 1542bdc081c6SAndrew Thompson #endif 154302ac6454SAndrew Thompson /* by default we cannot cancel any USB transfer immediately */ 154402ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 0; 154502ac6454SAndrew Thompson 154602ac6454SAndrew Thompson /* clear lengths and frame counts by default */ 154702ac6454SAndrew Thompson xfer->sumlen = 0; 154802ac6454SAndrew Thompson xfer->actlen = 0; 154902ac6454SAndrew Thompson xfer->aframes = 0; 155002ac6454SAndrew Thompson 155102ac6454SAndrew Thompson /* clear any previous errors */ 155202ac6454SAndrew Thompson xfer->error = 0; 155302ac6454SAndrew Thompson 1554ec8f3127SAndrew Thompson /* Check if the device is still alive */ 1555ec8f3127SAndrew Thompson if (info->udev->state < USB_STATE_POWERED) { 1556ec8f3127SAndrew Thompson USB_BUS_LOCK(bus); 1557f1f88408SAndrew Thompson /* 1558f1f88408SAndrew Thompson * Must return cancelled error code else 1559f1f88408SAndrew Thompson * device drivers can hang. 1560f1f88408SAndrew Thompson */ 1561a593f6b8SAndrew Thompson usbd_transfer_done(xfer, USB_ERR_CANCELLED); 1562ec8f3127SAndrew Thompson USB_BUS_UNLOCK(bus); 1563ec8f3127SAndrew Thompson return; 1564ec8f3127SAndrew Thompson } 156502ac6454SAndrew Thompson 1566ec8f3127SAndrew Thompson /* sanity check */ 156702ac6454SAndrew Thompson if (xfer->nframes == 0) { 156802ac6454SAndrew Thompson if (xfer->flags.stall_pipe) { 156902ac6454SAndrew Thompson /* 157002ac6454SAndrew Thompson * Special case - want to stall without transferring 157102ac6454SAndrew Thompson * any data: 157202ac6454SAndrew Thompson */ 157302ac6454SAndrew Thompson DPRINTF("xfer=%p nframes=0: stall " 157402ac6454SAndrew Thompson "or clear stall!\n", xfer); 1575bd216778SAndrew Thompson USB_BUS_LOCK(bus); 157602ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 1; 157702ac6454SAndrew Thompson /* start the transfer */ 1578a593f6b8SAndrew Thompson usb_command_wrapper(&xfer->endpoint->endpoint_q, xfer); 1579bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 158002ac6454SAndrew Thompson return; 158102ac6454SAndrew Thompson } 1582bd216778SAndrew Thompson USB_BUS_LOCK(bus); 1583a593f6b8SAndrew Thompson usbd_transfer_done(xfer, USB_ERR_INVAL); 1584bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 158502ac6454SAndrew Thompson return; 158602ac6454SAndrew Thompson } 158731a11691SHans Petter Selasky /* compute some variables */ 158802ac6454SAndrew Thompson 158902ac6454SAndrew Thompson for (x = 0; x != xfer->nframes; x++) { 159031a11691SHans Petter Selasky /* make a copy of the frlenghts[] */ 159131a11691SHans Petter Selasky xfer->frlengths[x + xfer->max_frame_count] = xfer->frlengths[x]; 159231a11691SHans Petter Selasky /* compute total transfer length */ 159302ac6454SAndrew Thompson xfer->sumlen += xfer->frlengths[x]; 159402ac6454SAndrew Thompson if (xfer->sumlen < xfer->frlengths[x]) { 159502ac6454SAndrew Thompson /* length wrapped around */ 1596bd216778SAndrew Thompson USB_BUS_LOCK(bus); 1597a593f6b8SAndrew Thompson usbd_transfer_done(xfer, USB_ERR_INVAL); 1598bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 159902ac6454SAndrew Thompson return; 160002ac6454SAndrew Thompson } 160102ac6454SAndrew Thompson } 160202ac6454SAndrew Thompson 160302ac6454SAndrew Thompson /* clear some internal flags */ 160402ac6454SAndrew Thompson 160502ac6454SAndrew Thompson xfer->flags_int.short_xfer_ok = 0; 160602ac6454SAndrew Thompson xfer->flags_int.short_frames_ok = 0; 160702ac6454SAndrew Thompson 160802ac6454SAndrew Thompson /* check if this is a control transfer */ 160902ac6454SAndrew Thompson 161002ac6454SAndrew Thompson if (xfer->flags_int.control_xfr) { 161102ac6454SAndrew Thompson 1612ed6d949aSAndrew Thompson if (usbd_setup_ctrl_transfer(xfer)) { 1613bd216778SAndrew Thompson USB_BUS_LOCK(bus); 1614a593f6b8SAndrew Thompson usbd_transfer_done(xfer, USB_ERR_STALLED); 1615bd216778SAndrew Thompson USB_BUS_UNLOCK(bus); 161602ac6454SAndrew Thompson return; 161702ac6454SAndrew Thompson } 161802ac6454SAndrew Thompson } 161902ac6454SAndrew Thompson /* 162002ac6454SAndrew Thompson * Setup filtered version of some transfer flags, 162102ac6454SAndrew Thompson * in case of data read direction 162202ac6454SAndrew Thompson */ 162302ac6454SAndrew Thompson if (USB_GET_DATA_ISREAD(xfer)) { 162402ac6454SAndrew Thompson 162502ac6454SAndrew Thompson if (xfer->flags.short_frames_ok) { 162602ac6454SAndrew Thompson xfer->flags_int.short_xfer_ok = 1; 162702ac6454SAndrew Thompson xfer->flags_int.short_frames_ok = 1; 162802ac6454SAndrew Thompson } else if (xfer->flags.short_xfer_ok) { 162902ac6454SAndrew Thompson xfer->flags_int.short_xfer_ok = 1; 1630e1ccac96SAndrew Thompson 1631e1ccac96SAndrew Thompson /* check for control transfer */ 1632e1ccac96SAndrew Thompson if (xfer->flags_int.control_xfr) { 1633e1ccac96SAndrew Thompson /* 1634e1ccac96SAndrew Thompson * 1) Control transfers do not support 1635e1ccac96SAndrew Thompson * reception of multiple short USB 1636e1ccac96SAndrew Thompson * frames in host mode and device side 1637e1ccac96SAndrew Thompson * mode, with exception of: 1638e1ccac96SAndrew Thompson * 1639e1ccac96SAndrew Thompson * 2) Due to sometimes buggy device 1640e1ccac96SAndrew Thompson * side firmware we need to do a 1641e1ccac96SAndrew Thompson * STATUS stage in case of short 1642e1ccac96SAndrew Thompson * control transfers in USB host mode. 1643e1ccac96SAndrew Thompson * The STATUS stage then becomes the 1644e1ccac96SAndrew Thompson * "alt_next" to the DATA stage. 1645e1ccac96SAndrew Thompson */ 1646e1ccac96SAndrew Thompson xfer->flags_int.short_frames_ok = 1; 164702ac6454SAndrew Thompson } 164802ac6454SAndrew Thompson } 164902ac6454SAndrew Thompson } 165002ac6454SAndrew Thompson /* 165102ac6454SAndrew Thompson * Check if BUS-DMA support is enabled and try to load virtual 165202ac6454SAndrew Thompson * buffers into DMA, if any: 165302ac6454SAndrew Thompson */ 1654bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 165502ac6454SAndrew Thompson if (xfer->flags_int.bdma_enable) { 165602ac6454SAndrew Thompson /* insert the USB transfer last in the BUS-DMA queue */ 1657a593f6b8SAndrew Thompson usb_command_wrapper(&xfer->xroot->dma_q, xfer); 165802ac6454SAndrew Thompson return; 165902ac6454SAndrew Thompson } 1660bdc081c6SAndrew Thompson #endif 166102ac6454SAndrew Thompson /* 166202ac6454SAndrew Thompson * Enter the USB transfer into the Host Controller or 166302ac6454SAndrew Thompson * Device Controller schedule: 166402ac6454SAndrew Thompson */ 1665a593f6b8SAndrew Thompson usbd_pipe_enter(xfer); 166602ac6454SAndrew Thompson } 166702ac6454SAndrew Thompson 166802ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1669a593f6b8SAndrew Thompson * usbd_pipe_enter - factored out code 167002ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 167102ac6454SAndrew Thompson void 1672a593f6b8SAndrew Thompson usbd_pipe_enter(struct usb_xfer *xfer) 167302ac6454SAndrew Thompson { 1674ae60fdfbSAndrew Thompson struct usb_endpoint *ep; 167502ac6454SAndrew Thompson 167602ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 167702ac6454SAndrew Thompson 167802ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 167902ac6454SAndrew Thompson 1680ae60fdfbSAndrew Thompson ep = xfer->endpoint; 168102ac6454SAndrew Thompson 168202ac6454SAndrew Thompson DPRINTF("enter\n"); 168302ac6454SAndrew Thompson 168402ac6454SAndrew Thompson /* enter the transfer */ 1685ae60fdfbSAndrew Thompson (ep->methods->enter) (xfer); 168602ac6454SAndrew Thompson 168702ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 1; 16884565300dSAndrew Thompson 168902ac6454SAndrew Thompson /* check for transfer error */ 169002ac6454SAndrew Thompson if (xfer->error) { 169102ac6454SAndrew Thompson /* some error has happened */ 1692a593f6b8SAndrew Thompson usbd_transfer_done(xfer, 0); 169302ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 169402ac6454SAndrew Thompson return; 169502ac6454SAndrew Thompson } 169602ac6454SAndrew Thompson 169702ac6454SAndrew Thompson /* start the transfer */ 1698a593f6b8SAndrew Thompson usb_command_wrapper(&ep->endpoint_q, xfer); 169902ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 170002ac6454SAndrew Thompson } 170102ac6454SAndrew Thompson 170202ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1703a593f6b8SAndrew Thompson * usbd_transfer_start - start an USB transfer 170402ac6454SAndrew Thompson * 170502ac6454SAndrew Thompson * NOTE: Calling this function more than one time will only 170602ac6454SAndrew Thompson * result in a single transfer start, until the USB transfer 170702ac6454SAndrew Thompson * completes. 170802ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 170902ac6454SAndrew Thompson void 1710a593f6b8SAndrew Thompson usbd_transfer_start(struct usb_xfer *xfer) 171102ac6454SAndrew Thompson { 171202ac6454SAndrew Thompson if (xfer == NULL) { 171302ac6454SAndrew Thompson /* transfer is gone */ 171402ac6454SAndrew Thompson return; 171502ac6454SAndrew Thompson } 171602ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 171702ac6454SAndrew Thompson 171802ac6454SAndrew Thompson /* mark the USB transfer started */ 171902ac6454SAndrew Thompson 172002ac6454SAndrew Thompson if (!xfer->flags_int.started) { 1721a8725281SAndrew Thompson /* lock the BUS lock to avoid races updating flags_int */ 1722a8725281SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 172302ac6454SAndrew Thompson xfer->flags_int.started = 1; 1724a8725281SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 172502ac6454SAndrew Thompson } 172602ac6454SAndrew Thompson /* check if the USB transfer callback is already transferring */ 172702ac6454SAndrew Thompson 172802ac6454SAndrew Thompson if (xfer->flags_int.transferring) { 172902ac6454SAndrew Thompson return; 173002ac6454SAndrew Thompson } 173102ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 173202ac6454SAndrew Thompson /* call the USB transfer callback */ 1733a593f6b8SAndrew Thompson usbd_callback_ss_done_defer(xfer); 173402ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 173502ac6454SAndrew Thompson } 173602ac6454SAndrew Thompson 173702ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1738a593f6b8SAndrew Thompson * usbd_transfer_stop - stop an USB transfer 173902ac6454SAndrew Thompson * 174002ac6454SAndrew Thompson * NOTE: Calling this function more than one time will only 174102ac6454SAndrew Thompson * result in a single transfer stop. 174202ac6454SAndrew Thompson * NOTE: When this function returns it is not safe to free nor 1743a593f6b8SAndrew Thompson * reuse any DMA buffers. See "usbd_transfer_drain()". 174402ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 174502ac6454SAndrew Thompson void 1746a593f6b8SAndrew Thompson usbd_transfer_stop(struct usb_xfer *xfer) 174702ac6454SAndrew Thompson { 1748ae60fdfbSAndrew Thompson struct usb_endpoint *ep; 174902ac6454SAndrew Thompson 175002ac6454SAndrew Thompson if (xfer == NULL) { 175102ac6454SAndrew Thompson /* transfer is gone */ 175202ac6454SAndrew Thompson return; 175302ac6454SAndrew Thompson } 175402ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 175502ac6454SAndrew Thompson 175602ac6454SAndrew Thompson /* check if the USB transfer was ever opened */ 175702ac6454SAndrew Thompson 175802ac6454SAndrew Thompson if (!xfer->flags_int.open) { 1759a8725281SAndrew Thompson if (xfer->flags_int.started) { 176002ac6454SAndrew Thompson /* nothing to do except clearing the "started" flag */ 1761a8725281SAndrew Thompson /* lock the BUS lock to avoid races updating flags_int */ 1762a8725281SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 176302ac6454SAndrew Thompson xfer->flags_int.started = 0; 1764a8725281SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 1765a8725281SAndrew Thompson } 176602ac6454SAndrew Thompson return; 176702ac6454SAndrew Thompson } 176802ac6454SAndrew Thompson /* try to stop the current USB transfer */ 176902ac6454SAndrew Thompson 177002ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 1771a8725281SAndrew Thompson /* override any previous error */ 1772a8725281SAndrew Thompson xfer->error = USB_ERR_CANCELLED; 1773a8725281SAndrew Thompson 177402ac6454SAndrew Thompson /* 177502ac6454SAndrew Thompson * Clear "open" and "started" when both private and USB lock 177602ac6454SAndrew Thompson * is locked so that we don't get a race updating "flags_int" 177702ac6454SAndrew Thompson */ 177802ac6454SAndrew Thompson xfer->flags_int.open = 0; 177902ac6454SAndrew Thompson xfer->flags_int.started = 0; 178002ac6454SAndrew Thompson 178102ac6454SAndrew Thompson /* 178202ac6454SAndrew Thompson * Check if we can cancel the USB transfer immediately. 178302ac6454SAndrew Thompson */ 178402ac6454SAndrew Thompson if (xfer->flags_int.transferring) { 178502ac6454SAndrew Thompson if (xfer->flags_int.can_cancel_immed && 178602ac6454SAndrew Thompson (!xfer->flags_int.did_close)) { 178702ac6454SAndrew Thompson DPRINTF("close\n"); 178802ac6454SAndrew Thompson /* 178902ac6454SAndrew Thompson * The following will lead to an USB_ERR_CANCELLED 179002ac6454SAndrew Thompson * error code being passed to the USB callback. 179102ac6454SAndrew Thompson */ 1792ae60fdfbSAndrew Thompson (xfer->endpoint->methods->close) (xfer); 179302ac6454SAndrew Thompson /* only close once */ 179402ac6454SAndrew Thompson xfer->flags_int.did_close = 1; 179502ac6454SAndrew Thompson } else { 179602ac6454SAndrew Thompson /* need to wait for the next done callback */ 179702ac6454SAndrew Thompson } 179802ac6454SAndrew Thompson } else { 179902ac6454SAndrew Thompson DPRINTF("close\n"); 180002ac6454SAndrew Thompson 180102ac6454SAndrew Thompson /* close here and now */ 1802ae60fdfbSAndrew Thompson (xfer->endpoint->methods->close) (xfer); 180302ac6454SAndrew Thompson 180402ac6454SAndrew Thompson /* 180502ac6454SAndrew Thompson * Any additional DMA delay is done by 1806a593f6b8SAndrew Thompson * "usbd_transfer_unsetup()". 180702ac6454SAndrew Thompson */ 180802ac6454SAndrew Thompson 180902ac6454SAndrew Thompson /* 181002ac6454SAndrew Thompson * Special case. Check if we need to restart a blocked 1811ae60fdfbSAndrew Thompson * endpoint. 181202ac6454SAndrew Thompson */ 1813ae60fdfbSAndrew Thompson ep = xfer->endpoint; 181402ac6454SAndrew Thompson 181502ac6454SAndrew Thompson /* 181602ac6454SAndrew Thompson * If the current USB transfer is completing we need 181702ac6454SAndrew Thompson * to start the next one: 181802ac6454SAndrew Thompson */ 1819ae60fdfbSAndrew Thompson if (ep->endpoint_q.curr == xfer) { 1820a593f6b8SAndrew Thompson usb_command_wrapper(&ep->endpoint_q, NULL); 182102ac6454SAndrew Thompson } 182202ac6454SAndrew Thompson } 182302ac6454SAndrew Thompson 182402ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 182502ac6454SAndrew Thompson } 182602ac6454SAndrew Thompson 182702ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1828a593f6b8SAndrew Thompson * usbd_transfer_pending 182902ac6454SAndrew Thompson * 183002ac6454SAndrew Thompson * This function will check if an USB transfer is pending which is a 183102ac6454SAndrew Thompson * little bit complicated! 183202ac6454SAndrew Thompson * Return values: 183302ac6454SAndrew Thompson * 0: Not pending 183402ac6454SAndrew Thompson * 1: Pending: The USB transfer will receive a callback in the future. 183502ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 183602ac6454SAndrew Thompson uint8_t 1837a593f6b8SAndrew Thompson usbd_transfer_pending(struct usb_xfer *xfer) 183802ac6454SAndrew Thompson { 1839760bc48eSAndrew Thompson struct usb_xfer_root *info; 1840760bc48eSAndrew Thompson struct usb_xfer_queue *pq; 184102ac6454SAndrew Thompson 184202ac6454SAndrew Thompson if (xfer == NULL) { 184302ac6454SAndrew Thompson /* transfer is gone */ 184402ac6454SAndrew Thompson return (0); 184502ac6454SAndrew Thompson } 184602ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 184702ac6454SAndrew Thompson 184802ac6454SAndrew Thompson if (xfer->flags_int.transferring) { 184902ac6454SAndrew Thompson /* trivial case */ 185002ac6454SAndrew Thompson return (1); 185102ac6454SAndrew Thompson } 185202ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 185302ac6454SAndrew Thompson if (xfer->wait_queue) { 185402ac6454SAndrew Thompson /* we are waiting on a queue somewhere */ 185502ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 185602ac6454SAndrew Thompson return (1); 185702ac6454SAndrew Thompson } 185802ac6454SAndrew Thompson info = xfer->xroot; 185902ac6454SAndrew Thompson pq = &info->done_q; 186002ac6454SAndrew Thompson 186102ac6454SAndrew Thompson if (pq->curr == xfer) { 186202ac6454SAndrew Thompson /* we are currently scheduled for callback */ 186302ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 186402ac6454SAndrew Thompson return (1); 186502ac6454SAndrew Thompson } 186602ac6454SAndrew Thompson /* we are not pending */ 186702ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 186802ac6454SAndrew Thompson return (0); 186902ac6454SAndrew Thompson } 187002ac6454SAndrew Thompson 187102ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1872a593f6b8SAndrew Thompson * usbd_transfer_drain 187302ac6454SAndrew Thompson * 187402ac6454SAndrew Thompson * This function will stop the USB transfer and wait for any 187502ac6454SAndrew Thompson * additional BUS-DMA and HW-DMA operations to complete. Buffers that 187602ac6454SAndrew Thompson * are loaded into DMA can safely be freed or reused after that this 187702ac6454SAndrew Thompson * function has returned. 187802ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 187902ac6454SAndrew Thompson void 1880a593f6b8SAndrew Thompson usbd_transfer_drain(struct usb_xfer *xfer) 188102ac6454SAndrew Thompson { 188202ac6454SAndrew Thompson WITNESS_WARN(WARN_GIANTOK | WARN_SLEEPOK, NULL, 1883a593f6b8SAndrew Thompson "usbd_transfer_drain can sleep!"); 188402ac6454SAndrew Thompson 188502ac6454SAndrew Thompson if (xfer == NULL) { 188602ac6454SAndrew Thompson /* transfer is gone */ 188702ac6454SAndrew Thompson return; 188802ac6454SAndrew Thompson } 188902ac6454SAndrew Thompson if (xfer->xroot->xfer_mtx != &Giant) { 189002ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_NOTOWNED); 189102ac6454SAndrew Thompson } 189202ac6454SAndrew Thompson USB_XFER_LOCK(xfer); 189302ac6454SAndrew Thompson 1894a593f6b8SAndrew Thompson usbd_transfer_stop(xfer); 189502ac6454SAndrew Thompson 1896bb9c7a8bSAndrew Thompson while (usbd_transfer_pending(xfer) || 1897bb9c7a8bSAndrew Thompson xfer->flags_int.doing_callback) { 1898bb9c7a8bSAndrew Thompson 1899bb9c7a8bSAndrew Thompson /* 1900bb9c7a8bSAndrew Thompson * It is allowed that the callback can drop its 1901bb9c7a8bSAndrew Thompson * transfer mutex. In that case checking only 1902bb9c7a8bSAndrew Thompson * "usbd_transfer_pending()" is not enough to tell if 1903bb9c7a8bSAndrew Thompson * the USB transfer is fully drained. We also need to 1904bb9c7a8bSAndrew Thompson * check the internal "doing_callback" flag. 1905bb9c7a8bSAndrew Thompson */ 190602ac6454SAndrew Thompson xfer->flags_int.draining = 1; 1907bb9c7a8bSAndrew Thompson 190802ac6454SAndrew Thompson /* 190902ac6454SAndrew Thompson * Wait until the current outstanding USB 191002ac6454SAndrew Thompson * transfer is complete ! 191102ac6454SAndrew Thompson */ 19128437751dSAndrew Thompson cv_wait(&xfer->xroot->cv_drain, xfer->xroot->xfer_mtx); 191302ac6454SAndrew Thompson } 191402ac6454SAndrew Thompson USB_XFER_UNLOCK(xfer); 191502ac6454SAndrew Thompson } 191602ac6454SAndrew Thompson 1917ed6d949aSAndrew Thompson struct usb_page_cache * 1918ed6d949aSAndrew Thompson usbd_xfer_get_frame(struct usb_xfer *xfer, usb_frcount_t frindex) 1919ed6d949aSAndrew Thompson { 1920ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 1921ed6d949aSAndrew Thompson 1922ed6d949aSAndrew Thompson return (&xfer->frbuffers[frindex]); 1923ed6d949aSAndrew Thompson } 1924ed6d949aSAndrew Thompson 1925883bb300SAndrew Thompson /*------------------------------------------------------------------------* 1926883bb300SAndrew Thompson * usbd_xfer_get_fps_shift 1927883bb300SAndrew Thompson * 1928883bb300SAndrew Thompson * The following function is only useful for isochronous transfers. It 1929883bb300SAndrew Thompson * returns how many times the frame execution rate has been shifted 1930883bb300SAndrew Thompson * down. 1931883bb300SAndrew Thompson * 1932883bb300SAndrew Thompson * Return value: 1933883bb300SAndrew Thompson * Success: 0..3 1934883bb300SAndrew Thompson * Failure: 0 1935883bb300SAndrew Thompson *------------------------------------------------------------------------*/ 1936883bb300SAndrew Thompson uint8_t 1937883bb300SAndrew Thompson usbd_xfer_get_fps_shift(struct usb_xfer *xfer) 1938883bb300SAndrew Thompson { 1939883bb300SAndrew Thompson return (xfer->fps_shift); 1940883bb300SAndrew Thompson } 1941883bb300SAndrew Thompson 1942ed6d949aSAndrew Thompson usb_frlength_t 19438f9e0ef9SAndrew Thompson usbd_xfer_frame_len(struct usb_xfer *xfer, usb_frcount_t frindex) 1944ed6d949aSAndrew Thompson { 1945ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 1946ed6d949aSAndrew Thompson 1947ed6d949aSAndrew Thompson return (xfer->frlengths[frindex]); 1948ed6d949aSAndrew Thompson } 1949ed6d949aSAndrew Thompson 195002ac6454SAndrew Thompson /*------------------------------------------------------------------------* 1951ed6d949aSAndrew Thompson * usbd_xfer_set_frame_data 195202ac6454SAndrew Thompson * 195302ac6454SAndrew Thompson * This function sets the pointer of the buffer that should 195402ac6454SAndrew Thompson * loaded directly into DMA for the given USB frame. Passing "ptr" 195502ac6454SAndrew Thompson * equal to NULL while the corresponding "frlength" is greater 195602ac6454SAndrew Thompson * than zero gives undefined results! 195702ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 195802ac6454SAndrew Thompson void 1959ed6d949aSAndrew Thompson usbd_xfer_set_frame_data(struct usb_xfer *xfer, usb_frcount_t frindex, 1960ed6d949aSAndrew Thompson void *ptr, usb_frlength_t len) 196102ac6454SAndrew Thompson { 1962ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 1963ed6d949aSAndrew Thompson 196402ac6454SAndrew Thompson /* set virtual address to load and length */ 196502ac6454SAndrew Thompson xfer->frbuffers[frindex].buffer = ptr; 1966ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, frindex, len); 1967ed6d949aSAndrew Thompson } 1968ed6d949aSAndrew Thompson 1969ed6d949aSAndrew Thompson void 19708f9e0ef9SAndrew Thompson usbd_xfer_frame_data(struct usb_xfer *xfer, usb_frcount_t frindex, 1971ed6d949aSAndrew Thompson void **ptr, int *len) 1972ed6d949aSAndrew Thompson { 1973ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 1974ed6d949aSAndrew Thompson 1975ed6d949aSAndrew Thompson if (ptr != NULL) 1976ed6d949aSAndrew Thompson *ptr = xfer->frbuffers[frindex].buffer; 1977ed6d949aSAndrew Thompson if (len != NULL) 1978ed6d949aSAndrew Thompson *len = xfer->frlengths[frindex]; 1979ed6d949aSAndrew Thompson } 1980ed6d949aSAndrew Thompson 198131a11691SHans Petter Selasky /*------------------------------------------------------------------------* 198231a11691SHans Petter Selasky * usbd_xfer_old_frame_length 198331a11691SHans Petter Selasky * 198431a11691SHans Petter Selasky * This function returns the framelength of the given frame at the 198531a11691SHans Petter Selasky * time the transfer was submitted. This function can be used to 198631a11691SHans Petter Selasky * compute the starting data pointer of the next isochronous frame 198731a11691SHans Petter Selasky * when an isochronous transfer has completed. 198831a11691SHans Petter Selasky *------------------------------------------------------------------------*/ 198931a11691SHans Petter Selasky usb_frlength_t 199031a11691SHans Petter Selasky usbd_xfer_old_frame_length(struct usb_xfer *xfer, usb_frcount_t frindex) 199131a11691SHans Petter Selasky { 199231a11691SHans Petter Selasky KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 199331a11691SHans Petter Selasky 199431a11691SHans Petter Selasky return (xfer->frlengths[frindex + xfer->max_frame_count]); 199531a11691SHans Petter Selasky } 199631a11691SHans Petter Selasky 1997ed6d949aSAndrew Thompson void 1998ed6d949aSAndrew Thompson usbd_xfer_status(struct usb_xfer *xfer, int *actlen, int *sumlen, int *aframes, 1999ed6d949aSAndrew Thompson int *nframes) 2000ed6d949aSAndrew Thompson { 2001ed6d949aSAndrew Thompson if (actlen != NULL) 2002ed6d949aSAndrew Thompson *actlen = xfer->actlen; 2003ed6d949aSAndrew Thompson if (sumlen != NULL) 2004ed6d949aSAndrew Thompson *sumlen = xfer->sumlen; 2005ed6d949aSAndrew Thompson if (aframes != NULL) 2006ed6d949aSAndrew Thompson *aframes = xfer->aframes; 2007ed6d949aSAndrew Thompson if (nframes != NULL) 2008ed6d949aSAndrew Thompson *nframes = xfer->nframes; 200902ac6454SAndrew Thompson } 201002ac6454SAndrew Thompson 201102ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2012ed6d949aSAndrew Thompson * usbd_xfer_set_frame_offset 201302ac6454SAndrew Thompson * 201402ac6454SAndrew Thompson * This function sets the frame data buffer offset relative to the beginning 201502ac6454SAndrew Thompson * of the USB DMA buffer allocated for this USB transfer. 201602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 201702ac6454SAndrew Thompson void 2018ed6d949aSAndrew Thompson usbd_xfer_set_frame_offset(struct usb_xfer *xfer, usb_frlength_t offset, 2019e0a69b51SAndrew Thompson usb_frcount_t frindex) 202002ac6454SAndrew Thompson { 2021ed6d949aSAndrew Thompson KASSERT(!xfer->flags.ext_buffer, ("Cannot offset data frame " 2022767cb2e2SAndrew Thompson "when the USB buffer is external\n")); 2023ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 202402ac6454SAndrew Thompson 202502ac6454SAndrew Thompson /* set virtual address to load */ 202602ac6454SAndrew Thompson xfer->frbuffers[frindex].buffer = 202702ac6454SAndrew Thompson USB_ADD_BYTES(xfer->local_buffer, offset); 202802ac6454SAndrew Thompson } 202902ac6454SAndrew Thompson 2030ed6d949aSAndrew Thompson void 2031ed6d949aSAndrew Thompson usbd_xfer_set_interval(struct usb_xfer *xfer, int i) 2032ed6d949aSAndrew Thompson { 2033ed6d949aSAndrew Thompson xfer->interval = i; 2034ed6d949aSAndrew Thompson } 2035ed6d949aSAndrew Thompson 2036ed6d949aSAndrew Thompson void 2037ed6d949aSAndrew Thompson usbd_xfer_set_timeout(struct usb_xfer *xfer, int t) 2038ed6d949aSAndrew Thompson { 2039ed6d949aSAndrew Thompson xfer->timeout = t; 2040ed6d949aSAndrew Thompson } 2041ed6d949aSAndrew Thompson 2042ed6d949aSAndrew Thompson void 2043ed6d949aSAndrew Thompson usbd_xfer_set_frames(struct usb_xfer *xfer, usb_frcount_t n) 2044ed6d949aSAndrew Thompson { 2045ed6d949aSAndrew Thompson xfer->nframes = n; 2046ed6d949aSAndrew Thompson } 2047ed6d949aSAndrew Thompson 2048ed6d949aSAndrew Thompson usb_frcount_t 2049ed6d949aSAndrew Thompson usbd_xfer_max_frames(struct usb_xfer *xfer) 2050ed6d949aSAndrew Thompson { 2051ed6d949aSAndrew Thompson return (xfer->max_frame_count); 2052ed6d949aSAndrew Thompson } 2053ed6d949aSAndrew Thompson 2054ed6d949aSAndrew Thompson usb_frlength_t 2055ed6d949aSAndrew Thompson usbd_xfer_max_len(struct usb_xfer *xfer) 2056ed6d949aSAndrew Thompson { 2057ed6d949aSAndrew Thompson return (xfer->max_data_length); 2058ed6d949aSAndrew Thompson } 2059ed6d949aSAndrew Thompson 2060ed6d949aSAndrew Thompson usb_frlength_t 2061ed6d949aSAndrew Thompson usbd_xfer_max_framelen(struct usb_xfer *xfer) 2062ed6d949aSAndrew Thompson { 2063ed6d949aSAndrew Thompson return (xfer->max_frame_size); 2064ed6d949aSAndrew Thompson } 2065ed6d949aSAndrew Thompson 2066ed6d949aSAndrew Thompson void 2067ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(struct usb_xfer *xfer, usb_frcount_t frindex, 2068ed6d949aSAndrew Thompson usb_frlength_t len) 2069ed6d949aSAndrew Thompson { 2070ed6d949aSAndrew Thompson KASSERT(frindex < xfer->max_frame_count, ("frame index overflow")); 2071ed6d949aSAndrew Thompson 2072ed6d949aSAndrew Thompson xfer->frlengths[frindex] = len; 2073ed6d949aSAndrew Thompson } 2074ed6d949aSAndrew Thompson 207502ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2076a593f6b8SAndrew Thompson * usb_callback_proc - factored out code 207702ac6454SAndrew Thompson * 207802ac6454SAndrew Thompson * This function performs USB callbacks. 207902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 208002ac6454SAndrew Thompson static void 2081a593f6b8SAndrew Thompson usb_callback_proc(struct usb_proc_msg *_pm) 208202ac6454SAndrew Thompson { 2083760bc48eSAndrew Thompson struct usb_done_msg *pm = (void *)_pm; 2084760bc48eSAndrew Thompson struct usb_xfer_root *info = pm->xroot; 208502ac6454SAndrew Thompson 208602ac6454SAndrew Thompson /* Change locking order */ 208702ac6454SAndrew Thompson USB_BUS_UNLOCK(info->bus); 208802ac6454SAndrew Thompson 208902ac6454SAndrew Thompson /* 209002ac6454SAndrew Thompson * We exploit the fact that the mutex is the same for all 209102ac6454SAndrew Thompson * callbacks that will be called from this thread: 209202ac6454SAndrew Thompson */ 209302ac6454SAndrew Thompson mtx_lock(info->xfer_mtx); 209402ac6454SAndrew Thompson USB_BUS_LOCK(info->bus); 209502ac6454SAndrew Thompson 209602ac6454SAndrew Thompson /* Continue where we lost track */ 2097a593f6b8SAndrew Thompson usb_command_wrapper(&info->done_q, 209802ac6454SAndrew Thompson info->done_q.curr); 209902ac6454SAndrew Thompson 210002ac6454SAndrew Thompson mtx_unlock(info->xfer_mtx); 210102ac6454SAndrew Thompson } 210202ac6454SAndrew Thompson 210302ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2104a593f6b8SAndrew Thompson * usbd_callback_ss_done_defer 210502ac6454SAndrew Thompson * 210602ac6454SAndrew Thompson * This function will defer the start, stop and done callback to the 210702ac6454SAndrew Thompson * correct thread. 210802ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 210902ac6454SAndrew Thompson static void 2110a593f6b8SAndrew Thompson usbd_callback_ss_done_defer(struct usb_xfer *xfer) 211102ac6454SAndrew Thompson { 2112760bc48eSAndrew Thompson struct usb_xfer_root *info = xfer->xroot; 2113760bc48eSAndrew Thompson struct usb_xfer_queue *pq = &info->done_q; 211402ac6454SAndrew Thompson 211502ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 211602ac6454SAndrew Thompson 211702ac6454SAndrew Thompson if (pq->curr != xfer) { 2118a593f6b8SAndrew Thompson usbd_transfer_enqueue(pq, xfer); 211902ac6454SAndrew Thompson } 212002ac6454SAndrew Thompson if (!pq->recurse_1) { 212102ac6454SAndrew Thompson 212202ac6454SAndrew Thompson /* 212302ac6454SAndrew Thompson * We have to postpone the callback due to the fact we 212402ac6454SAndrew Thompson * will have a Lock Order Reversal, LOR, if we try to 212502ac6454SAndrew Thompson * proceed ! 212602ac6454SAndrew Thompson */ 2127a593f6b8SAndrew Thompson if (usb_proc_msignal(info->done_p, 212802ac6454SAndrew Thompson &info->done_m[0], &info->done_m[1])) { 212902ac6454SAndrew Thompson /* ignore */ 213002ac6454SAndrew Thompson } 213102ac6454SAndrew Thompson } else { 213202ac6454SAndrew Thompson /* clear second recurse flag */ 213302ac6454SAndrew Thompson pq->recurse_2 = 0; 213402ac6454SAndrew Thompson } 213502ac6454SAndrew Thompson return; 213602ac6454SAndrew Thompson 213702ac6454SAndrew Thompson } 213802ac6454SAndrew Thompson 213902ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2140a593f6b8SAndrew Thompson * usbd_callback_wrapper 214102ac6454SAndrew Thompson * 214202ac6454SAndrew Thompson * This is a wrapper for USB callbacks. This wrapper does some 214302ac6454SAndrew Thompson * auto-magic things like figuring out if we can call the callback 214402ac6454SAndrew Thompson * directly from the current context or if we need to wakeup the 214502ac6454SAndrew Thompson * interrupt process. 214602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 214702ac6454SAndrew Thompson static void 2148a593f6b8SAndrew Thompson usbd_callback_wrapper(struct usb_xfer_queue *pq) 214902ac6454SAndrew Thompson { 2150760bc48eSAndrew Thompson struct usb_xfer *xfer = pq->curr; 2151760bc48eSAndrew Thompson struct usb_xfer_root *info = xfer->xroot; 215202ac6454SAndrew Thompson 21534565300dSAndrew Thompson USB_BUS_LOCK_ASSERT(info->bus, MA_OWNED); 21546703915eSAndriy Gapon if (!mtx_owned(info->xfer_mtx) && !SCHEDULER_STOPPED()) { 215502ac6454SAndrew Thompson /* 215602ac6454SAndrew Thompson * Cases that end up here: 215702ac6454SAndrew Thompson * 215802ac6454SAndrew Thompson * 5) HW interrupt done callback or other source. 215902ac6454SAndrew Thompson */ 216002ac6454SAndrew Thompson DPRINTFN(3, "case 5\n"); 216102ac6454SAndrew Thompson 216202ac6454SAndrew Thompson /* 216302ac6454SAndrew Thompson * We have to postpone the callback due to the fact we 216402ac6454SAndrew Thompson * will have a Lock Order Reversal, LOR, if we try to 216502ac6454SAndrew Thompson * proceed ! 216602ac6454SAndrew Thompson */ 2167a593f6b8SAndrew Thompson if (usb_proc_msignal(info->done_p, 216802ac6454SAndrew Thompson &info->done_m[0], &info->done_m[1])) { 216902ac6454SAndrew Thompson /* ignore */ 217002ac6454SAndrew Thompson } 217102ac6454SAndrew Thompson return; 217202ac6454SAndrew Thompson } 217302ac6454SAndrew Thompson /* 217402ac6454SAndrew Thompson * Cases that end up here: 217502ac6454SAndrew Thompson * 217602ac6454SAndrew Thompson * 1) We are starting a transfer 217702ac6454SAndrew Thompson * 2) We are prematurely calling back a transfer 217802ac6454SAndrew Thompson * 3) We are stopping a transfer 217902ac6454SAndrew Thompson * 4) We are doing an ordinary callback 218002ac6454SAndrew Thompson */ 218102ac6454SAndrew Thompson DPRINTFN(3, "case 1-4\n"); 218202ac6454SAndrew Thompson /* get next USB transfer in the queue */ 218302ac6454SAndrew Thompson info->done_q.curr = NULL; 218402ac6454SAndrew Thompson 2185bb9c7a8bSAndrew Thompson /* set flag in case of drain */ 2186bb9c7a8bSAndrew Thompson xfer->flags_int.doing_callback = 1; 2187bb9c7a8bSAndrew Thompson 21884565300dSAndrew Thompson USB_BUS_UNLOCK(info->bus); 21894565300dSAndrew Thompson USB_BUS_LOCK_ASSERT(info->bus, MA_NOTOWNED); 219002ac6454SAndrew Thompson 219102ac6454SAndrew Thompson /* set correct USB state for callback */ 219202ac6454SAndrew Thompson if (!xfer->flags_int.transferring) { 2193a593f6b8SAndrew Thompson xfer->usb_state = USB_ST_SETUP; 219402ac6454SAndrew Thompson if (!xfer->flags_int.started) { 219502ac6454SAndrew Thompson /* we got stopped before we even got started */ 21964565300dSAndrew Thompson USB_BUS_LOCK(info->bus); 219702ac6454SAndrew Thompson goto done; 219802ac6454SAndrew Thompson } 219902ac6454SAndrew Thompson } else { 220002ac6454SAndrew Thompson 2201a593f6b8SAndrew Thompson if (usbd_callback_wrapper_sub(xfer)) { 220202ac6454SAndrew Thompson /* the callback has been deferred */ 22034565300dSAndrew Thompson USB_BUS_LOCK(info->bus); 220402ac6454SAndrew Thompson goto done; 220502ac6454SAndrew Thompson } 22064eae601eSAndrew Thompson #if USB_HAVE_POWERD 220702ac6454SAndrew Thompson /* decrement power reference */ 2208a593f6b8SAndrew Thompson usbd_transfer_power_ref(xfer, -1); 22094eae601eSAndrew Thompson #endif 221002ac6454SAndrew Thompson xfer->flags_int.transferring = 0; 221102ac6454SAndrew Thompson 221202ac6454SAndrew Thompson if (xfer->error) { 2213a593f6b8SAndrew Thompson xfer->usb_state = USB_ST_ERROR; 221402ac6454SAndrew Thompson } else { 221502ac6454SAndrew Thompson /* set transferred state */ 2216a593f6b8SAndrew Thompson xfer->usb_state = USB_ST_TRANSFERRED; 2217bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 221802ac6454SAndrew Thompson /* sync DMA memory, if any */ 221902ac6454SAndrew Thompson if (xfer->flags_int.bdma_enable && 222002ac6454SAndrew Thompson (!xfer->flags_int.bdma_no_post_sync)) { 2221a593f6b8SAndrew Thompson usb_bdma_post_sync(xfer); 222202ac6454SAndrew Thompson } 2223bdc081c6SAndrew Thompson #endif 222402ac6454SAndrew Thompson } 222502ac6454SAndrew Thompson } 222602ac6454SAndrew Thompson 22278be09334SHans Petter Selasky #if USB_HAVE_PF 222818ec6525SWeongyo Jeong if (xfer->usb_state != USB_ST_SETUP) 222918ec6525SWeongyo Jeong usbpf_xfertap(xfer, USBPF_XFERTAP_DONE); 22308be09334SHans Petter Selasky #endif 223102ac6454SAndrew Thompson /* call processing routine */ 2232ed6d949aSAndrew Thompson (xfer->callback) (xfer, xfer->error); 223302ac6454SAndrew Thompson 223402ac6454SAndrew Thompson /* pickup the USB mutex again */ 22354565300dSAndrew Thompson USB_BUS_LOCK(info->bus); 223602ac6454SAndrew Thompson 223702ac6454SAndrew Thompson /* 223802ac6454SAndrew Thompson * Check if we got started after that we got cancelled, but 223902ac6454SAndrew Thompson * before we managed to do the callback. 224002ac6454SAndrew Thompson */ 224102ac6454SAndrew Thompson if ((!xfer->flags_int.open) && 224202ac6454SAndrew Thompson (xfer->flags_int.started) && 2243a593f6b8SAndrew Thompson (xfer->usb_state == USB_ST_ERROR)) { 2244bb9c7a8bSAndrew Thompson /* clear flag in case of drain */ 2245bb9c7a8bSAndrew Thompson xfer->flags_int.doing_callback = 0; 224602ac6454SAndrew Thompson /* try to loop, but not recursivly */ 2247a593f6b8SAndrew Thompson usb_command_wrapper(&info->done_q, xfer); 224802ac6454SAndrew Thompson return; 224902ac6454SAndrew Thompson } 225002ac6454SAndrew Thompson 225102ac6454SAndrew Thompson done: 2252bb9c7a8bSAndrew Thompson /* clear flag in case of drain */ 2253bb9c7a8bSAndrew Thompson xfer->flags_int.doing_callback = 0; 2254bb9c7a8bSAndrew Thompson 225502ac6454SAndrew Thompson /* 225602ac6454SAndrew Thompson * Check if we are draining. 225702ac6454SAndrew Thompson */ 225802ac6454SAndrew Thompson if (xfer->flags_int.draining && 225902ac6454SAndrew Thompson (!xfer->flags_int.transferring)) { 2260a593f6b8SAndrew Thompson /* "usbd_transfer_drain()" is waiting for end of transfer */ 226102ac6454SAndrew Thompson xfer->flags_int.draining = 0; 22628437751dSAndrew Thompson cv_broadcast(&info->cv_drain); 226302ac6454SAndrew Thompson } 226402ac6454SAndrew Thompson 226502ac6454SAndrew Thompson /* do the next callback, if any */ 2266a593f6b8SAndrew Thompson usb_command_wrapper(&info->done_q, 226702ac6454SAndrew Thompson info->done_q.curr); 226802ac6454SAndrew Thompson } 226902ac6454SAndrew Thompson 227002ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2271a593f6b8SAndrew Thompson * usb_dma_delay_done_cb 227202ac6454SAndrew Thompson * 227302ac6454SAndrew Thompson * This function is called when the DMA delay has been exectuded, and 227402ac6454SAndrew Thompson * will make sure that the callback is called to complete the USB 227502ac6454SAndrew Thompson * transfer. This code path is ususally only used when there is an USB 227602ac6454SAndrew Thompson * error like USB_ERR_CANCELLED. 227702ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 2278963169b4SHans Petter Selasky void 2279963169b4SHans Petter Selasky usb_dma_delay_done_cb(struct usb_xfer *xfer) 228002ac6454SAndrew Thompson { 228102ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 228202ac6454SAndrew Thompson 228302ac6454SAndrew Thompson DPRINTFN(3, "Completed %p\n", xfer); 228402ac6454SAndrew Thompson 228502ac6454SAndrew Thompson /* queue callback for execution, again */ 2286a593f6b8SAndrew Thompson usbd_transfer_done(xfer, 0); 228702ac6454SAndrew Thompson } 228802ac6454SAndrew Thompson 228902ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2290a593f6b8SAndrew Thompson * usbd_transfer_dequeue 229102ac6454SAndrew Thompson * 229202ac6454SAndrew Thompson * - This function is used to remove an USB transfer from a USB 229302ac6454SAndrew Thompson * transfer queue. 229402ac6454SAndrew Thompson * 229502ac6454SAndrew Thompson * - This function can be called multiple times in a row. 229602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 229702ac6454SAndrew Thompson void 2298a593f6b8SAndrew Thompson usbd_transfer_dequeue(struct usb_xfer *xfer) 229902ac6454SAndrew Thompson { 2300760bc48eSAndrew Thompson struct usb_xfer_queue *pq; 230102ac6454SAndrew Thompson 230202ac6454SAndrew Thompson pq = xfer->wait_queue; 230302ac6454SAndrew Thompson if (pq) { 230402ac6454SAndrew Thompson TAILQ_REMOVE(&pq->head, xfer, wait_entry); 230502ac6454SAndrew Thompson xfer->wait_queue = NULL; 230602ac6454SAndrew Thompson } 230702ac6454SAndrew Thompson } 230802ac6454SAndrew Thompson 230902ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2310a593f6b8SAndrew Thompson * usbd_transfer_enqueue 231102ac6454SAndrew Thompson * 231202ac6454SAndrew Thompson * - This function is used to insert an USB transfer into a USB * 231302ac6454SAndrew Thompson * transfer queue. 231402ac6454SAndrew Thompson * 231502ac6454SAndrew Thompson * - This function can be called multiple times in a row. 231602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 231702ac6454SAndrew Thompson void 2318a593f6b8SAndrew Thompson usbd_transfer_enqueue(struct usb_xfer_queue *pq, struct usb_xfer *xfer) 231902ac6454SAndrew Thompson { 232002ac6454SAndrew Thompson /* 232102ac6454SAndrew Thompson * Insert the USB transfer into the queue, if it is not 232202ac6454SAndrew Thompson * already on a USB transfer queue: 232302ac6454SAndrew Thompson */ 232402ac6454SAndrew Thompson if (xfer->wait_queue == NULL) { 232502ac6454SAndrew Thompson xfer->wait_queue = pq; 232602ac6454SAndrew Thompson TAILQ_INSERT_TAIL(&pq->head, xfer, wait_entry); 232702ac6454SAndrew Thompson } 232802ac6454SAndrew Thompson } 232902ac6454SAndrew Thompson 233002ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2331a593f6b8SAndrew Thompson * usbd_transfer_done 233202ac6454SAndrew Thompson * 233302ac6454SAndrew Thompson * - This function is used to remove an USB transfer from the busdma, 233402ac6454SAndrew Thompson * pipe or interrupt queue. 233502ac6454SAndrew Thompson * 233602ac6454SAndrew Thompson * - This function is used to queue the USB transfer on the done 233702ac6454SAndrew Thompson * queue. 233802ac6454SAndrew Thompson * 233902ac6454SAndrew Thompson * - This function is used to stop any USB transfer timeouts. 234002ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 234102ac6454SAndrew Thompson void 2342a593f6b8SAndrew Thompson usbd_transfer_done(struct usb_xfer *xfer, usb_error_t error) 234302ac6454SAndrew Thompson { 234402ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 234502ac6454SAndrew Thompson 2346a593f6b8SAndrew Thompson DPRINTF("err=%s\n", usbd_errstr(error)); 234702ac6454SAndrew Thompson 234802ac6454SAndrew Thompson /* 234902ac6454SAndrew Thompson * If we are not transferring then just return. 235002ac6454SAndrew Thompson * This can happen during transfer cancel. 235102ac6454SAndrew Thompson */ 235202ac6454SAndrew Thompson if (!xfer->flags_int.transferring) { 235302ac6454SAndrew Thompson DPRINTF("not transferring\n"); 2354a8725281SAndrew Thompson /* end of control transfer, if any */ 2355a8725281SAndrew Thompson xfer->flags_int.control_act = 0; 235602ac6454SAndrew Thompson return; 235702ac6454SAndrew Thompson } 235802ac6454SAndrew Thompson /* only set transfer error if not already set */ 235902ac6454SAndrew Thompson if (!xfer->error) { 236002ac6454SAndrew Thompson xfer->error = error; 236102ac6454SAndrew Thompson } 236202ac6454SAndrew Thompson /* stop any callouts */ 2363a593f6b8SAndrew Thompson usb_callout_stop(&xfer->timeout_handle); 236402ac6454SAndrew Thompson 236502ac6454SAndrew Thompson /* 236602ac6454SAndrew Thompson * If we are waiting on a queue, just remove the USB transfer 236702ac6454SAndrew Thompson * from the queue, if any. We should have the required locks 236802ac6454SAndrew Thompson * locked to do the remove when this function is called. 236902ac6454SAndrew Thompson */ 2370a593f6b8SAndrew Thompson usbd_transfer_dequeue(xfer); 237102ac6454SAndrew Thompson 2372bdc081c6SAndrew Thompson #if USB_HAVE_BUSDMA 237302ac6454SAndrew Thompson if (mtx_owned(xfer->xroot->xfer_mtx)) { 2374760bc48eSAndrew Thompson struct usb_xfer_queue *pq; 2375bdc081c6SAndrew Thompson 237602ac6454SAndrew Thompson /* 237702ac6454SAndrew Thompson * If the private USB lock is not locked, then we assume 237802ac6454SAndrew Thompson * that the BUS-DMA load stage has been passed: 237902ac6454SAndrew Thompson */ 238002ac6454SAndrew Thompson pq = &xfer->xroot->dma_q; 238102ac6454SAndrew Thompson 238202ac6454SAndrew Thompson if (pq->curr == xfer) { 238302ac6454SAndrew Thompson /* start the next BUS-DMA load, if any */ 2384a593f6b8SAndrew Thompson usb_command_wrapper(pq, NULL); 238502ac6454SAndrew Thompson } 238602ac6454SAndrew Thompson } 2387bdc081c6SAndrew Thompson #endif 238802ac6454SAndrew Thompson /* keep some statistics */ 238902ac6454SAndrew Thompson if (xfer->error) { 239002ac6454SAndrew Thompson xfer->xroot->bus->stats_err.uds_requests 2391ae60fdfbSAndrew Thompson [xfer->endpoint->edesc->bmAttributes & UE_XFERTYPE]++; 239202ac6454SAndrew Thompson } else { 239302ac6454SAndrew Thompson xfer->xroot->bus->stats_ok.uds_requests 2394ae60fdfbSAndrew Thompson [xfer->endpoint->edesc->bmAttributes & UE_XFERTYPE]++; 239502ac6454SAndrew Thompson } 239602ac6454SAndrew Thompson 239702ac6454SAndrew Thompson /* call the USB transfer callback */ 2398a593f6b8SAndrew Thompson usbd_callback_ss_done_defer(xfer); 239902ac6454SAndrew Thompson } 240002ac6454SAndrew Thompson 240102ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2402a593f6b8SAndrew Thompson * usbd_transfer_start_cb 240302ac6454SAndrew Thompson * 240402ac6454SAndrew Thompson * This function is called to start the USB transfer when 240502ac6454SAndrew Thompson * "xfer->interval" is greater than zero, and and the endpoint type is 240602ac6454SAndrew Thompson * BULK or CONTROL. 240702ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 240802ac6454SAndrew Thompson static void 2409a593f6b8SAndrew Thompson usbd_transfer_start_cb(void *arg) 241002ac6454SAndrew Thompson { 2411760bc48eSAndrew Thompson struct usb_xfer *xfer = arg; 2412ae60fdfbSAndrew Thompson struct usb_endpoint *ep = xfer->endpoint; 241302ac6454SAndrew Thompson 241402ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 241502ac6454SAndrew Thompson 241602ac6454SAndrew Thompson DPRINTF("start\n"); 241702ac6454SAndrew Thompson 24188be09334SHans Petter Selasky #if USB_HAVE_PF 241918ec6525SWeongyo Jeong usbpf_xfertap(xfer, USBPF_XFERTAP_SUBMIT); 24208be09334SHans Petter Selasky #endif 24213e677ca0SHans Petter Selasky /* start USB transfer, if no error */ 24223e677ca0SHans Petter Selasky if (xfer->error == 0) 2423ae60fdfbSAndrew Thompson (ep->methods->start) (xfer); 242402ac6454SAndrew Thompson 242502ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 1; 24264565300dSAndrew Thompson 24274565300dSAndrew Thompson /* check for error */ 242802ac6454SAndrew Thompson if (xfer->error) { 242902ac6454SAndrew Thompson /* some error has happened */ 2430a593f6b8SAndrew Thompson usbd_transfer_done(xfer, 0); 243102ac6454SAndrew Thompson } 243202ac6454SAndrew Thompson } 243302ac6454SAndrew Thompson 243402ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2435ed6d949aSAndrew Thompson * usbd_xfer_set_stall 243602ac6454SAndrew Thompson * 243702ac6454SAndrew Thompson * This function is used to set the stall flag outside the 243802ac6454SAndrew Thompson * callback. This function is NULL safe. 243902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 244002ac6454SAndrew Thompson void 2441ed6d949aSAndrew Thompson usbd_xfer_set_stall(struct usb_xfer *xfer) 244202ac6454SAndrew Thompson { 244302ac6454SAndrew Thompson if (xfer == NULL) { 244402ac6454SAndrew Thompson /* tearing down */ 244502ac6454SAndrew Thompson return; 244602ac6454SAndrew Thompson } 244702ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 244802ac6454SAndrew Thompson 244902ac6454SAndrew Thompson /* avoid any races by locking the USB mutex */ 245002ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 245102ac6454SAndrew Thompson xfer->flags.stall_pipe = 1; 245202ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 245302ac6454SAndrew Thompson } 245402ac6454SAndrew Thompson 2455ed6d949aSAndrew Thompson int 2456ed6d949aSAndrew Thompson usbd_xfer_is_stalled(struct usb_xfer *xfer) 2457ed6d949aSAndrew Thompson { 2458ed6d949aSAndrew Thompson return (xfer->endpoint->is_stalled); 2459ed6d949aSAndrew Thompson } 2460ed6d949aSAndrew Thompson 246102ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2462a593f6b8SAndrew Thompson * usbd_transfer_clear_stall 246302ac6454SAndrew Thompson * 246402ac6454SAndrew Thompson * This function is used to clear the stall flag outside the 246502ac6454SAndrew Thompson * callback. This function is NULL safe. 246602ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 246702ac6454SAndrew Thompson void 2468a593f6b8SAndrew Thompson usbd_transfer_clear_stall(struct usb_xfer *xfer) 246902ac6454SAndrew Thompson { 247002ac6454SAndrew Thompson if (xfer == NULL) { 247102ac6454SAndrew Thompson /* tearing down */ 247202ac6454SAndrew Thompson return; 247302ac6454SAndrew Thompson } 247402ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer, MA_OWNED); 247502ac6454SAndrew Thompson 247602ac6454SAndrew Thompson /* avoid any races by locking the USB mutex */ 247702ac6454SAndrew Thompson USB_BUS_LOCK(xfer->xroot->bus); 247802ac6454SAndrew Thompson 247902ac6454SAndrew Thompson xfer->flags.stall_pipe = 0; 248002ac6454SAndrew Thompson 248102ac6454SAndrew Thompson USB_BUS_UNLOCK(xfer->xroot->bus); 248202ac6454SAndrew Thompson } 248302ac6454SAndrew Thompson 248402ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2485a593f6b8SAndrew Thompson * usbd_pipe_start 248602ac6454SAndrew Thompson * 248702ac6454SAndrew Thompson * This function is used to add an USB transfer to the pipe transfer list. 248802ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 248902ac6454SAndrew Thompson void 2490a593f6b8SAndrew Thompson usbd_pipe_start(struct usb_xfer_queue *pq) 249102ac6454SAndrew Thompson { 2492ae60fdfbSAndrew Thompson struct usb_endpoint *ep; 2493760bc48eSAndrew Thompson struct usb_xfer *xfer; 249402ac6454SAndrew Thompson uint8_t type; 249502ac6454SAndrew Thompson 249602ac6454SAndrew Thompson xfer = pq->curr; 2497ae60fdfbSAndrew Thompson ep = xfer->endpoint; 249802ac6454SAndrew Thompson 249902ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 250002ac6454SAndrew Thompson 250102ac6454SAndrew Thompson /* 2502ae60fdfbSAndrew Thompson * If the endpoint is already stalled we do nothing ! 250302ac6454SAndrew Thompson */ 2504ae60fdfbSAndrew Thompson if (ep->is_stalled) { 250502ac6454SAndrew Thompson return; 250602ac6454SAndrew Thompson } 250702ac6454SAndrew Thompson /* 2508ae60fdfbSAndrew Thompson * Check if we are supposed to stall the endpoint: 250902ac6454SAndrew Thompson */ 251002ac6454SAndrew Thompson if (xfer->flags.stall_pipe) { 25113f6c7805SAndrew Thompson struct usb_device *udev; 25123f6c7805SAndrew Thompson struct usb_xfer_root *info; 25133f6c7805SAndrew Thompson 251402ac6454SAndrew Thompson /* clear stall command */ 251502ac6454SAndrew Thompson xfer->flags.stall_pipe = 0; 251602ac6454SAndrew Thompson 25173f6c7805SAndrew Thompson /* get pointer to USB device */ 25183f6c7805SAndrew Thompson info = xfer->xroot; 25193f6c7805SAndrew Thompson udev = info->udev; 25203f6c7805SAndrew Thompson 252102ac6454SAndrew Thompson /* 252202ac6454SAndrew Thompson * Only stall BULK and INTERRUPT endpoints. 252302ac6454SAndrew Thompson */ 2524ae60fdfbSAndrew Thompson type = (ep->edesc->bmAttributes & UE_XFERTYPE); 252502ac6454SAndrew Thompson if ((type == UE_BULK) || 252602ac6454SAndrew Thompson (type == UE_INTERRUPT)) { 252729bd7d7eSAndrew Thompson uint8_t did_stall; 252802ac6454SAndrew Thompson 252929bd7d7eSAndrew Thompson did_stall = 1; 253002ac6454SAndrew Thompson 2531f29a0724SAndrew Thompson if (udev->flags.usb_mode == USB_MODE_DEVICE) { 253202ac6454SAndrew Thompson (udev->bus->methods->set_stall) ( 253329bd7d7eSAndrew Thompson udev, NULL, ep, &did_stall); 25345b3bb704SAndrew Thompson } else if (udev->ctrl_xfer[1]) { 25355b3bb704SAndrew Thompson info = udev->ctrl_xfer[1]->xroot; 253629bd7d7eSAndrew Thompson usb_proc_msignal( 253702ac6454SAndrew Thompson &info->bus->non_giant_callback_proc, 253829bd7d7eSAndrew Thompson &udev->cs_msg[0], &udev->cs_msg[1]); 253902ac6454SAndrew Thompson } else { 254002ac6454SAndrew Thompson /* should not happen */ 2541767cb2e2SAndrew Thompson DPRINTFN(0, "No stall handler\n"); 254202ac6454SAndrew Thompson } 254302ac6454SAndrew Thompson /* 254429bd7d7eSAndrew Thompson * Check if we should stall. Some USB hardware 254529bd7d7eSAndrew Thompson * handles set- and clear-stall in hardware. 254602ac6454SAndrew Thompson */ 254729bd7d7eSAndrew Thompson if (did_stall) { 254829bd7d7eSAndrew Thompson /* 254929bd7d7eSAndrew Thompson * The transfer will be continued when 255029bd7d7eSAndrew Thompson * the clear-stall control endpoint 255129bd7d7eSAndrew Thompson * message is received. 255229bd7d7eSAndrew Thompson */ 255329bd7d7eSAndrew Thompson ep->is_stalled = 1; 255402ac6454SAndrew Thompson return; 255502ac6454SAndrew Thompson } 25563f6c7805SAndrew Thompson } else if (type == UE_ISOCHRONOUS) { 25573f6c7805SAndrew Thompson 25583f6c7805SAndrew Thompson /* 25593f6c7805SAndrew Thompson * Make sure any FIFO overflow or other FIFO 25603f6c7805SAndrew Thompson * error conditions go away by resetting the 25613f6c7805SAndrew Thompson * endpoint FIFO through the clear stall 25623f6c7805SAndrew Thompson * method. 25633f6c7805SAndrew Thompson */ 25643f6c7805SAndrew Thompson if (udev->flags.usb_mode == USB_MODE_DEVICE) { 25653f6c7805SAndrew Thompson (udev->bus->methods->clear_stall) (udev, ep); 25663f6c7805SAndrew Thompson } 256702ac6454SAndrew Thompson } 256829bd7d7eSAndrew Thompson } 256902ac6454SAndrew Thompson /* Set or clear stall complete - special case */ 257002ac6454SAndrew Thompson if (xfer->nframes == 0) { 257102ac6454SAndrew Thompson /* we are complete */ 257202ac6454SAndrew Thompson xfer->aframes = 0; 2573a593f6b8SAndrew Thompson usbd_transfer_done(xfer, 0); 257402ac6454SAndrew Thompson return; 257502ac6454SAndrew Thompson } 257602ac6454SAndrew Thompson /* 257702ac6454SAndrew Thompson * Handled cases: 257802ac6454SAndrew Thompson * 257902ac6454SAndrew Thompson * 1) Start the first transfer queued. 258002ac6454SAndrew Thompson * 258102ac6454SAndrew Thompson * 2) Re-start the current USB transfer. 258202ac6454SAndrew Thompson */ 258302ac6454SAndrew Thompson /* 258402ac6454SAndrew Thompson * Check if there should be any 258502ac6454SAndrew Thompson * pre transfer start delay: 258602ac6454SAndrew Thompson */ 258702ac6454SAndrew Thompson if (xfer->interval > 0) { 2588ae60fdfbSAndrew Thompson type = (ep->edesc->bmAttributes & UE_XFERTYPE); 258902ac6454SAndrew Thompson if ((type == UE_BULK) || 259002ac6454SAndrew Thompson (type == UE_CONTROL)) { 2591a593f6b8SAndrew Thompson usbd_transfer_timeout_ms(xfer, 2592a593f6b8SAndrew Thompson &usbd_transfer_start_cb, 259302ac6454SAndrew Thompson xfer->interval); 259402ac6454SAndrew Thompson return; 259502ac6454SAndrew Thompson } 259602ac6454SAndrew Thompson } 259702ac6454SAndrew Thompson DPRINTF("start\n"); 259802ac6454SAndrew Thompson 25998be09334SHans Petter Selasky #if USB_HAVE_PF 260018ec6525SWeongyo Jeong usbpf_xfertap(xfer, USBPF_XFERTAP_SUBMIT); 26018be09334SHans Petter Selasky #endif 26023e677ca0SHans Petter Selasky /* start USB transfer, if no error */ 26033e677ca0SHans Petter Selasky if (xfer->error == 0) 2604ae60fdfbSAndrew Thompson (ep->methods->start) (xfer); 260502ac6454SAndrew Thompson 260602ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 1; 26074565300dSAndrew Thompson 26084565300dSAndrew Thompson /* check for error */ 260902ac6454SAndrew Thompson if (xfer->error) { 261002ac6454SAndrew Thompson /* some error has happened */ 2611a593f6b8SAndrew Thompson usbd_transfer_done(xfer, 0); 261202ac6454SAndrew Thompson } 261302ac6454SAndrew Thompson } 261402ac6454SAndrew Thompson 261502ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2616a593f6b8SAndrew Thompson * usbd_transfer_timeout_ms 261702ac6454SAndrew Thompson * 261802ac6454SAndrew Thompson * This function is used to setup a timeout on the given USB 261902ac6454SAndrew Thompson * transfer. If the timeout has been deferred the callback given by 262002ac6454SAndrew Thompson * "cb" will get called after "ms" milliseconds. 262102ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 262202ac6454SAndrew Thompson void 2623a593f6b8SAndrew Thompson usbd_transfer_timeout_ms(struct usb_xfer *xfer, 2624e0a69b51SAndrew Thompson void (*cb) (void *arg), usb_timeout_t ms) 262502ac6454SAndrew Thompson { 262602ac6454SAndrew Thompson USB_BUS_LOCK_ASSERT(xfer->xroot->bus, MA_OWNED); 262702ac6454SAndrew Thompson 262802ac6454SAndrew Thompson /* defer delay */ 2629a593f6b8SAndrew Thompson usb_callout_reset(&xfer->timeout_handle, 263002ac6454SAndrew Thompson USB_MS_TO_TICKS(ms), cb, xfer); 263102ac6454SAndrew Thompson } 263202ac6454SAndrew Thompson 263302ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2634a593f6b8SAndrew Thompson * usbd_callback_wrapper_sub 263502ac6454SAndrew Thompson * 263602ac6454SAndrew Thompson * - This function will update variables in an USB transfer after 263702ac6454SAndrew Thompson * that the USB transfer is complete. 263802ac6454SAndrew Thompson * 263902ac6454SAndrew Thompson * - This function is used to start the next USB transfer on the 2640ae60fdfbSAndrew Thompson * ep transfer queue, if any. 264102ac6454SAndrew Thompson * 264202ac6454SAndrew Thompson * NOTE: In some special cases the USB transfer will not be removed from 264302ac6454SAndrew Thompson * the pipe queue, but remain first. To enforce USB transfer removal call 264402ac6454SAndrew Thompson * this function passing the error code "USB_ERR_CANCELLED". 264502ac6454SAndrew Thompson * 264602ac6454SAndrew Thompson * Return values: 264702ac6454SAndrew Thompson * 0: Success. 264802ac6454SAndrew Thompson * Else: The callback has been deferred. 264902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 265002ac6454SAndrew Thompson static uint8_t 2651a593f6b8SAndrew Thompson usbd_callback_wrapper_sub(struct usb_xfer *xfer) 265202ac6454SAndrew Thompson { 2653ae60fdfbSAndrew Thompson struct usb_endpoint *ep; 2654963169b4SHans Petter Selasky struct usb_bus *bus; 2655e0a69b51SAndrew Thompson usb_frcount_t x; 265602ac6454SAndrew Thompson 2657963169b4SHans Petter Selasky bus = xfer->xroot->bus; 2658963169b4SHans Petter Selasky 265902ac6454SAndrew Thompson if ((!xfer->flags_int.open) && 266002ac6454SAndrew Thompson (!xfer->flags_int.did_close)) { 266102ac6454SAndrew Thompson DPRINTF("close\n"); 2662963169b4SHans Petter Selasky USB_BUS_LOCK(bus); 2663ae60fdfbSAndrew Thompson (xfer->endpoint->methods->close) (xfer); 2664963169b4SHans Petter Selasky USB_BUS_UNLOCK(bus); 266502ac6454SAndrew Thompson /* only close once */ 266602ac6454SAndrew Thompson xfer->flags_int.did_close = 1; 266702ac6454SAndrew Thompson return (1); /* wait for new callback */ 266802ac6454SAndrew Thompson } 266902ac6454SAndrew Thompson /* 267002ac6454SAndrew Thompson * If we have a non-hardware induced error we 267102ac6454SAndrew Thompson * need to do the DMA delay! 267202ac6454SAndrew Thompson */ 2673963169b4SHans Petter Selasky if (xfer->error != 0 && !xfer->flags_int.did_dma_delay && 2674963169b4SHans Petter Selasky (xfer->error == USB_ERR_CANCELLED || 2675963169b4SHans Petter Selasky xfer->error == USB_ERR_TIMEOUT || 2676963169b4SHans Petter Selasky bus->methods->start_dma_delay != NULL)) { 267702ac6454SAndrew Thompson 2678e0a69b51SAndrew Thompson usb_timeout_t temp; 267902ac6454SAndrew Thompson 2680a8725281SAndrew Thompson /* only delay once */ 2681a8725281SAndrew Thompson xfer->flags_int.did_dma_delay = 1; 2682a8725281SAndrew Thompson 268302ac6454SAndrew Thompson /* we can not cancel this delay */ 268402ac6454SAndrew Thompson xfer->flags_int.can_cancel_immed = 0; 268502ac6454SAndrew Thompson 2686527aa7b2SAndrew Thompson temp = usbd_get_dma_delay(xfer->xroot->udev); 268702ac6454SAndrew Thompson 268802ac6454SAndrew Thompson DPRINTFN(3, "DMA delay, %u ms, " 268902ac6454SAndrew Thompson "on %p\n", temp, xfer); 269002ac6454SAndrew Thompson 269102ac6454SAndrew Thompson if (temp != 0) { 2692963169b4SHans Petter Selasky USB_BUS_LOCK(bus); 2693963169b4SHans Petter Selasky /* 2694963169b4SHans Petter Selasky * Some hardware solutions have dedicated 2695963169b4SHans Petter Selasky * events when it is safe to free DMA'ed 2696963169b4SHans Petter Selasky * memory. For the other hardware platforms we 2697963169b4SHans Petter Selasky * use a static delay. 2698963169b4SHans Petter Selasky */ 2699963169b4SHans Petter Selasky if (bus->methods->start_dma_delay != NULL) { 2700963169b4SHans Petter Selasky (bus->methods->start_dma_delay) (xfer); 2701963169b4SHans Petter Selasky } else { 2702a593f6b8SAndrew Thompson usbd_transfer_timeout_ms(xfer, 2703*6d917491SHans Petter Selasky (void (*)(void *))&usb_dma_delay_done_cb, 2704*6d917491SHans Petter Selasky temp); 2705963169b4SHans Petter Selasky } 2706963169b4SHans Petter Selasky USB_BUS_UNLOCK(bus); 270702ac6454SAndrew Thompson return (1); /* wait for new callback */ 270802ac6454SAndrew Thompson } 270902ac6454SAndrew Thompson } 271002ac6454SAndrew Thompson /* check actual number of frames */ 271102ac6454SAndrew Thompson if (xfer->aframes > xfer->nframes) { 271202ac6454SAndrew Thompson if (xfer->error == 0) { 271302ac6454SAndrew Thompson panic("%s: actual number of frames, %d, is " 2714767cb2e2SAndrew Thompson "greater than initial number of frames, %d\n", 271502ac6454SAndrew Thompson __FUNCTION__, xfer->aframes, xfer->nframes); 271602ac6454SAndrew Thompson } else { 271702ac6454SAndrew Thompson /* just set some valid value */ 271802ac6454SAndrew Thompson xfer->aframes = xfer->nframes; 271902ac6454SAndrew Thompson } 272002ac6454SAndrew Thompson } 272102ac6454SAndrew Thompson /* compute actual length */ 272202ac6454SAndrew Thompson xfer->actlen = 0; 272302ac6454SAndrew Thompson 272402ac6454SAndrew Thompson for (x = 0; x != xfer->aframes; x++) { 272502ac6454SAndrew Thompson xfer->actlen += xfer->frlengths[x]; 272602ac6454SAndrew Thompson } 272702ac6454SAndrew Thompson 272802ac6454SAndrew Thompson /* 272902ac6454SAndrew Thompson * Frames that were not transferred get zero actual length in 273002ac6454SAndrew Thompson * case the USB device driver does not check the actual number 273102ac6454SAndrew Thompson * of frames transferred, "xfer->aframes": 273202ac6454SAndrew Thompson */ 273302ac6454SAndrew Thompson for (; x < xfer->nframes; x++) { 2734ed6d949aSAndrew Thompson usbd_xfer_set_frame_len(xfer, x, 0); 273502ac6454SAndrew Thompson } 273602ac6454SAndrew Thompson 273702ac6454SAndrew Thompson /* check actual length */ 273802ac6454SAndrew Thompson if (xfer->actlen > xfer->sumlen) { 273902ac6454SAndrew Thompson if (xfer->error == 0) { 274002ac6454SAndrew Thompson panic("%s: actual length, %d, is greater than " 2741767cb2e2SAndrew Thompson "initial length, %d\n", 274202ac6454SAndrew Thompson __FUNCTION__, xfer->actlen, xfer->sumlen); 274302ac6454SAndrew Thompson } else { 274402ac6454SAndrew Thompson /* just set some valid value */ 274502ac6454SAndrew Thompson xfer->actlen = xfer->sumlen; 274602ac6454SAndrew Thompson } 274702ac6454SAndrew Thompson } 2748ed6d949aSAndrew Thompson DPRINTFN(1, "xfer=%p endpoint=%p sts=%d alen=%d, slen=%d, afrm=%d, nfrm=%d\n", 2749ae60fdfbSAndrew Thompson xfer, xfer->endpoint, xfer->error, xfer->actlen, xfer->sumlen, 275002ac6454SAndrew Thompson xfer->aframes, xfer->nframes); 275102ac6454SAndrew Thompson 275202ac6454SAndrew Thompson if (xfer->error) { 275302ac6454SAndrew Thompson /* end of control transfer, if any */ 275402ac6454SAndrew Thompson xfer->flags_int.control_act = 0; 275502ac6454SAndrew Thompson 275602ac6454SAndrew Thompson /* check if we should block the execution queue */ 275702ac6454SAndrew Thompson if ((xfer->error != USB_ERR_CANCELLED) && 275802ac6454SAndrew Thompson (xfer->flags.pipe_bof)) { 275902ac6454SAndrew Thompson DPRINTFN(2, "xfer=%p: Block On Failure " 2760ae60fdfbSAndrew Thompson "on endpoint=%p\n", xfer, xfer->endpoint); 276102ac6454SAndrew Thompson goto done; 276202ac6454SAndrew Thompson } 276302ac6454SAndrew Thompson } else { 276402ac6454SAndrew Thompson /* check for short transfers */ 276502ac6454SAndrew Thompson if (xfer->actlen < xfer->sumlen) { 276602ac6454SAndrew Thompson 276702ac6454SAndrew Thompson /* end of control transfer, if any */ 276802ac6454SAndrew Thompson xfer->flags_int.control_act = 0; 276902ac6454SAndrew Thompson 277002ac6454SAndrew Thompson if (!xfer->flags_int.short_xfer_ok) { 277102ac6454SAndrew Thompson xfer->error = USB_ERR_SHORT_XFER; 277202ac6454SAndrew Thompson if (xfer->flags.pipe_bof) { 277302ac6454SAndrew Thompson DPRINTFN(2, "xfer=%p: Block On Failure on " 2774ae60fdfbSAndrew Thompson "Short Transfer on endpoint %p.\n", 2775ae60fdfbSAndrew Thompson xfer, xfer->endpoint); 277602ac6454SAndrew Thompson goto done; 277702ac6454SAndrew Thompson } 277802ac6454SAndrew Thompson } 277902ac6454SAndrew Thompson } else { 278002ac6454SAndrew Thompson /* 278102ac6454SAndrew Thompson * Check if we are in the middle of a 278202ac6454SAndrew Thompson * control transfer: 278302ac6454SAndrew Thompson */ 278402ac6454SAndrew Thompson if (xfer->flags_int.control_act) { 278502ac6454SAndrew Thompson DPRINTFN(5, "xfer=%p: Control transfer " 2786ae60fdfbSAndrew Thompson "active on endpoint=%p\n", xfer, xfer->endpoint); 278702ac6454SAndrew Thompson goto done; 278802ac6454SAndrew Thompson } 278902ac6454SAndrew Thompson } 279002ac6454SAndrew Thompson } 279102ac6454SAndrew Thompson 2792ae60fdfbSAndrew Thompson ep = xfer->endpoint; 279302ac6454SAndrew Thompson 279402ac6454SAndrew Thompson /* 279502ac6454SAndrew Thompson * If the current USB transfer is completing we need to start the 279602ac6454SAndrew Thompson * next one: 279702ac6454SAndrew Thompson */ 2798963169b4SHans Petter Selasky USB_BUS_LOCK(bus); 2799ae60fdfbSAndrew Thompson if (ep->endpoint_q.curr == xfer) { 2800a593f6b8SAndrew Thompson usb_command_wrapper(&ep->endpoint_q, NULL); 280102ac6454SAndrew Thompson 2802ae60fdfbSAndrew Thompson if (ep->endpoint_q.curr || TAILQ_FIRST(&ep->endpoint_q.head)) { 280302ac6454SAndrew Thompson /* there is another USB transfer waiting */ 280402ac6454SAndrew Thompson } else { 280502ac6454SAndrew Thompson /* this is the last USB transfer */ 280602ac6454SAndrew Thompson /* clear isochronous sync flag */ 2807ae60fdfbSAndrew Thompson xfer->endpoint->is_synced = 0; 280802ac6454SAndrew Thompson } 280902ac6454SAndrew Thompson } 2810963169b4SHans Petter Selasky USB_BUS_UNLOCK(bus); 281102ac6454SAndrew Thompson done: 281202ac6454SAndrew Thompson return (0); 281302ac6454SAndrew Thompson } 281402ac6454SAndrew Thompson 281502ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2816a593f6b8SAndrew Thompson * usb_command_wrapper 281702ac6454SAndrew Thompson * 281802ac6454SAndrew Thompson * This function is used to execute commands non-recursivly on an USB 281902ac6454SAndrew Thompson * transfer. 282002ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 282102ac6454SAndrew Thompson void 2822a593f6b8SAndrew Thompson usb_command_wrapper(struct usb_xfer_queue *pq, struct usb_xfer *xfer) 282302ac6454SAndrew Thompson { 282402ac6454SAndrew Thompson if (xfer) { 282502ac6454SAndrew Thompson /* 282602ac6454SAndrew Thompson * If the transfer is not already processing, 282702ac6454SAndrew Thompson * queue it! 282802ac6454SAndrew Thompson */ 282902ac6454SAndrew Thompson if (pq->curr != xfer) { 2830a593f6b8SAndrew Thompson usbd_transfer_enqueue(pq, xfer); 283102ac6454SAndrew Thompson if (pq->curr != NULL) { 283202ac6454SAndrew Thompson /* something is already processing */ 283302ac6454SAndrew Thompson DPRINTFN(6, "busy %p\n", pq->curr); 283402ac6454SAndrew Thompson return; 283502ac6454SAndrew Thompson } 283602ac6454SAndrew Thompson } 283702ac6454SAndrew Thompson } else { 283802ac6454SAndrew Thompson /* Get next element in queue */ 283902ac6454SAndrew Thompson pq->curr = NULL; 284002ac6454SAndrew Thompson } 284102ac6454SAndrew Thompson 284202ac6454SAndrew Thompson if (!pq->recurse_1) { 284302ac6454SAndrew Thompson 284402ac6454SAndrew Thompson do { 284502ac6454SAndrew Thompson 284602ac6454SAndrew Thompson /* set both recurse flags */ 284702ac6454SAndrew Thompson pq->recurse_1 = 1; 284802ac6454SAndrew Thompson pq->recurse_2 = 1; 284902ac6454SAndrew Thompson 285002ac6454SAndrew Thompson if (pq->curr == NULL) { 285102ac6454SAndrew Thompson xfer = TAILQ_FIRST(&pq->head); 285202ac6454SAndrew Thompson if (xfer) { 285302ac6454SAndrew Thompson TAILQ_REMOVE(&pq->head, xfer, 285402ac6454SAndrew Thompson wait_entry); 285502ac6454SAndrew Thompson xfer->wait_queue = NULL; 285602ac6454SAndrew Thompson pq->curr = xfer; 285702ac6454SAndrew Thompson } else { 285802ac6454SAndrew Thompson break; 285902ac6454SAndrew Thompson } 286002ac6454SAndrew Thompson } 286102ac6454SAndrew Thompson DPRINTFN(6, "cb %p (enter)\n", pq->curr); 286202ac6454SAndrew Thompson (pq->command) (pq); 286302ac6454SAndrew Thompson DPRINTFN(6, "cb %p (leave)\n", pq->curr); 286402ac6454SAndrew Thompson 286502ac6454SAndrew Thompson } while (!pq->recurse_2); 286602ac6454SAndrew Thompson 286702ac6454SAndrew Thompson /* clear first recurse flag */ 286802ac6454SAndrew Thompson pq->recurse_1 = 0; 286902ac6454SAndrew Thompson 287002ac6454SAndrew Thompson } else { 287102ac6454SAndrew Thompson /* clear second recurse flag */ 287202ac6454SAndrew Thompson pq->recurse_2 = 0; 287302ac6454SAndrew Thompson } 287402ac6454SAndrew Thompson } 287502ac6454SAndrew Thompson 287602ac6454SAndrew Thompson /*------------------------------------------------------------------------* 28775b3bb704SAndrew Thompson * usbd_ctrl_transfer_setup 287802ac6454SAndrew Thompson * 287902ac6454SAndrew Thompson * This function is used to setup the default USB control endpoint 288002ac6454SAndrew Thompson * transfer. 288102ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 288202ac6454SAndrew Thompson void 28835b3bb704SAndrew Thompson usbd_ctrl_transfer_setup(struct usb_device *udev) 288402ac6454SAndrew Thompson { 2885760bc48eSAndrew Thompson struct usb_xfer *xfer; 288602ac6454SAndrew Thompson uint8_t no_resetup; 288702ac6454SAndrew Thompson uint8_t iface_index; 288802ac6454SAndrew Thompson 288939307315SAndrew Thompson /* check for root HUB */ 289039307315SAndrew Thompson if (udev->parent_hub == NULL) 289139307315SAndrew Thompson return; 289202ac6454SAndrew Thompson repeat: 289302ac6454SAndrew Thompson 28945b3bb704SAndrew Thompson xfer = udev->ctrl_xfer[0]; 289502ac6454SAndrew Thompson if (xfer) { 289602ac6454SAndrew Thompson USB_XFER_LOCK(xfer); 289702ac6454SAndrew Thompson no_resetup = 289802ac6454SAndrew Thompson ((xfer->address == udev->address) && 28995b3bb704SAndrew Thompson (udev->ctrl_ep_desc.wMaxPacketSize[0] == 290002ac6454SAndrew Thompson udev->ddesc.bMaxPacketSize)); 2901f29a0724SAndrew Thompson if (udev->flags.usb_mode == USB_MODE_DEVICE) { 290202ac6454SAndrew Thompson if (no_resetup) { 290302ac6454SAndrew Thompson /* 290402ac6454SAndrew Thompson * NOTE: checking "xfer->address" and 290502ac6454SAndrew Thompson * starting the USB transfer must be 290602ac6454SAndrew Thompson * atomic! 290702ac6454SAndrew Thompson */ 2908a593f6b8SAndrew Thompson usbd_transfer_start(xfer); 290902ac6454SAndrew Thompson } 291002ac6454SAndrew Thompson } 291102ac6454SAndrew Thompson USB_XFER_UNLOCK(xfer); 291202ac6454SAndrew Thompson } else { 291302ac6454SAndrew Thompson no_resetup = 0; 291402ac6454SAndrew Thompson } 291502ac6454SAndrew Thompson 291602ac6454SAndrew Thompson if (no_resetup) { 291702ac6454SAndrew Thompson /* 291802ac6454SAndrew Thompson * All parameters are exactly the same like before. 291902ac6454SAndrew Thompson * Just return. 292002ac6454SAndrew Thompson */ 292102ac6454SAndrew Thompson return; 292202ac6454SAndrew Thompson } 292302ac6454SAndrew Thompson /* 292402ac6454SAndrew Thompson * Update wMaxPacketSize for the default control endpoint: 292502ac6454SAndrew Thompson */ 29265b3bb704SAndrew Thompson udev->ctrl_ep_desc.wMaxPacketSize[0] = 292702ac6454SAndrew Thompson udev->ddesc.bMaxPacketSize; 292802ac6454SAndrew Thompson 292902ac6454SAndrew Thompson /* 293002ac6454SAndrew Thompson * Unsetup any existing USB transfer: 293102ac6454SAndrew Thompson */ 29325b3bb704SAndrew Thompson usbd_transfer_unsetup(udev->ctrl_xfer, USB_CTRL_XFER_MAX); 293302ac6454SAndrew Thompson 293402ac6454SAndrew Thompson /* 29352906af23SHans Petter Selasky * Reset clear stall error counter. 29362906af23SHans Petter Selasky */ 29372906af23SHans Petter Selasky udev->clear_stall_errors = 0; 29382906af23SHans Petter Selasky 29392906af23SHans Petter Selasky /* 294002ac6454SAndrew Thompson * Try to setup a new USB transfer for the 294102ac6454SAndrew Thompson * default control endpoint: 294202ac6454SAndrew Thompson */ 294302ac6454SAndrew Thompson iface_index = 0; 2944a593f6b8SAndrew Thompson if (usbd_transfer_setup(udev, &iface_index, 29455b3bb704SAndrew Thompson udev->ctrl_xfer, usb_control_ep_cfg, USB_CTRL_XFER_MAX, NULL, 294691cd9240SAndrew Thompson &udev->device_mtx)) { 294702ac6454SAndrew Thompson DPRINTFN(0, "could not setup default " 2948767cb2e2SAndrew Thompson "USB transfer\n"); 294902ac6454SAndrew Thompson } else { 295002ac6454SAndrew Thompson goto repeat; 295102ac6454SAndrew Thompson } 295202ac6454SAndrew Thompson } 295302ac6454SAndrew Thompson 295402ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2955a593f6b8SAndrew Thompson * usbd_clear_data_toggle - factored out code 295602ac6454SAndrew Thompson * 295702ac6454SAndrew Thompson * NOTE: the intention of this function is not to reset the hardware 295802ac6454SAndrew Thompson * data toggle. 295902ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 296002ac6454SAndrew Thompson void 2961963169b4SHans Petter Selasky usbd_clear_stall_locked(struct usb_device *udev, struct usb_endpoint *ep) 2962963169b4SHans Petter Selasky { 2963963169b4SHans Petter Selasky USB_BUS_LOCK_ASSERT(udev->bus, MA_OWNED); 2964963169b4SHans Petter Selasky 2965963169b4SHans Petter Selasky /* check that we have a valid case */ 2966963169b4SHans Petter Selasky if (udev->flags.usb_mode == USB_MODE_HOST && 2967963169b4SHans Petter Selasky udev->parent_hub != NULL && 2968963169b4SHans Petter Selasky udev->bus->methods->clear_stall != NULL && 2969963169b4SHans Petter Selasky ep->methods != NULL) { 2970963169b4SHans Petter Selasky (udev->bus->methods->clear_stall) (udev, ep); 2971963169b4SHans Petter Selasky } 2972963169b4SHans Petter Selasky } 2973963169b4SHans Petter Selasky 2974963169b4SHans Petter Selasky /*------------------------------------------------------------------------* 2975963169b4SHans Petter Selasky * usbd_clear_data_toggle - factored out code 2976963169b4SHans Petter Selasky * 2977963169b4SHans Petter Selasky * NOTE: the intention of this function is not to reset the hardware 2978963169b4SHans Petter Selasky * data toggle on the USB device side. 2979963169b4SHans Petter Selasky *------------------------------------------------------------------------*/ 2980963169b4SHans Petter Selasky void 2981a593f6b8SAndrew Thompson usbd_clear_data_toggle(struct usb_device *udev, struct usb_endpoint *ep) 298202ac6454SAndrew Thompson { 2983ae60fdfbSAndrew Thompson DPRINTFN(5, "udev=%p endpoint=%p\n", udev, ep); 298402ac6454SAndrew Thompson 298502ac6454SAndrew Thompson USB_BUS_LOCK(udev->bus); 2986ae60fdfbSAndrew Thompson ep->toggle_next = 0; 2987963169b4SHans Petter Selasky /* some hardware needs a callback to clear the data toggle */ 2988963169b4SHans Petter Selasky usbd_clear_stall_locked(udev, ep); 298902ac6454SAndrew Thompson USB_BUS_UNLOCK(udev->bus); 299002ac6454SAndrew Thompson } 299102ac6454SAndrew Thompson 299202ac6454SAndrew Thompson /*------------------------------------------------------------------------* 2993a593f6b8SAndrew Thompson * usbd_clear_stall_callback - factored out clear stall callback 299402ac6454SAndrew Thompson * 299502ac6454SAndrew Thompson * Input parameters: 299602ac6454SAndrew Thompson * xfer1: Clear Stall Control Transfer 299702ac6454SAndrew Thompson * xfer2: Stalled USB Transfer 299802ac6454SAndrew Thompson * 299902ac6454SAndrew Thompson * This function is NULL safe. 300002ac6454SAndrew Thompson * 300102ac6454SAndrew Thompson * Return values: 300202ac6454SAndrew Thompson * 0: In progress 300302ac6454SAndrew Thompson * Else: Finished 300402ac6454SAndrew Thompson * 300502ac6454SAndrew Thompson * Clear stall config example: 300602ac6454SAndrew Thompson * 3007760bc48eSAndrew Thompson * static const struct usb_config my_clearstall = { 300802ac6454SAndrew Thompson * .type = UE_CONTROL, 300902ac6454SAndrew Thompson * .endpoint = 0, 301002ac6454SAndrew Thompson * .direction = UE_DIR_ANY, 301102ac6454SAndrew Thompson * .interval = 50, //50 milliseconds 3012760bc48eSAndrew Thompson * .bufsize = sizeof(struct usb_device_request), 30134eae601eSAndrew Thompson * .timeout = 1000, //1.000 seconds 30144eae601eSAndrew Thompson * .callback = &my_clear_stall_callback, // ** 30154eae601eSAndrew Thompson * .usb_mode = USB_MODE_HOST, 301602ac6454SAndrew Thompson * }; 301702ac6454SAndrew Thompson * 3018a593f6b8SAndrew Thompson * ** "my_clear_stall_callback" calls "usbd_clear_stall_callback" 301902ac6454SAndrew Thompson * passing the correct parameters. 302002ac6454SAndrew Thompson *------------------------------------------------------------------------*/ 302102ac6454SAndrew Thompson uint8_t 3022a593f6b8SAndrew Thompson usbd_clear_stall_callback(struct usb_xfer *xfer1, 3023760bc48eSAndrew Thompson struct usb_xfer *xfer2) 302402ac6454SAndrew Thompson { 3025760bc48eSAndrew Thompson struct usb_device_request req; 302602ac6454SAndrew Thompson 302702ac6454SAndrew Thompson if (xfer2 == NULL) { 302802ac6454SAndrew Thompson /* looks like we are tearing down */ 302902ac6454SAndrew Thompson DPRINTF("NULL input parameter\n"); 303002ac6454SAndrew Thompson return (0); 303102ac6454SAndrew Thompson } 303202ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer1, MA_OWNED); 303302ac6454SAndrew Thompson USB_XFER_LOCK_ASSERT(xfer2, MA_OWNED); 303402ac6454SAndrew Thompson 303502ac6454SAndrew Thompson switch (USB_GET_STATE(xfer1)) { 303602ac6454SAndrew Thompson case USB_ST_SETUP: 303702ac6454SAndrew Thompson 303802ac6454SAndrew Thompson /* 303902ac6454SAndrew Thompson * pre-clear the data toggle to DATA0 ("umass.c" and 304002ac6454SAndrew Thompson * "ata-usb.c" depends on this) 304102ac6454SAndrew Thompson */ 304202ac6454SAndrew Thompson 3043a593f6b8SAndrew Thompson usbd_clear_data_toggle(xfer2->xroot->udev, xfer2->endpoint); 304402ac6454SAndrew Thompson 304502ac6454SAndrew Thompson /* setup a clear-stall packet */ 304602ac6454SAndrew Thompson 304702ac6454SAndrew Thompson req.bmRequestType = UT_WRITE_ENDPOINT; 304802ac6454SAndrew Thompson req.bRequest = UR_CLEAR_FEATURE; 304902ac6454SAndrew Thompson USETW(req.wValue, UF_ENDPOINT_HALT); 3050ae60fdfbSAndrew Thompson req.wIndex[0] = xfer2->endpoint->edesc->bEndpointAddress; 305102ac6454SAndrew Thompson req.wIndex[1] = 0; 305202ac6454SAndrew Thompson USETW(req.wLength, 0); 305302ac6454SAndrew Thompson 305402ac6454SAndrew Thompson /* 3055a593f6b8SAndrew Thompson * "usbd_transfer_setup_sub()" will ensure that 305602ac6454SAndrew Thompson * we have sufficient room in the buffer for 305702ac6454SAndrew Thompson * the request structure! 305802ac6454SAndrew Thompson */ 305902ac6454SAndrew Thompson 306002ac6454SAndrew Thompson /* copy in the transfer */ 306102ac6454SAndrew Thompson 3062a593f6b8SAndrew Thompson usbd_copy_in(xfer1->frbuffers, 0, &req, sizeof(req)); 306302ac6454SAndrew Thompson 306402ac6454SAndrew Thompson /* set length */ 306502ac6454SAndrew Thompson xfer1->frlengths[0] = sizeof(req); 306602ac6454SAndrew Thompson xfer1->nframes = 1; 306702ac6454SAndrew Thompson 3068a593f6b8SAndrew Thompson usbd_transfer_submit(xfer1); 306902ac6454SAndrew Thompson return (0); 307002ac6454SAndrew Thompson 307102ac6454SAndrew Thompson case USB_ST_TRANSFERRED: 307202ac6454SAndrew Thompson break; 307302ac6454SAndrew Thompson 307402ac6454SAndrew Thompson default: /* Error */ 307502ac6454SAndrew Thompson if (xfer1->error == USB_ERR_CANCELLED) { 307602ac6454SAndrew Thompson return (0); 307702ac6454SAndrew Thompson } 307802ac6454SAndrew Thompson break; 307902ac6454SAndrew Thompson } 308002ac6454SAndrew Thompson return (1); /* Clear Stall Finished */ 308102ac6454SAndrew Thompson } 308202ac6454SAndrew Thompson 3083dddb25f9SAlfred Perlstein /*------------------------------------------------------------------------* 3084dddb25f9SAlfred Perlstein * usbd_transfer_poll 3085dddb25f9SAlfred Perlstein * 3086dddb25f9SAlfred Perlstein * The following function gets called from the USB keyboard driver and 3087dddb25f9SAlfred Perlstein * UMASS when the system has paniced. 3088dddb25f9SAlfred Perlstein * 3089dddb25f9SAlfred Perlstein * NOTE: It is currently not possible to resume normal operation on 3090dddb25f9SAlfred Perlstein * the USB controller which has been polled, due to clearing of the 3091dddb25f9SAlfred Perlstein * "up_dsleep" and "up_msleep" flags. 3092dddb25f9SAlfred Perlstein *------------------------------------------------------------------------*/ 309302ac6454SAndrew Thompson void 3094ed6d949aSAndrew Thompson usbd_transfer_poll(struct usb_xfer **ppxfer, uint16_t max) 309502ac6454SAndrew Thompson { 3096dddb25f9SAlfred Perlstein struct usb_xfer *xfer; 3097dddb25f9SAlfred Perlstein struct usb_xfer_root *xroot; 3098dddb25f9SAlfred Perlstein struct usb_device *udev; 3099dddb25f9SAlfred Perlstein struct usb_proc_msg *pm; 3100dddb25f9SAlfred Perlstein uint16_t n; 3101dddb25f9SAlfred Perlstein uint16_t drop_bus; 3102dddb25f9SAlfred Perlstein uint16_t drop_xfer; 3103dddb25f9SAlfred Perlstein 3104dddb25f9SAlfred Perlstein for (n = 0; n != max; n++) { 3105dddb25f9SAlfred Perlstein /* Extra checks to avoid panic */ 3106dddb25f9SAlfred Perlstein xfer = ppxfer[n]; 3107dddb25f9SAlfred Perlstein if (xfer == NULL) 3108dddb25f9SAlfred Perlstein continue; /* no USB transfer */ 3109dddb25f9SAlfred Perlstein xroot = xfer->xroot; 3110dddb25f9SAlfred Perlstein if (xroot == NULL) 3111dddb25f9SAlfred Perlstein continue; /* no USB root */ 3112dddb25f9SAlfred Perlstein udev = xroot->udev; 3113dddb25f9SAlfred Perlstein if (udev == NULL) 3114dddb25f9SAlfred Perlstein continue; /* no USB device */ 3115dddb25f9SAlfred Perlstein if (udev->bus == NULL) 3116dddb25f9SAlfred Perlstein continue; /* no BUS structure */ 3117dddb25f9SAlfred Perlstein if (udev->bus->methods == NULL) 3118dddb25f9SAlfred Perlstein continue; /* no BUS methods */ 3119dddb25f9SAlfred Perlstein if (udev->bus->methods->xfer_poll == NULL) 3120dddb25f9SAlfred Perlstein continue; /* no poll method */ 3121dddb25f9SAlfred Perlstein 3122dddb25f9SAlfred Perlstein /* make sure that the BUS mutex is not locked */ 3123dddb25f9SAlfred Perlstein drop_bus = 0; 31246703915eSAndriy Gapon while (mtx_owned(&xroot->udev->bus->bus_mtx) && !SCHEDULER_STOPPED()) { 3125dddb25f9SAlfred Perlstein mtx_unlock(&xroot->udev->bus->bus_mtx); 3126dddb25f9SAlfred Perlstein drop_bus++; 3127dddb25f9SAlfred Perlstein } 3128dddb25f9SAlfred Perlstein 3129dddb25f9SAlfred Perlstein /* make sure that the transfer mutex is not locked */ 3130dddb25f9SAlfred Perlstein drop_xfer = 0; 31316703915eSAndriy Gapon while (mtx_owned(xroot->xfer_mtx) && !SCHEDULER_STOPPED()) { 3132dddb25f9SAlfred Perlstein mtx_unlock(xroot->xfer_mtx); 3133dddb25f9SAlfred Perlstein drop_xfer++; 3134dddb25f9SAlfred Perlstein } 3135dddb25f9SAlfred Perlstein 3136dddb25f9SAlfred Perlstein /* Make sure cv_signal() and cv_broadcast() is not called */ 3137dddb25f9SAlfred Perlstein udev->bus->control_xfer_proc.up_msleep = 0; 3138dddb25f9SAlfred Perlstein udev->bus->explore_proc.up_msleep = 0; 3139dddb25f9SAlfred Perlstein udev->bus->giant_callback_proc.up_msleep = 0; 3140dddb25f9SAlfred Perlstein udev->bus->non_giant_callback_proc.up_msleep = 0; 3141dddb25f9SAlfred Perlstein 3142dddb25f9SAlfred Perlstein /* poll USB hardware */ 3143dddb25f9SAlfred Perlstein (udev->bus->methods->xfer_poll) (udev->bus); 3144dddb25f9SAlfred Perlstein 3145dddb25f9SAlfred Perlstein USB_BUS_LOCK(xroot->bus); 3146dddb25f9SAlfred Perlstein 3147dddb25f9SAlfred Perlstein /* check for clear stall */ 31485b3bb704SAndrew Thompson if (udev->ctrl_xfer[1] != NULL) { 3149dddb25f9SAlfred Perlstein 3150dddb25f9SAlfred Perlstein /* poll clear stall start */ 3151dddb25f9SAlfred Perlstein pm = &udev->cs_msg[0].hdr; 3152dddb25f9SAlfred Perlstein (pm->pm_callback) (pm); 3153dddb25f9SAlfred Perlstein /* poll clear stall done thread */ 31545b3bb704SAndrew Thompson pm = &udev->ctrl_xfer[1]-> 3155dddb25f9SAlfred Perlstein xroot->done_m[0].hdr; 3156dddb25f9SAlfred Perlstein (pm->pm_callback) (pm); 3157dddb25f9SAlfred Perlstein } 3158dddb25f9SAlfred Perlstein 3159dddb25f9SAlfred Perlstein /* poll done thread */ 3160dddb25f9SAlfred Perlstein pm = &xroot->done_m[0].hdr; 3161dddb25f9SAlfred Perlstein (pm->pm_callback) (pm); 3162dddb25f9SAlfred Perlstein 3163dddb25f9SAlfred Perlstein USB_BUS_UNLOCK(xroot->bus); 3164dddb25f9SAlfred Perlstein 3165dddb25f9SAlfred Perlstein /* restore transfer mutex */ 3166dddb25f9SAlfred Perlstein while (drop_xfer--) 3167dddb25f9SAlfred Perlstein mtx_lock(xroot->xfer_mtx); 3168dddb25f9SAlfred Perlstein 3169dddb25f9SAlfred Perlstein /* restore BUS mutex */ 3170dddb25f9SAlfred Perlstein while (drop_bus--) 3171dddb25f9SAlfred Perlstein mtx_lock(&xroot->udev->bus->bus_mtx); 317202ac6454SAndrew Thompson } 317302ac6454SAndrew Thompson } 31744eae601eSAndrew Thompson 31754eae601eSAndrew Thompson static void 3176a593f6b8SAndrew Thompson usbd_get_std_packet_size(struct usb_std_packet_size *ptr, 31778d2dd5ddSAndrew Thompson uint8_t type, enum usb_dev_speed speed) 31784eae601eSAndrew Thompson { 31794eae601eSAndrew Thompson static const uint16_t intr_range_max[USB_SPEED_MAX] = { 31804eae601eSAndrew Thompson [USB_SPEED_LOW] = 8, 31814eae601eSAndrew Thompson [USB_SPEED_FULL] = 64, 31824eae601eSAndrew Thompson [USB_SPEED_HIGH] = 1024, 31834eae601eSAndrew Thompson [USB_SPEED_VARIABLE] = 1024, 31844eae601eSAndrew Thompson [USB_SPEED_SUPER] = 1024, 31854eae601eSAndrew Thompson }; 31864eae601eSAndrew Thompson 31874eae601eSAndrew Thompson static const uint16_t isoc_range_max[USB_SPEED_MAX] = { 31884eae601eSAndrew Thompson [USB_SPEED_LOW] = 0, /* invalid */ 31894eae601eSAndrew Thompson [USB_SPEED_FULL] = 1023, 31904eae601eSAndrew Thompson [USB_SPEED_HIGH] = 1024, 31914eae601eSAndrew Thompson [USB_SPEED_VARIABLE] = 3584, 31924eae601eSAndrew Thompson [USB_SPEED_SUPER] = 1024, 31934eae601eSAndrew Thompson }; 31944eae601eSAndrew Thompson 31954eae601eSAndrew Thompson static const uint16_t control_min[USB_SPEED_MAX] = { 31964eae601eSAndrew Thompson [USB_SPEED_LOW] = 8, 31974eae601eSAndrew Thompson [USB_SPEED_FULL] = 8, 31984eae601eSAndrew Thompson [USB_SPEED_HIGH] = 64, 31994eae601eSAndrew Thompson [USB_SPEED_VARIABLE] = 512, 32004eae601eSAndrew Thompson [USB_SPEED_SUPER] = 512, 32014eae601eSAndrew Thompson }; 32024eae601eSAndrew Thompson 32034eae601eSAndrew Thompson static const uint16_t bulk_min[USB_SPEED_MAX] = { 3204a4cadedbSAndrew Thompson [USB_SPEED_LOW] = 8, 32054eae601eSAndrew Thompson [USB_SPEED_FULL] = 8, 32064eae601eSAndrew Thompson [USB_SPEED_HIGH] = 512, 32074eae601eSAndrew Thompson [USB_SPEED_VARIABLE] = 512, 32084eae601eSAndrew Thompson [USB_SPEED_SUPER] = 1024, 32094eae601eSAndrew Thompson }; 32104eae601eSAndrew Thompson 32114eae601eSAndrew Thompson uint16_t temp; 32124eae601eSAndrew Thompson 32134eae601eSAndrew Thompson memset(ptr, 0, sizeof(*ptr)); 32144eae601eSAndrew Thompson 32154eae601eSAndrew Thompson switch (type) { 32164eae601eSAndrew Thompson case UE_INTERRUPT: 32178d2dd5ddSAndrew Thompson ptr->range.max = intr_range_max[speed]; 32184eae601eSAndrew Thompson break; 32194eae601eSAndrew Thompson case UE_ISOCHRONOUS: 32208d2dd5ddSAndrew Thompson ptr->range.max = isoc_range_max[speed]; 32214eae601eSAndrew Thompson break; 32224eae601eSAndrew Thompson default: 32234eae601eSAndrew Thompson if (type == UE_BULK) 32248d2dd5ddSAndrew Thompson temp = bulk_min[speed]; 32254eae601eSAndrew Thompson else /* UE_CONTROL */ 32268d2dd5ddSAndrew Thompson temp = control_min[speed]; 32274eae601eSAndrew Thompson 32284eae601eSAndrew Thompson /* default is fixed */ 32294eae601eSAndrew Thompson ptr->fixed[0] = temp; 32304eae601eSAndrew Thompson ptr->fixed[1] = temp; 32314eae601eSAndrew Thompson ptr->fixed[2] = temp; 32324eae601eSAndrew Thompson ptr->fixed[3] = temp; 32334eae601eSAndrew Thompson 32348d2dd5ddSAndrew Thompson if (speed == USB_SPEED_FULL) { 32354eae601eSAndrew Thompson /* multiple sizes */ 32364eae601eSAndrew Thompson ptr->fixed[1] = 16; 32374eae601eSAndrew Thompson ptr->fixed[2] = 32; 32384eae601eSAndrew Thompson ptr->fixed[3] = 64; 32394eae601eSAndrew Thompson } 32408d2dd5ddSAndrew Thompson if ((speed == USB_SPEED_VARIABLE) && 32414eae601eSAndrew Thompson (type == UE_BULK)) { 32424eae601eSAndrew Thompson /* multiple sizes */ 32434eae601eSAndrew Thompson ptr->fixed[2] = 1024; 32444eae601eSAndrew Thompson ptr->fixed[3] = 1536; 32454eae601eSAndrew Thompson } 32464eae601eSAndrew Thompson break; 32474eae601eSAndrew Thompson } 32484eae601eSAndrew Thompson } 3249ed6d949aSAndrew Thompson 3250ed6d949aSAndrew Thompson void * 3251ed6d949aSAndrew Thompson usbd_xfer_softc(struct usb_xfer *xfer) 3252ed6d949aSAndrew Thompson { 3253ed6d949aSAndrew Thompson return (xfer->priv_sc); 3254ed6d949aSAndrew Thompson } 3255ed6d949aSAndrew Thompson 3256ed6d949aSAndrew Thompson void * 3257ed6d949aSAndrew Thompson usbd_xfer_get_priv(struct usb_xfer *xfer) 3258ed6d949aSAndrew Thompson { 3259ed6d949aSAndrew Thompson return (xfer->priv_fifo); 3260ed6d949aSAndrew Thompson } 3261ed6d949aSAndrew Thompson 3262ed6d949aSAndrew Thompson void 3263ed6d949aSAndrew Thompson usbd_xfer_set_priv(struct usb_xfer *xfer, void *ptr) 3264ed6d949aSAndrew Thompson { 3265ed6d949aSAndrew Thompson xfer->priv_fifo = ptr; 3266ed6d949aSAndrew Thompson } 3267ed6d949aSAndrew Thompson 3268ed6d949aSAndrew Thompson uint8_t 3269ed6d949aSAndrew Thompson usbd_xfer_state(struct usb_xfer *xfer) 3270ed6d949aSAndrew Thompson { 3271ed6d949aSAndrew Thompson return (xfer->usb_state); 3272ed6d949aSAndrew Thompson } 3273ed6d949aSAndrew Thompson 3274ed6d949aSAndrew Thompson void 3275ed6d949aSAndrew Thompson usbd_xfer_set_flag(struct usb_xfer *xfer, int flag) 3276ed6d949aSAndrew Thompson { 3277ed6d949aSAndrew Thompson switch (flag) { 3278ed6d949aSAndrew Thompson case USB_FORCE_SHORT_XFER: 3279ed6d949aSAndrew Thompson xfer->flags.force_short_xfer = 1; 3280ed6d949aSAndrew Thompson break; 3281ed6d949aSAndrew Thompson case USB_SHORT_XFER_OK: 3282ed6d949aSAndrew Thompson xfer->flags.short_xfer_ok = 1; 3283ed6d949aSAndrew Thompson break; 328429bd7d7eSAndrew Thompson case USB_MULTI_SHORT_OK: 328529bd7d7eSAndrew Thompson xfer->flags.short_frames_ok = 1; 328629bd7d7eSAndrew Thompson break; 328729bd7d7eSAndrew Thompson case USB_MANUAL_STATUS: 328829bd7d7eSAndrew Thompson xfer->flags.manual_status = 1; 328929bd7d7eSAndrew Thompson break; 3290ed6d949aSAndrew Thompson } 3291ed6d949aSAndrew Thompson } 3292ed6d949aSAndrew Thompson 3293ed6d949aSAndrew Thompson void 3294ed6d949aSAndrew Thompson usbd_xfer_clr_flag(struct usb_xfer *xfer, int flag) 3295ed6d949aSAndrew Thompson { 3296ed6d949aSAndrew Thompson switch (flag) { 3297ed6d949aSAndrew Thompson case USB_FORCE_SHORT_XFER: 3298ed6d949aSAndrew Thompson xfer->flags.force_short_xfer = 0; 3299ed6d949aSAndrew Thompson break; 3300ed6d949aSAndrew Thompson case USB_SHORT_XFER_OK: 3301ed6d949aSAndrew Thompson xfer->flags.short_xfer_ok = 0; 3302ed6d949aSAndrew Thompson break; 330329bd7d7eSAndrew Thompson case USB_MULTI_SHORT_OK: 330429bd7d7eSAndrew Thompson xfer->flags.short_frames_ok = 0; 330529bd7d7eSAndrew Thompson break; 330629bd7d7eSAndrew Thompson case USB_MANUAL_STATUS: 330729bd7d7eSAndrew Thompson xfer->flags.manual_status = 0; 330829bd7d7eSAndrew Thompson break; 3309ed6d949aSAndrew Thompson } 3310ed6d949aSAndrew Thompson } 331129bd7d7eSAndrew Thompson 331229bd7d7eSAndrew Thompson /* 331329bd7d7eSAndrew Thompson * The following function returns in milliseconds when the isochronous 331429bd7d7eSAndrew Thompson * transfer was completed by the hardware. The returned value wraps 331529bd7d7eSAndrew Thompson * around 65536 milliseconds. 331629bd7d7eSAndrew Thompson */ 331729bd7d7eSAndrew Thompson uint16_t 331829bd7d7eSAndrew Thompson usbd_xfer_get_timestamp(struct usb_xfer *xfer) 331929bd7d7eSAndrew Thompson { 332029bd7d7eSAndrew Thompson return (xfer->isoc_time_complete); 332129bd7d7eSAndrew Thompson } 3322