12b2325ffSGerd Hoffmann /* 22b2325ffSGerd Hoffmann * Linux host USB redirector 32b2325ffSGerd Hoffmann * 42b2325ffSGerd Hoffmann * Copyright (c) 2005 Fabrice Bellard 52b2325ffSGerd Hoffmann * 62b2325ffSGerd Hoffmann * Copyright (c) 2008 Max Krasnyansky 72b2325ffSGerd Hoffmann * Support for host device auto connect & disconnect 82b2325ffSGerd Hoffmann * Major rewrite to support fully async operation 92b2325ffSGerd Hoffmann * 102b2325ffSGerd Hoffmann * Copyright 2008 TJ <linux@tjworld.net> 112b2325ffSGerd Hoffmann * Added flexible support for /dev/bus/usb /sys/bus/usb/devices in addition 122b2325ffSGerd Hoffmann * to the legacy /proc/bus/usb USB device discovery and handling 132b2325ffSGerd Hoffmann * 142b2325ffSGerd Hoffmann * (c) 2012 Gerd Hoffmann <kraxel@redhat.com> 152b2325ffSGerd Hoffmann * Completely rewritten to use libusb instead of usbfs ioctls. 162b2325ffSGerd Hoffmann * 172b2325ffSGerd Hoffmann * Permission is hereby granted, free of charge, to any person obtaining a copy 182b2325ffSGerd Hoffmann * of this software and associated documentation files (the "Software"), to deal 192b2325ffSGerd Hoffmann * in the Software without restriction, including without limitation the rights 202b2325ffSGerd Hoffmann * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 212b2325ffSGerd Hoffmann * copies of the Software, and to permit persons to whom the Software is 222b2325ffSGerd Hoffmann * furnished to do so, subject to the following conditions: 232b2325ffSGerd Hoffmann * 242b2325ffSGerd Hoffmann * The above copyright notice and this permission notice shall be included in 252b2325ffSGerd Hoffmann * all copies or substantial portions of the Software. 262b2325ffSGerd Hoffmann * 272b2325ffSGerd Hoffmann * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 282b2325ffSGerd Hoffmann * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 292b2325ffSGerd Hoffmann * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 302b2325ffSGerd Hoffmann * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 312b2325ffSGerd Hoffmann * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 322b2325ffSGerd Hoffmann * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 332b2325ffSGerd Hoffmann * THE SOFTWARE. 342b2325ffSGerd Hoffmann */ 352b2325ffSGerd Hoffmann 36e532b2e0SPeter Maydell #include "qemu/osdep.h" 37a277c3e0SStefan Weil #ifndef CONFIG_WIN32 382b2325ffSGerd Hoffmann #include <poll.h> 39a277c3e0SStefan Weil #endif 402b2325ffSGerd Hoffmann #include <libusb.h> 412b2325ffSGerd Hoffmann 42da34e65cSMarkus Armbruster #include "qapi/error.h" 432b2325ffSGerd Hoffmann #include "qemu-common.h" 442b2325ffSGerd Hoffmann #include "monitor/monitor.h" 45d49b6836SMarkus Armbruster #include "qemu/error-report.h" 462b2325ffSGerd Hoffmann #include "sysemu/sysemu.h" 472b2325ffSGerd Hoffmann #include "trace.h" 482b2325ffSGerd Hoffmann 492b2325ffSGerd Hoffmann #include "hw/usb.h" 502b2325ffSGerd Hoffmann 512b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 522b2325ffSGerd Hoffmann 532b2325ffSGerd Hoffmann #define TYPE_USB_HOST_DEVICE "usb-host" 542b2325ffSGerd Hoffmann #define USB_HOST_DEVICE(obj) \ 552b2325ffSGerd Hoffmann OBJECT_CHECK(USBHostDevice, (obj), TYPE_USB_HOST_DEVICE) 562b2325ffSGerd Hoffmann 572b2325ffSGerd Hoffmann typedef struct USBHostDevice USBHostDevice; 582b2325ffSGerd Hoffmann typedef struct USBHostRequest USBHostRequest; 592b2325ffSGerd Hoffmann typedef struct USBHostIsoXfer USBHostIsoXfer; 602b2325ffSGerd Hoffmann typedef struct USBHostIsoRing USBHostIsoRing; 612b2325ffSGerd Hoffmann 622b2325ffSGerd Hoffmann struct USBAutoFilter { 632b2325ffSGerd Hoffmann uint32_t bus_num; 642b2325ffSGerd Hoffmann uint32_t addr; 652b2325ffSGerd Hoffmann char *port; 662b2325ffSGerd Hoffmann uint32_t vendor_id; 672b2325ffSGerd Hoffmann uint32_t product_id; 682b2325ffSGerd Hoffmann }; 692b2325ffSGerd Hoffmann 702b2325ffSGerd Hoffmann enum USBHostDeviceOptions { 712b2325ffSGerd Hoffmann USB_HOST_OPT_PIPELINE, 722b2325ffSGerd Hoffmann }; 732b2325ffSGerd Hoffmann 742b2325ffSGerd Hoffmann struct USBHostDevice { 752b2325ffSGerd Hoffmann USBDevice parent_obj; 762b2325ffSGerd Hoffmann 772b2325ffSGerd Hoffmann /* properties */ 782b2325ffSGerd Hoffmann struct USBAutoFilter match; 792b2325ffSGerd Hoffmann int32_t bootindex; 802b2325ffSGerd Hoffmann uint32_t iso_urb_count; 812b2325ffSGerd Hoffmann uint32_t iso_urb_frames; 822b2325ffSGerd Hoffmann uint32_t options; 832b2325ffSGerd Hoffmann uint32_t loglevel; 84e058fa2dSGerd Hoffmann bool needs_autoscan; 852b2325ffSGerd Hoffmann 862b2325ffSGerd Hoffmann /* state */ 872b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostDevice) next; 882b2325ffSGerd Hoffmann int seen, errcount; 892b2325ffSGerd Hoffmann int bus_num; 902b2325ffSGerd Hoffmann int addr; 912b2325ffSGerd Hoffmann char port[16]; 922b2325ffSGerd Hoffmann 932b2325ffSGerd Hoffmann libusb_device *dev; 942b2325ffSGerd Hoffmann libusb_device_handle *dh; 952b2325ffSGerd Hoffmann struct libusb_device_descriptor ddesc; 962b2325ffSGerd Hoffmann 972b2325ffSGerd Hoffmann struct { 982b2325ffSGerd Hoffmann bool detached; 992b2325ffSGerd Hoffmann bool claimed; 1002b2325ffSGerd Hoffmann } ifs[USB_MAX_INTERFACES]; 1012b2325ffSGerd Hoffmann 1022b2325ffSGerd Hoffmann /* callbacks & friends */ 10395efb20cSGerd Hoffmann QEMUBH *bh_nodev; 10495efb20cSGerd Hoffmann QEMUBH *bh_postld; 105*3280ea8eSGerd Hoffmann bool bh_postld_pending; 1062b2325ffSGerd Hoffmann Notifier exit; 1072b2325ffSGerd Hoffmann 1082b2325ffSGerd Hoffmann /* request queues */ 1092b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostRequest) requests; 1102b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoRing) isorings; 1112b2325ffSGerd Hoffmann }; 1122b2325ffSGerd Hoffmann 1132b2325ffSGerd Hoffmann struct USBHostRequest { 1142b2325ffSGerd Hoffmann USBHostDevice *host; 1152b2325ffSGerd Hoffmann USBPacket *p; 1162b2325ffSGerd Hoffmann bool in; 1172b2325ffSGerd Hoffmann struct libusb_transfer *xfer; 1182b2325ffSGerd Hoffmann unsigned char *buffer; 1192b2325ffSGerd Hoffmann unsigned char *cbuf; 1202b2325ffSGerd Hoffmann unsigned int clen; 121b88a3e01SGerd Hoffmann bool usb3ep0quirk; 1222b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostRequest) next; 1232b2325ffSGerd Hoffmann }; 1242b2325ffSGerd Hoffmann 1252b2325ffSGerd Hoffmann struct USBHostIsoXfer { 1262b2325ffSGerd Hoffmann USBHostIsoRing *ring; 1272b2325ffSGerd Hoffmann struct libusb_transfer *xfer; 1282b2325ffSGerd Hoffmann bool copy_complete; 1292b2325ffSGerd Hoffmann unsigned int packet; 1302b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostIsoXfer) next; 1312b2325ffSGerd Hoffmann }; 1322b2325ffSGerd Hoffmann 1332b2325ffSGerd Hoffmann struct USBHostIsoRing { 1342b2325ffSGerd Hoffmann USBHostDevice *host; 1352b2325ffSGerd Hoffmann USBEndpoint *ep; 1362b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) unused; 1372b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) inflight; 1382b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) copy; 1392b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostIsoRing) next; 1402b2325ffSGerd Hoffmann }; 1412b2325ffSGerd Hoffmann 1422b2325ffSGerd Hoffmann static QTAILQ_HEAD(, USBHostDevice) hostdevs = 1432b2325ffSGerd Hoffmann QTAILQ_HEAD_INITIALIZER(hostdevs); 1442b2325ffSGerd Hoffmann 1452b2325ffSGerd Hoffmann static void usb_host_auto_check(void *unused); 1462b2325ffSGerd Hoffmann static void usb_host_release_interfaces(USBHostDevice *s); 1472b2325ffSGerd Hoffmann static void usb_host_nodev(USBHostDevice *s); 148f34d5c75SHans de Goede static void usb_host_detach_kernel(USBHostDevice *s); 1492b2325ffSGerd Hoffmann static void usb_host_attach_kernel(USBHostDevice *s); 1502b2325ffSGerd Hoffmann 1512b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 1522b2325ffSGerd Hoffmann 1531e03e407SChris Johns #ifndef LIBUSB_LOG_LEVEL_WARNING /* older libusb didn't define these */ 1541e03e407SChris Johns #define LIBUSB_LOG_LEVEL_WARNING 2 1551e03e407SChris Johns #endif 1561e03e407SChris Johns 1571e03e407SChris Johns /* ------------------------------------------------------------------------ */ 1581e03e407SChris Johns 1592b2325ffSGerd Hoffmann #define CONTROL_TIMEOUT 10000 /* 10 sec */ 1602b2325ffSGerd Hoffmann #define BULK_TIMEOUT 0 /* unlimited */ 1612b2325ffSGerd Hoffmann #define INTR_TIMEOUT 0 /* unlimited */ 1622b2325ffSGerd Hoffmann 163102a3d84SGerd Hoffmann #ifndef LIBUSB_API_VERSION 164102a3d84SGerd Hoffmann # define LIBUSB_API_VERSION LIBUSBX_API_VERSION 165102a3d84SGerd Hoffmann #endif 166102a3d84SGerd Hoffmann #if LIBUSB_API_VERSION >= 0x01000103 167322fd1f4SGerd Hoffmann # define HAVE_STREAMS 1 168322fd1f4SGerd Hoffmann #endif 169322fd1f4SGerd Hoffmann 1702b2325ffSGerd Hoffmann static const char *speed_name[] = { 1712b2325ffSGerd Hoffmann [LIBUSB_SPEED_UNKNOWN] = "?", 1722b2325ffSGerd Hoffmann [LIBUSB_SPEED_LOW] = "1.5", 1732b2325ffSGerd Hoffmann [LIBUSB_SPEED_FULL] = "12", 1742b2325ffSGerd Hoffmann [LIBUSB_SPEED_HIGH] = "480", 1752b2325ffSGerd Hoffmann [LIBUSB_SPEED_SUPER] = "5000", 1762b2325ffSGerd Hoffmann }; 1772b2325ffSGerd Hoffmann 1782b2325ffSGerd Hoffmann static const unsigned int speed_map[] = { 1792b2325ffSGerd Hoffmann [LIBUSB_SPEED_LOW] = USB_SPEED_LOW, 1802b2325ffSGerd Hoffmann [LIBUSB_SPEED_FULL] = USB_SPEED_FULL, 1812b2325ffSGerd Hoffmann [LIBUSB_SPEED_HIGH] = USB_SPEED_HIGH, 1822b2325ffSGerd Hoffmann [LIBUSB_SPEED_SUPER] = USB_SPEED_SUPER, 1832b2325ffSGerd Hoffmann }; 1842b2325ffSGerd Hoffmann 1852b2325ffSGerd Hoffmann static const unsigned int status_map[] = { 1862b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_COMPLETED] = USB_RET_SUCCESS, 1872b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_ERROR] = USB_RET_IOERROR, 1882b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_TIMED_OUT] = USB_RET_IOERROR, 1892b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_CANCELLED] = USB_RET_IOERROR, 1902b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_STALL] = USB_RET_STALL, 1912b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_NO_DEVICE] = USB_RET_NODEV, 1922b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_OVERFLOW] = USB_RET_BABBLE, 1932b2325ffSGerd Hoffmann }; 1942b2325ffSGerd Hoffmann 1952b2325ffSGerd Hoffmann static const char *err_names[] = { 1962b2325ffSGerd Hoffmann [-LIBUSB_ERROR_IO] = "IO", 1972b2325ffSGerd Hoffmann [-LIBUSB_ERROR_INVALID_PARAM] = "INVALID_PARAM", 1982b2325ffSGerd Hoffmann [-LIBUSB_ERROR_ACCESS] = "ACCESS", 1992b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NO_DEVICE] = "NO_DEVICE", 2002b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NOT_FOUND] = "NOT_FOUND", 2012b2325ffSGerd Hoffmann [-LIBUSB_ERROR_BUSY] = "BUSY", 2022b2325ffSGerd Hoffmann [-LIBUSB_ERROR_TIMEOUT] = "TIMEOUT", 2032b2325ffSGerd Hoffmann [-LIBUSB_ERROR_OVERFLOW] = "OVERFLOW", 2042b2325ffSGerd Hoffmann [-LIBUSB_ERROR_PIPE] = "PIPE", 2052b2325ffSGerd Hoffmann [-LIBUSB_ERROR_INTERRUPTED] = "INTERRUPTED", 2062b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NO_MEM] = "NO_MEM", 2072b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NOT_SUPPORTED] = "NOT_SUPPORTED", 2082b2325ffSGerd Hoffmann [-LIBUSB_ERROR_OTHER] = "OTHER", 2092b2325ffSGerd Hoffmann }; 2102b2325ffSGerd Hoffmann 2112b2325ffSGerd Hoffmann static libusb_context *ctx; 2122b2325ffSGerd Hoffmann static uint32_t loglevel; 2132b2325ffSGerd Hoffmann 214a277c3e0SStefan Weil #ifndef CONFIG_WIN32 215a277c3e0SStefan Weil 2162b2325ffSGerd Hoffmann static void usb_host_handle_fd(void *opaque) 2172b2325ffSGerd Hoffmann { 2182b2325ffSGerd Hoffmann struct timeval tv = { 0, 0 }; 2192b2325ffSGerd Hoffmann libusb_handle_events_timeout(ctx, &tv); 2202b2325ffSGerd Hoffmann } 2212b2325ffSGerd Hoffmann 2222b2325ffSGerd Hoffmann static void usb_host_add_fd(int fd, short events, void *user_data) 2232b2325ffSGerd Hoffmann { 2242b2325ffSGerd Hoffmann qemu_set_fd_handler(fd, 2252b2325ffSGerd Hoffmann (events & POLLIN) ? usb_host_handle_fd : NULL, 2262b2325ffSGerd Hoffmann (events & POLLOUT) ? usb_host_handle_fd : NULL, 2272b2325ffSGerd Hoffmann ctx); 2282b2325ffSGerd Hoffmann } 2292b2325ffSGerd Hoffmann 2302b2325ffSGerd Hoffmann static void usb_host_del_fd(int fd, void *user_data) 2312b2325ffSGerd Hoffmann { 2322b2325ffSGerd Hoffmann qemu_set_fd_handler(fd, NULL, NULL, NULL); 2332b2325ffSGerd Hoffmann } 2342b2325ffSGerd Hoffmann 235a277c3e0SStefan Weil #endif /* !CONFIG_WIN32 */ 236a277c3e0SStefan Weil 2372b2325ffSGerd Hoffmann static int usb_host_init(void) 2382b2325ffSGerd Hoffmann { 239a277c3e0SStefan Weil #ifndef CONFIG_WIN32 2402b2325ffSGerd Hoffmann const struct libusb_pollfd **poll; 241a277c3e0SStefan Weil #endif 2423bf2b3a1SStefan Weil int rc; 2432b2325ffSGerd Hoffmann 2442b2325ffSGerd Hoffmann if (ctx) { 2452b2325ffSGerd Hoffmann return 0; 2462b2325ffSGerd Hoffmann } 2472b2325ffSGerd Hoffmann rc = libusb_init(&ctx); 2482b2325ffSGerd Hoffmann if (rc != 0) { 2492b2325ffSGerd Hoffmann return -1; 2502b2325ffSGerd Hoffmann } 2519d8fa0dfSJohn Thomson #if LIBUSB_API_VERSION >= 0x01000106 2529d8fa0dfSJohn Thomson libusb_set_option(ctx, LIBUSB_OPTION_LOG_LEVEL, loglevel); 2539d8fa0dfSJohn Thomson #else 2542b2325ffSGerd Hoffmann libusb_set_debug(ctx, loglevel); 2559d8fa0dfSJohn Thomson #endif 256a277c3e0SStefan Weil #ifdef CONFIG_WIN32 257a277c3e0SStefan Weil /* FIXME: add support for Windows. */ 258a277c3e0SStefan Weil #else 2592b2325ffSGerd Hoffmann libusb_set_pollfd_notifiers(ctx, usb_host_add_fd, 2602b2325ffSGerd Hoffmann usb_host_del_fd, 2612b2325ffSGerd Hoffmann ctx); 2622b2325ffSGerd Hoffmann poll = libusb_get_pollfds(ctx); 2632b2325ffSGerd Hoffmann if (poll) { 2643bf2b3a1SStefan Weil int i; 2652b2325ffSGerd Hoffmann for (i = 0; poll[i] != NULL; i++) { 2662b2325ffSGerd Hoffmann usb_host_add_fd(poll[i]->fd, poll[i]->events, ctx); 2672b2325ffSGerd Hoffmann } 2682b2325ffSGerd Hoffmann } 2692b2325ffSGerd Hoffmann free(poll); 270a277c3e0SStefan Weil #endif 2712b2325ffSGerd Hoffmann return 0; 2722b2325ffSGerd Hoffmann } 2732b2325ffSGerd Hoffmann 2742b2325ffSGerd Hoffmann static int usb_host_get_port(libusb_device *dev, char *port, size_t len) 2752b2325ffSGerd Hoffmann { 2762b2325ffSGerd Hoffmann uint8_t path[7]; 2772b2325ffSGerd Hoffmann size_t off; 2782b2325ffSGerd Hoffmann int rc, i; 2792b2325ffSGerd Hoffmann 280102a3d84SGerd Hoffmann #if LIBUSB_API_VERSION >= 0x01000102 281bc45de8cSHans de Goede rc = libusb_get_port_numbers(dev, path, 7); 282bc45de8cSHans de Goede #else 2832b2325ffSGerd Hoffmann rc = libusb_get_port_path(ctx, dev, path, 7); 284bc45de8cSHans de Goede #endif 2852b2325ffSGerd Hoffmann if (rc < 0) { 2862b2325ffSGerd Hoffmann return 0; 2872b2325ffSGerd Hoffmann } 2882b2325ffSGerd Hoffmann off = snprintf(port, len, "%d", path[0]); 2892b2325ffSGerd Hoffmann for (i = 1; i < rc; i++) { 2902b2325ffSGerd Hoffmann off += snprintf(port+off, len-off, ".%d", path[i]); 2912b2325ffSGerd Hoffmann } 2922b2325ffSGerd Hoffmann return off; 2932b2325ffSGerd Hoffmann } 2942b2325ffSGerd Hoffmann 2952b2325ffSGerd Hoffmann static void usb_host_libusb_error(const char *func, int rc) 2962b2325ffSGerd Hoffmann { 2972b2325ffSGerd Hoffmann const char *errname; 2982b2325ffSGerd Hoffmann 2992b2325ffSGerd Hoffmann if (rc >= 0) { 3002b2325ffSGerd Hoffmann return; 3012b2325ffSGerd Hoffmann } 3022b2325ffSGerd Hoffmann 3032b2325ffSGerd Hoffmann if (-rc < ARRAY_SIZE(err_names) && err_names[-rc]) { 3042b2325ffSGerd Hoffmann errname = err_names[-rc]; 3052b2325ffSGerd Hoffmann } else { 3062b2325ffSGerd Hoffmann errname = "?"; 3072b2325ffSGerd Hoffmann } 3082e6a0dd1SGonglei error_report("%s: %d [%s]", func, rc, errname); 3092b2325ffSGerd Hoffmann } 3102b2325ffSGerd Hoffmann 3112b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 3122b2325ffSGerd Hoffmann 3132b2325ffSGerd Hoffmann static bool usb_host_use_combining(USBEndpoint *ep) 3142b2325ffSGerd Hoffmann { 3152b2325ffSGerd Hoffmann int type; 3162b2325ffSGerd Hoffmann 3172b2325ffSGerd Hoffmann if (!ep->pipeline) { 3182b2325ffSGerd Hoffmann return false; 3192b2325ffSGerd Hoffmann } 3202b2325ffSGerd Hoffmann if (ep->pid != USB_TOKEN_IN) { 3212b2325ffSGerd Hoffmann return false; 3222b2325ffSGerd Hoffmann } 3232b2325ffSGerd Hoffmann type = usb_ep_get_type(ep->dev, ep->pid, ep->nr); 3242b2325ffSGerd Hoffmann if (type != USB_ENDPOINT_XFER_BULK) { 3252b2325ffSGerd Hoffmann return false; 3262b2325ffSGerd Hoffmann } 3272b2325ffSGerd Hoffmann return true; 3282b2325ffSGerd Hoffmann } 3292b2325ffSGerd Hoffmann 3302b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 3312b2325ffSGerd Hoffmann 3322b2325ffSGerd Hoffmann static USBHostRequest *usb_host_req_alloc(USBHostDevice *s, USBPacket *p, 3332b2325ffSGerd Hoffmann bool in, size_t bufsize) 3342b2325ffSGerd Hoffmann { 3352b2325ffSGerd Hoffmann USBHostRequest *r = g_new0(USBHostRequest, 1); 3362b2325ffSGerd Hoffmann 3372b2325ffSGerd Hoffmann r->host = s; 3382b2325ffSGerd Hoffmann r->p = p; 3392b2325ffSGerd Hoffmann r->in = in; 3402b2325ffSGerd Hoffmann r->xfer = libusb_alloc_transfer(0); 3412b2325ffSGerd Hoffmann if (bufsize) { 3422b2325ffSGerd Hoffmann r->buffer = g_malloc(bufsize); 3432b2325ffSGerd Hoffmann } 3442b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&s->requests, r, next); 3452b2325ffSGerd Hoffmann return r; 3462b2325ffSGerd Hoffmann } 3472b2325ffSGerd Hoffmann 3482b2325ffSGerd Hoffmann static void usb_host_req_free(USBHostRequest *r) 3492b2325ffSGerd Hoffmann { 3502b2325ffSGerd Hoffmann if (r->host) { 3512b2325ffSGerd Hoffmann QTAILQ_REMOVE(&r->host->requests, r, next); 3522b2325ffSGerd Hoffmann } 3532b2325ffSGerd Hoffmann libusb_free_transfer(r->xfer); 3542b2325ffSGerd Hoffmann g_free(r->buffer); 3552b2325ffSGerd Hoffmann g_free(r); 3562b2325ffSGerd Hoffmann } 3572b2325ffSGerd Hoffmann 3582b2325ffSGerd Hoffmann static USBHostRequest *usb_host_req_find(USBHostDevice *s, USBPacket *p) 3592b2325ffSGerd Hoffmann { 3602b2325ffSGerd Hoffmann USBHostRequest *r; 3612b2325ffSGerd Hoffmann 3622b2325ffSGerd Hoffmann QTAILQ_FOREACH(r, &s->requests, next) { 3632b2325ffSGerd Hoffmann if (r->p == p) { 3642b2325ffSGerd Hoffmann return r; 3652b2325ffSGerd Hoffmann } 3662b2325ffSGerd Hoffmann } 3672b2325ffSGerd Hoffmann return NULL; 3682b2325ffSGerd Hoffmann } 3692b2325ffSGerd Hoffmann 370c16e3664SStefan Weil static void LIBUSB_CALL usb_host_req_complete_ctrl(struct libusb_transfer *xfer) 3712b2325ffSGerd Hoffmann { 3722b2325ffSGerd Hoffmann USBHostRequest *r = xfer->user_data; 3732b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 3742b2325ffSGerd Hoffmann bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE); 3752b2325ffSGerd Hoffmann 3762b2325ffSGerd Hoffmann if (r->p == NULL) { 3772b2325ffSGerd Hoffmann goto out; /* request was canceled */ 3782b2325ffSGerd Hoffmann } 3792b2325ffSGerd Hoffmann 3802b2325ffSGerd Hoffmann r->p->status = status_map[xfer->status]; 3812b2325ffSGerd Hoffmann r->p->actual_length = xfer->actual_length; 3822b2325ffSGerd Hoffmann if (r->in && xfer->actual_length) { 3832b2325ffSGerd Hoffmann memcpy(r->cbuf, r->buffer + 8, xfer->actual_length); 384b88a3e01SGerd Hoffmann 385b88a3e01SGerd Hoffmann /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices 386b88a3e01SGerd Hoffmann * to work redirected to a not superspeed capable hcd */ 387b88a3e01SGerd Hoffmann if (r->usb3ep0quirk && xfer->actual_length >= 18 && 388b88a3e01SGerd Hoffmann r->cbuf[7] == 9) { 389b88a3e01SGerd Hoffmann r->cbuf[7] = 64; 390b88a3e01SGerd Hoffmann } 3912b2325ffSGerd Hoffmann } 3922b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 3932b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 3942b2325ffSGerd Hoffmann usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p); 3952b2325ffSGerd Hoffmann 3962b2325ffSGerd Hoffmann out: 3972b2325ffSGerd Hoffmann usb_host_req_free(r); 3982b2325ffSGerd Hoffmann if (disconnect) { 3992b2325ffSGerd Hoffmann usb_host_nodev(s); 4002b2325ffSGerd Hoffmann } 4012b2325ffSGerd Hoffmann } 4022b2325ffSGerd Hoffmann 403c16e3664SStefan Weil static void LIBUSB_CALL usb_host_req_complete_data(struct libusb_transfer *xfer) 4042b2325ffSGerd Hoffmann { 4052b2325ffSGerd Hoffmann USBHostRequest *r = xfer->user_data; 4062b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 4072b2325ffSGerd Hoffmann bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE); 4082b2325ffSGerd Hoffmann 4092b2325ffSGerd Hoffmann if (r->p == NULL) { 4102b2325ffSGerd Hoffmann goto out; /* request was canceled */ 4112b2325ffSGerd Hoffmann } 4122b2325ffSGerd Hoffmann 4132b2325ffSGerd Hoffmann r->p->status = status_map[xfer->status]; 4142b2325ffSGerd Hoffmann if (r->in && xfer->actual_length) { 4152b2325ffSGerd Hoffmann usb_packet_copy(r->p, r->buffer, xfer->actual_length); 4162b2325ffSGerd Hoffmann } 4172b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 4182b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 4192b2325ffSGerd Hoffmann if (usb_host_use_combining(r->p->ep)) { 4202b2325ffSGerd Hoffmann usb_combined_input_packet_complete(USB_DEVICE(s), r->p); 4212b2325ffSGerd Hoffmann } else { 4222b2325ffSGerd Hoffmann usb_packet_complete(USB_DEVICE(s), r->p); 4232b2325ffSGerd Hoffmann } 4242b2325ffSGerd Hoffmann 4252b2325ffSGerd Hoffmann out: 4262b2325ffSGerd Hoffmann usb_host_req_free(r); 4272b2325ffSGerd Hoffmann if (disconnect) { 4282b2325ffSGerd Hoffmann usb_host_nodev(s); 4292b2325ffSGerd Hoffmann } 4302b2325ffSGerd Hoffmann } 4312b2325ffSGerd Hoffmann 4322b2325ffSGerd Hoffmann static void usb_host_req_abort(USBHostRequest *r) 4332b2325ffSGerd Hoffmann { 4342b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 43545ec2671SEd Maste bool inflight = (r->p && r->p->state == USB_PACKET_ASYNC); 4362b2325ffSGerd Hoffmann 4372b2325ffSGerd Hoffmann if (inflight) { 4382b2325ffSGerd Hoffmann r->p->status = USB_RET_NODEV; 4392b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 4402b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 4412b2325ffSGerd Hoffmann if (r->p->ep->nr == 0) { 4422b2325ffSGerd Hoffmann usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p); 4432b2325ffSGerd Hoffmann } else { 4442b2325ffSGerd Hoffmann usb_packet_complete(USB_DEVICE(s), r->p); 4452b2325ffSGerd Hoffmann } 4462b2325ffSGerd Hoffmann r->p = NULL; 4472b2325ffSGerd Hoffmann } 4482b2325ffSGerd Hoffmann 4492b2325ffSGerd Hoffmann QTAILQ_REMOVE(&r->host->requests, r, next); 4502b2325ffSGerd Hoffmann r->host = NULL; 4512b2325ffSGerd Hoffmann 4522b2325ffSGerd Hoffmann if (inflight) { 4532b2325ffSGerd Hoffmann libusb_cancel_transfer(r->xfer); 4542b2325ffSGerd Hoffmann } 4552b2325ffSGerd Hoffmann } 4562b2325ffSGerd Hoffmann 4572b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 4582b2325ffSGerd Hoffmann 459c16e3664SStefan Weil static void LIBUSB_CALL 460c16e3664SStefan Weil usb_host_req_complete_iso(struct libusb_transfer *transfer) 4612b2325ffSGerd Hoffmann { 4622b2325ffSGerd Hoffmann USBHostIsoXfer *xfer = transfer->user_data; 4632b2325ffSGerd Hoffmann 4642b2325ffSGerd Hoffmann if (!xfer) { 4652b2325ffSGerd Hoffmann /* USBHostIsoXfer released while inflight */ 4662b2325ffSGerd Hoffmann g_free(transfer->buffer); 4672b2325ffSGerd Hoffmann libusb_free_transfer(transfer); 4682b2325ffSGerd Hoffmann return; 4692b2325ffSGerd Hoffmann } 4702b2325ffSGerd Hoffmann 4712b2325ffSGerd Hoffmann QTAILQ_REMOVE(&xfer->ring->inflight, xfer, next); 4722b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&xfer->ring->inflight)) { 4732b2325ffSGerd Hoffmann USBHostDevice *s = xfer->ring->host; 4742b2325ffSGerd Hoffmann trace_usb_host_iso_stop(s->bus_num, s->addr, xfer->ring->ep->nr); 4752b2325ffSGerd Hoffmann } 4762b2325ffSGerd Hoffmann if (xfer->ring->ep->pid == USB_TOKEN_IN) { 4772b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&xfer->ring->copy, xfer, next); 478e206ddfbSGerd Hoffmann usb_wakeup(xfer->ring->ep, 0); 4792b2325ffSGerd Hoffmann } else { 4802b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&xfer->ring->unused, xfer, next); 4812b2325ffSGerd Hoffmann } 4822b2325ffSGerd Hoffmann } 4832b2325ffSGerd Hoffmann 4842b2325ffSGerd Hoffmann static USBHostIsoRing *usb_host_iso_alloc(USBHostDevice *s, USBEndpoint *ep) 4852b2325ffSGerd Hoffmann { 4862b2325ffSGerd Hoffmann USBHostIsoRing *ring = g_new0(USBHostIsoRing, 1); 4872b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 4882b2325ffSGerd Hoffmann /* FIXME: check interval (for now assume one xfer per frame) */ 4892b2325ffSGerd Hoffmann int packets = s->iso_urb_frames; 4902b2325ffSGerd Hoffmann int i; 4912b2325ffSGerd Hoffmann 4922b2325ffSGerd Hoffmann ring->host = s; 4932b2325ffSGerd Hoffmann ring->ep = ep; 4942b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->unused); 4952b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->inflight); 4962b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->copy); 4972b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&s->isorings, ring, next); 4982b2325ffSGerd Hoffmann 4992b2325ffSGerd Hoffmann for (i = 0; i < s->iso_urb_count; i++) { 5002b2325ffSGerd Hoffmann xfer = g_new0(USBHostIsoXfer, 1); 5012b2325ffSGerd Hoffmann xfer->ring = ring; 5022b2325ffSGerd Hoffmann xfer->xfer = libusb_alloc_transfer(packets); 5032b2325ffSGerd Hoffmann xfer->xfer->dev_handle = s->dh; 5042b2325ffSGerd Hoffmann xfer->xfer->type = LIBUSB_TRANSFER_TYPE_ISOCHRONOUS; 5052b2325ffSGerd Hoffmann 5062b2325ffSGerd Hoffmann xfer->xfer->endpoint = ring->ep->nr; 5072b2325ffSGerd Hoffmann if (ring->ep->pid == USB_TOKEN_IN) { 5082b2325ffSGerd Hoffmann xfer->xfer->endpoint |= USB_DIR_IN; 5092b2325ffSGerd Hoffmann } 5102b2325ffSGerd Hoffmann xfer->xfer->callback = usb_host_req_complete_iso; 5112b2325ffSGerd Hoffmann xfer->xfer->user_data = xfer; 5122b2325ffSGerd Hoffmann 5132b2325ffSGerd Hoffmann xfer->xfer->num_iso_packets = packets; 5142b2325ffSGerd Hoffmann xfer->xfer->length = ring->ep->max_packet_size * packets; 5152b2325ffSGerd Hoffmann xfer->xfer->buffer = g_malloc0(xfer->xfer->length); 5162b2325ffSGerd Hoffmann 5172b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 5182b2325ffSGerd Hoffmann } 5192b2325ffSGerd Hoffmann 5202b2325ffSGerd Hoffmann return ring; 5212b2325ffSGerd Hoffmann } 5222b2325ffSGerd Hoffmann 5232b2325ffSGerd Hoffmann static USBHostIsoRing *usb_host_iso_find(USBHostDevice *s, USBEndpoint *ep) 5242b2325ffSGerd Hoffmann { 5252b2325ffSGerd Hoffmann USBHostIsoRing *ring; 5262b2325ffSGerd Hoffmann 5272b2325ffSGerd Hoffmann QTAILQ_FOREACH(ring, &s->isorings, next) { 5282b2325ffSGerd Hoffmann if (ring->ep == ep) { 5292b2325ffSGerd Hoffmann return ring; 5302b2325ffSGerd Hoffmann } 5312b2325ffSGerd Hoffmann } 5322b2325ffSGerd Hoffmann return NULL; 5332b2325ffSGerd Hoffmann } 5342b2325ffSGerd Hoffmann 5352b2325ffSGerd Hoffmann static void usb_host_iso_reset_xfer(USBHostIsoXfer *xfer) 5362b2325ffSGerd Hoffmann { 5372b2325ffSGerd Hoffmann libusb_set_iso_packet_lengths(xfer->xfer, 5382b2325ffSGerd Hoffmann xfer->ring->ep->max_packet_size); 5392b2325ffSGerd Hoffmann xfer->packet = 0; 5402b2325ffSGerd Hoffmann xfer->copy_complete = false; 5412b2325ffSGerd Hoffmann } 5422b2325ffSGerd Hoffmann 5432b2325ffSGerd Hoffmann static void usb_host_iso_free_xfer(USBHostIsoXfer *xfer, bool inflight) 5442b2325ffSGerd Hoffmann { 5452b2325ffSGerd Hoffmann if (inflight) { 5462b2325ffSGerd Hoffmann xfer->xfer->user_data = NULL; 5472b2325ffSGerd Hoffmann } else { 5482b2325ffSGerd Hoffmann g_free(xfer->xfer->buffer); 5492b2325ffSGerd Hoffmann libusb_free_transfer(xfer->xfer); 5502b2325ffSGerd Hoffmann } 5512b2325ffSGerd Hoffmann g_free(xfer); 5522b2325ffSGerd Hoffmann } 5532b2325ffSGerd Hoffmann 5542b2325ffSGerd Hoffmann static void usb_host_iso_free(USBHostIsoRing *ring) 5552b2325ffSGerd Hoffmann { 5562b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 5572b2325ffSGerd Hoffmann 5582b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->inflight)) != NULL) { 5592b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->inflight, xfer, next); 5602b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, true); 5612b2325ffSGerd Hoffmann } 5622b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) { 5632b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 5642b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, false); 5652b2325ffSGerd Hoffmann } 5662b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL) { 5672b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 5682b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, false); 5692b2325ffSGerd Hoffmann } 5702b2325ffSGerd Hoffmann 5712b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->host->isorings, ring, next); 5722b2325ffSGerd Hoffmann g_free(ring); 5732b2325ffSGerd Hoffmann } 5742b2325ffSGerd Hoffmann 5752b2325ffSGerd Hoffmann static void usb_host_iso_free_all(USBHostDevice *s) 5762b2325ffSGerd Hoffmann { 5772b2325ffSGerd Hoffmann USBHostIsoRing *ring; 5782b2325ffSGerd Hoffmann 5792b2325ffSGerd Hoffmann while ((ring = QTAILQ_FIRST(&s->isorings)) != NULL) { 5802b2325ffSGerd Hoffmann usb_host_iso_free(ring); 5812b2325ffSGerd Hoffmann } 5822b2325ffSGerd Hoffmann } 5832b2325ffSGerd Hoffmann 5842b2325ffSGerd Hoffmann static bool usb_host_iso_data_copy(USBHostIsoXfer *xfer, USBPacket *p) 5852b2325ffSGerd Hoffmann { 5862b2325ffSGerd Hoffmann unsigned int psize; 5872b2325ffSGerd Hoffmann unsigned char *buf; 5882b2325ffSGerd Hoffmann 5892b2325ffSGerd Hoffmann buf = libusb_get_iso_packet_buffer_simple(xfer->xfer, xfer->packet); 5902b2325ffSGerd Hoffmann if (p->pid == USB_TOKEN_OUT) { 5912b2325ffSGerd Hoffmann psize = p->iov.size; 5922b2325ffSGerd Hoffmann if (psize > xfer->ring->ep->max_packet_size) { 5932b2325ffSGerd Hoffmann /* should not happen (guest bug) */ 5942b2325ffSGerd Hoffmann psize = xfer->ring->ep->max_packet_size; 5952b2325ffSGerd Hoffmann } 5962b2325ffSGerd Hoffmann xfer->xfer->iso_packet_desc[xfer->packet].length = psize; 5972b2325ffSGerd Hoffmann } else { 5982b2325ffSGerd Hoffmann psize = xfer->xfer->iso_packet_desc[xfer->packet].actual_length; 5992b2325ffSGerd Hoffmann if (psize > p->iov.size) { 6002b2325ffSGerd Hoffmann /* should not happen (guest bug) */ 6012b2325ffSGerd Hoffmann psize = p->iov.size; 6022b2325ffSGerd Hoffmann } 6032b2325ffSGerd Hoffmann } 6042b2325ffSGerd Hoffmann usb_packet_copy(p, buf, psize); 6052b2325ffSGerd Hoffmann xfer->packet++; 6062b2325ffSGerd Hoffmann xfer->copy_complete = (xfer->packet == xfer->xfer->num_iso_packets); 6072b2325ffSGerd Hoffmann return xfer->copy_complete; 6082b2325ffSGerd Hoffmann } 6092b2325ffSGerd Hoffmann 6102b2325ffSGerd Hoffmann static void usb_host_iso_data_in(USBHostDevice *s, USBPacket *p) 6112b2325ffSGerd Hoffmann { 6122b2325ffSGerd Hoffmann USBHostIsoRing *ring; 6132b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 6142b2325ffSGerd Hoffmann bool disconnect = false; 6152b2325ffSGerd Hoffmann int rc; 6162b2325ffSGerd Hoffmann 6172b2325ffSGerd Hoffmann ring = usb_host_iso_find(s, p->ep); 6182b2325ffSGerd Hoffmann if (ring == NULL) { 6192b2325ffSGerd Hoffmann ring = usb_host_iso_alloc(s, p->ep); 6202b2325ffSGerd Hoffmann } 6212b2325ffSGerd Hoffmann 6222b2325ffSGerd Hoffmann /* copy data to guest */ 6232b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->copy); 6242b2325ffSGerd Hoffmann if (xfer != NULL) { 6252b2325ffSGerd Hoffmann if (usb_host_iso_data_copy(xfer, p)) { 6262b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 6272b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 6282b2325ffSGerd Hoffmann } 6292b2325ffSGerd Hoffmann } 6302b2325ffSGerd Hoffmann 6312b2325ffSGerd Hoffmann /* submit empty bufs to host */ 6322b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) { 6332b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 6342b2325ffSGerd Hoffmann usb_host_iso_reset_xfer(xfer); 6352b2325ffSGerd Hoffmann rc = libusb_submit_transfer(xfer->xfer); 6362b2325ffSGerd Hoffmann if (rc != 0) { 6372b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_submit_transfer [iso]", rc); 6382b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 6392b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 6402b2325ffSGerd Hoffmann disconnect = true; 6412b2325ffSGerd Hoffmann } 6422b2325ffSGerd Hoffmann break; 6432b2325ffSGerd Hoffmann } 6442b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 6452b2325ffSGerd Hoffmann trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr); 6462b2325ffSGerd Hoffmann } 6472b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next); 6482b2325ffSGerd Hoffmann } 6492b2325ffSGerd Hoffmann 6502b2325ffSGerd Hoffmann if (disconnect) { 6512b2325ffSGerd Hoffmann usb_host_nodev(s); 6522b2325ffSGerd Hoffmann } 6532b2325ffSGerd Hoffmann } 6542b2325ffSGerd Hoffmann 6552b2325ffSGerd Hoffmann static void usb_host_iso_data_out(USBHostDevice *s, USBPacket *p) 6562b2325ffSGerd Hoffmann { 6572b2325ffSGerd Hoffmann USBHostIsoRing *ring; 6582b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 6592b2325ffSGerd Hoffmann bool disconnect = false; 6602b2325ffSGerd Hoffmann int rc, filled = 0; 6612b2325ffSGerd Hoffmann 6622b2325ffSGerd Hoffmann ring = usb_host_iso_find(s, p->ep); 6632b2325ffSGerd Hoffmann if (ring == NULL) { 6642b2325ffSGerd Hoffmann ring = usb_host_iso_alloc(s, p->ep); 6652b2325ffSGerd Hoffmann } 6662b2325ffSGerd Hoffmann 6672b2325ffSGerd Hoffmann /* copy data from guest */ 6682b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->copy); 6692b2325ffSGerd Hoffmann while (xfer != NULL && xfer->copy_complete) { 6702b2325ffSGerd Hoffmann filled++; 6712b2325ffSGerd Hoffmann xfer = QTAILQ_NEXT(xfer, next); 6722b2325ffSGerd Hoffmann } 6732b2325ffSGerd Hoffmann if (xfer == NULL) { 6742b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->unused); 6752b2325ffSGerd Hoffmann if (xfer == NULL) { 6762b2325ffSGerd Hoffmann trace_usb_host_iso_out_of_bufs(s->bus_num, s->addr, p->ep->nr); 6772b2325ffSGerd Hoffmann return; 6782b2325ffSGerd Hoffmann } 6792b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 6802b2325ffSGerd Hoffmann usb_host_iso_reset_xfer(xfer); 6812b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->copy, xfer, next); 6822b2325ffSGerd Hoffmann } 6832b2325ffSGerd Hoffmann usb_host_iso_data_copy(xfer, p); 6842b2325ffSGerd Hoffmann 6852b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 6862b2325ffSGerd Hoffmann /* wait until half of our buffers are filled 6872b2325ffSGerd Hoffmann before kicking the iso out stream */ 6882b2325ffSGerd Hoffmann if (filled*2 < s->iso_urb_count) { 6892b2325ffSGerd Hoffmann return; 6902b2325ffSGerd Hoffmann } 6912b2325ffSGerd Hoffmann } 6922b2325ffSGerd Hoffmann 6932b2325ffSGerd Hoffmann /* submit filled bufs to host */ 6942b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL && 6952b2325ffSGerd Hoffmann xfer->copy_complete) { 6962b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 6972b2325ffSGerd Hoffmann rc = libusb_submit_transfer(xfer->xfer); 6982b2325ffSGerd Hoffmann if (rc != 0) { 6992b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_submit_transfer [iso]", rc); 7002b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 7012b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 7022b2325ffSGerd Hoffmann disconnect = true; 7032b2325ffSGerd Hoffmann } 7042b2325ffSGerd Hoffmann break; 7052b2325ffSGerd Hoffmann } 7062b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 7072b2325ffSGerd Hoffmann trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr); 7082b2325ffSGerd Hoffmann } 7092b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next); 7102b2325ffSGerd Hoffmann } 7112b2325ffSGerd Hoffmann 7122b2325ffSGerd Hoffmann if (disconnect) { 7132b2325ffSGerd Hoffmann usb_host_nodev(s); 7142b2325ffSGerd Hoffmann } 7152b2325ffSGerd Hoffmann } 7162b2325ffSGerd Hoffmann 7172b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 7182b2325ffSGerd Hoffmann 719b88a3e01SGerd Hoffmann static void usb_host_speed_compat(USBHostDevice *s) 720c3268cc1SGerd Hoffmann { 721b88a3e01SGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 722c3268cc1SGerd Hoffmann struct libusb_config_descriptor *conf; 723c3268cc1SGerd Hoffmann const struct libusb_interface_descriptor *intf; 724c3268cc1SGerd Hoffmann const struct libusb_endpoint_descriptor *endp; 725322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 726b88a3e01SGerd Hoffmann struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp; 727b88a3e01SGerd Hoffmann #endif 728b88a3e01SGerd Hoffmann bool compat_high = true; 729b88a3e01SGerd Hoffmann bool compat_full = true; 730c3268cc1SGerd Hoffmann uint8_t type; 731c3268cc1SGerd Hoffmann int rc, c, i, a, e; 732c3268cc1SGerd Hoffmann 733c3268cc1SGerd Hoffmann for (c = 0;; c++) { 734c3268cc1SGerd Hoffmann rc = libusb_get_config_descriptor(s->dev, c, &conf); 735c3268cc1SGerd Hoffmann if (rc != 0) { 736c3268cc1SGerd Hoffmann break; 737c3268cc1SGerd Hoffmann } 738c3268cc1SGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 739c3268cc1SGerd Hoffmann for (a = 0; a < conf->interface[i].num_altsetting; a++) { 740c3268cc1SGerd Hoffmann intf = &conf->interface[i].altsetting[a]; 741c3268cc1SGerd Hoffmann for (e = 0; e < intf->bNumEndpoints; e++) { 742c3268cc1SGerd Hoffmann endp = &intf->endpoint[e]; 743c3268cc1SGerd Hoffmann type = endp->bmAttributes & 0x3; 744c3268cc1SGerd Hoffmann switch (type) { 745c3268cc1SGerd Hoffmann case 0x01: /* ISO */ 746b88a3e01SGerd Hoffmann compat_full = false; 747b88a3e01SGerd Hoffmann compat_high = false; 748b88a3e01SGerd Hoffmann break; 749b88a3e01SGerd Hoffmann case 0x02: /* BULK */ 750322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 751b88a3e01SGerd Hoffmann rc = libusb_get_ss_endpoint_companion_descriptor 752b88a3e01SGerd Hoffmann (ctx, endp, &endp_ss_comp); 753b88a3e01SGerd Hoffmann if (rc == LIBUSB_SUCCESS) { 7546a711234SGerd Hoffmann int streams = endp_ss_comp->bmAttributes & 0x1f; 7556a711234SGerd Hoffmann if (streams) { 756b88a3e01SGerd Hoffmann compat_full = false; 757b88a3e01SGerd Hoffmann compat_high = false; 758b88a3e01SGerd Hoffmann } 7596a711234SGerd Hoffmann libusb_free_ss_endpoint_companion_descriptor 7606a711234SGerd Hoffmann (endp_ss_comp); 7616a711234SGerd Hoffmann } 762b88a3e01SGerd Hoffmann #endif 763b88a3e01SGerd Hoffmann break; 764c3268cc1SGerd Hoffmann case 0x03: /* INTERRUPT */ 765c3268cc1SGerd Hoffmann if (endp->wMaxPacketSize > 64) { 766b88a3e01SGerd Hoffmann compat_full = false; 767b88a3e01SGerd Hoffmann } 768b88a3e01SGerd Hoffmann if (endp->wMaxPacketSize > 1024) { 769b88a3e01SGerd Hoffmann compat_high = false; 770c3268cc1SGerd Hoffmann } 771c3268cc1SGerd Hoffmann break; 772c3268cc1SGerd Hoffmann } 773c3268cc1SGerd Hoffmann } 774c3268cc1SGerd Hoffmann } 775c3268cc1SGerd Hoffmann } 776c3268cc1SGerd Hoffmann libusb_free_config_descriptor(conf); 777c3268cc1SGerd Hoffmann } 778b88a3e01SGerd Hoffmann 779b88a3e01SGerd Hoffmann udev->speedmask = (1 << udev->speed); 780b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_SUPER && compat_high) { 78179ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_HIGH; 782b88a3e01SGerd Hoffmann } 783b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_SUPER && compat_full) { 78479ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_FULL; 785b88a3e01SGerd Hoffmann } 786b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_HIGH && compat_full) { 78779ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_FULL; 788b88a3e01SGerd Hoffmann } 789c3268cc1SGerd Hoffmann } 790c3268cc1SGerd Hoffmann 7912b2325ffSGerd Hoffmann static void usb_host_ep_update(USBHostDevice *s) 7922b2325ffSGerd Hoffmann { 7932b2325ffSGerd Hoffmann static const char *tname[] = { 7942b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_CONTROL] = "control", 7952b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_ISOC] = "isoc", 7962b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_BULK] = "bulk", 7972b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_INT] = "int", 7982b2325ffSGerd Hoffmann }; 7992b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 8002b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 8012b2325ffSGerd Hoffmann const struct libusb_interface_descriptor *intf; 8022b2325ffSGerd Hoffmann const struct libusb_endpoint_descriptor *endp; 803322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 804b664b80fSHans de Goede struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp; 805b664b80fSHans de Goede #endif 8062b2325ffSGerd Hoffmann uint8_t devep, type; 8072b2325ffSGerd Hoffmann int pid, ep; 8082b2325ffSGerd Hoffmann int rc, i, e; 8092b2325ffSGerd Hoffmann 8102b2325ffSGerd Hoffmann usb_ep_reset(udev); 8112b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 8122b2325ffSGerd Hoffmann if (rc != 0) { 8132b2325ffSGerd Hoffmann return; 8142b2325ffSGerd Hoffmann } 8152b2325ffSGerd Hoffmann trace_usb_host_parse_config(s->bus_num, s->addr, 8162b2325ffSGerd Hoffmann conf->bConfigurationValue, true); 8172b2325ffSGerd Hoffmann 8182b2325ffSGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 8192b2325ffSGerd Hoffmann assert(udev->altsetting[i] < conf->interface[i].num_altsetting); 8202b2325ffSGerd Hoffmann intf = &conf->interface[i].altsetting[udev->altsetting[i]]; 8212b2325ffSGerd Hoffmann trace_usb_host_parse_interface(s->bus_num, s->addr, 8222b2325ffSGerd Hoffmann intf->bInterfaceNumber, 8232b2325ffSGerd Hoffmann intf->bAlternateSetting, true); 8242b2325ffSGerd Hoffmann for (e = 0; e < intf->bNumEndpoints; e++) { 8252b2325ffSGerd Hoffmann endp = &intf->endpoint[e]; 8262b2325ffSGerd Hoffmann 8272b2325ffSGerd Hoffmann devep = endp->bEndpointAddress; 8282b2325ffSGerd Hoffmann pid = (devep & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT; 8292b2325ffSGerd Hoffmann ep = devep & 0xf; 8302b2325ffSGerd Hoffmann type = endp->bmAttributes & 0x3; 8312b2325ffSGerd Hoffmann 8322b2325ffSGerd Hoffmann if (ep == 0) { 8332b2325ffSGerd Hoffmann trace_usb_host_parse_error(s->bus_num, s->addr, 8342b2325ffSGerd Hoffmann "invalid endpoint address"); 8352b2325ffSGerd Hoffmann return; 8362b2325ffSGerd Hoffmann } 8372b2325ffSGerd Hoffmann if (usb_ep_get_type(udev, pid, ep) != USB_ENDPOINT_XFER_INVALID) { 8382b2325ffSGerd Hoffmann trace_usb_host_parse_error(s->bus_num, s->addr, 8392b2325ffSGerd Hoffmann "duplicate endpoint address"); 8402b2325ffSGerd Hoffmann return; 8412b2325ffSGerd Hoffmann } 8422b2325ffSGerd Hoffmann 8432b2325ffSGerd Hoffmann trace_usb_host_parse_endpoint(s->bus_num, s->addr, ep, 8442b2325ffSGerd Hoffmann (devep & USB_DIR_IN) ? "in" : "out", 8452b2325ffSGerd Hoffmann tname[type], true); 8462b2325ffSGerd Hoffmann usb_ep_set_max_packet_size(udev, pid, ep, 8472b2325ffSGerd Hoffmann endp->wMaxPacketSize); 8482b2325ffSGerd Hoffmann usb_ep_set_type(udev, pid, ep, type); 8492b2325ffSGerd Hoffmann usb_ep_set_ifnum(udev, pid, ep, i); 8502b2325ffSGerd Hoffmann usb_ep_set_halted(udev, pid, ep, 0); 851322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 852b664b80fSHans de Goede if (type == LIBUSB_TRANSFER_TYPE_BULK && 853b664b80fSHans de Goede libusb_get_ss_endpoint_companion_descriptor(ctx, endp, 854b664b80fSHans de Goede &endp_ss_comp) == LIBUSB_SUCCESS) { 855b664b80fSHans de Goede usb_ep_set_max_streams(udev, pid, ep, 856b664b80fSHans de Goede endp_ss_comp->bmAttributes); 857b664b80fSHans de Goede libusb_free_ss_endpoint_companion_descriptor(endp_ss_comp); 858b664b80fSHans de Goede } 859b664b80fSHans de Goede #endif 8602b2325ffSGerd Hoffmann } 8612b2325ffSGerd Hoffmann } 8622b2325ffSGerd Hoffmann 8632b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 8642b2325ffSGerd Hoffmann } 8652b2325ffSGerd Hoffmann 8662b2325ffSGerd Hoffmann static int usb_host_open(USBHostDevice *s, libusb_device *dev) 8672b2325ffSGerd Hoffmann { 8682b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 8692b2325ffSGerd Hoffmann int bus_num = libusb_get_bus_number(dev); 8702b2325ffSGerd Hoffmann int addr = libusb_get_device_address(dev); 8712b2325ffSGerd Hoffmann int rc; 8727d553f27SGonglei Error *local_err = NULL; 8732b2325ffSGerd Hoffmann 874*3280ea8eSGerd Hoffmann if (s->bh_postld_pending) { 875*3280ea8eSGerd Hoffmann return -1; 876*3280ea8eSGerd Hoffmann } 877*3280ea8eSGerd Hoffmann 8782b2325ffSGerd Hoffmann trace_usb_host_open_started(bus_num, addr); 8792b2325ffSGerd Hoffmann 8802b2325ffSGerd Hoffmann if (s->dh != NULL) { 8812b2325ffSGerd Hoffmann goto fail; 8822b2325ffSGerd Hoffmann } 8832b2325ffSGerd Hoffmann rc = libusb_open(dev, &s->dh); 8842b2325ffSGerd Hoffmann if (rc != 0) { 8852b2325ffSGerd Hoffmann goto fail; 8862b2325ffSGerd Hoffmann } 8872b2325ffSGerd Hoffmann 8882b2325ffSGerd Hoffmann s->dev = dev; 8892b2325ffSGerd Hoffmann s->bus_num = bus_num; 8902b2325ffSGerd Hoffmann s->addr = addr; 891f34d5c75SHans de Goede 892f34d5c75SHans de Goede usb_host_detach_kernel(s); 893f34d5c75SHans de Goede 894f34d5c75SHans de Goede libusb_get_device_descriptor(dev, &s->ddesc); 8952b2325ffSGerd Hoffmann usb_host_get_port(s->dev, s->port, sizeof(s->port)); 8962b2325ffSGerd Hoffmann 8972b2325ffSGerd Hoffmann usb_ep_init(udev); 8982b2325ffSGerd Hoffmann usb_host_ep_update(s); 8992b2325ffSGerd Hoffmann 9002b2325ffSGerd Hoffmann udev->speed = speed_map[libusb_get_device_speed(dev)]; 901b88a3e01SGerd Hoffmann usb_host_speed_compat(s); 9022b2325ffSGerd Hoffmann 9032b2325ffSGerd Hoffmann if (s->ddesc.iProduct) { 9042b2325ffSGerd Hoffmann libusb_get_string_descriptor_ascii(s->dh, s->ddesc.iProduct, 9052b2325ffSGerd Hoffmann (unsigned char *)udev->product_desc, 9062b2325ffSGerd Hoffmann sizeof(udev->product_desc)); 9072b2325ffSGerd Hoffmann } else { 9082b2325ffSGerd Hoffmann snprintf(udev->product_desc, sizeof(udev->product_desc), 9092b2325ffSGerd Hoffmann "host:%d.%d", bus_num, addr); 9102b2325ffSGerd Hoffmann } 9112b2325ffSGerd Hoffmann 9127d553f27SGonglei usb_device_attach(udev, &local_err); 9137d553f27SGonglei if (local_err) { 914565f65d2SMarkus Armbruster error_report_err(local_err); 9152b2325ffSGerd Hoffmann goto fail; 9162b2325ffSGerd Hoffmann } 9172b2325ffSGerd Hoffmann 9182b2325ffSGerd Hoffmann trace_usb_host_open_success(bus_num, addr); 9192b2325ffSGerd Hoffmann return 0; 9202b2325ffSGerd Hoffmann 9212b2325ffSGerd Hoffmann fail: 9222b2325ffSGerd Hoffmann trace_usb_host_open_failure(bus_num, addr); 9232b2325ffSGerd Hoffmann if (s->dh != NULL) { 9246110ce59SLin Ma usb_host_release_interfaces(s); 9256110ce59SLin Ma libusb_reset_device(s->dh); 9266110ce59SLin Ma usb_host_attach_kernel(s); 9272b2325ffSGerd Hoffmann libusb_close(s->dh); 9282b2325ffSGerd Hoffmann s->dh = NULL; 9292b2325ffSGerd Hoffmann s->dev = NULL; 9302b2325ffSGerd Hoffmann } 9312b2325ffSGerd Hoffmann return -1; 9322b2325ffSGerd Hoffmann } 9332b2325ffSGerd Hoffmann 9342b2325ffSGerd Hoffmann static void usb_host_abort_xfers(USBHostDevice *s) 9352b2325ffSGerd Hoffmann { 9362b2325ffSGerd Hoffmann USBHostRequest *r, *rtmp; 9372b2325ffSGerd Hoffmann 9382b2325ffSGerd Hoffmann QTAILQ_FOREACH_SAFE(r, &s->requests, next, rtmp) { 9392b2325ffSGerd Hoffmann usb_host_req_abort(r); 9402b2325ffSGerd Hoffmann } 9412b2325ffSGerd Hoffmann } 9422b2325ffSGerd Hoffmann 9432b2325ffSGerd Hoffmann static int usb_host_close(USBHostDevice *s) 9442b2325ffSGerd Hoffmann { 9452b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 9462b2325ffSGerd Hoffmann 9472b2325ffSGerd Hoffmann if (s->dh == NULL) { 9482b2325ffSGerd Hoffmann return -1; 9492b2325ffSGerd Hoffmann } 9502b2325ffSGerd Hoffmann 9512b2325ffSGerd Hoffmann trace_usb_host_close(s->bus_num, s->addr); 9522b2325ffSGerd Hoffmann 9532b2325ffSGerd Hoffmann usb_host_abort_xfers(s); 9542b2325ffSGerd Hoffmann usb_host_iso_free_all(s); 9552b2325ffSGerd Hoffmann 9562b2325ffSGerd Hoffmann if (udev->attached) { 9572b2325ffSGerd Hoffmann usb_device_detach(udev); 9582b2325ffSGerd Hoffmann } 9592b2325ffSGerd Hoffmann 9602b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 9612b2325ffSGerd Hoffmann libusb_reset_device(s->dh); 9622b2325ffSGerd Hoffmann usb_host_attach_kernel(s); 9632b2325ffSGerd Hoffmann libusb_close(s->dh); 9642b2325ffSGerd Hoffmann s->dh = NULL; 9652b2325ffSGerd Hoffmann s->dev = NULL; 9662b2325ffSGerd Hoffmann 9672b2325ffSGerd Hoffmann usb_host_auto_check(NULL); 9682b2325ffSGerd Hoffmann return 0; 9692b2325ffSGerd Hoffmann } 9702b2325ffSGerd Hoffmann 9712b2325ffSGerd Hoffmann static void usb_host_nodev_bh(void *opaque) 9722b2325ffSGerd Hoffmann { 9732b2325ffSGerd Hoffmann USBHostDevice *s = opaque; 9742b2325ffSGerd Hoffmann usb_host_close(s); 9752b2325ffSGerd Hoffmann } 9762b2325ffSGerd Hoffmann 9772b2325ffSGerd Hoffmann static void usb_host_nodev(USBHostDevice *s) 9782b2325ffSGerd Hoffmann { 97995efb20cSGerd Hoffmann if (!s->bh_nodev) { 98095efb20cSGerd Hoffmann s->bh_nodev = qemu_bh_new(usb_host_nodev_bh, s); 9812b2325ffSGerd Hoffmann } 98295efb20cSGerd Hoffmann qemu_bh_schedule(s->bh_nodev); 9832b2325ffSGerd Hoffmann } 9842b2325ffSGerd Hoffmann 9852b2325ffSGerd Hoffmann static void usb_host_exit_notifier(struct Notifier *n, void *data) 9862b2325ffSGerd Hoffmann { 9872b2325ffSGerd Hoffmann USBHostDevice *s = container_of(n, USBHostDevice, exit); 9882b2325ffSGerd Hoffmann 9892b2325ffSGerd Hoffmann if (s->dh) { 9902b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 9912b2325ffSGerd Hoffmann usb_host_attach_kernel(s); 9922b2325ffSGerd Hoffmann } 9932b2325ffSGerd Hoffmann } 9942b2325ffSGerd Hoffmann 995e058fa2dSGerd Hoffmann static libusb_device *usb_host_find_ref(int bus, int addr) 996e058fa2dSGerd Hoffmann { 997e058fa2dSGerd Hoffmann libusb_device **devs = NULL; 998e058fa2dSGerd Hoffmann libusb_device *ret = NULL; 999e058fa2dSGerd Hoffmann int i, n; 1000e058fa2dSGerd Hoffmann 1001e058fa2dSGerd Hoffmann if (usb_host_init() != 0) { 1002e058fa2dSGerd Hoffmann return NULL; 1003e058fa2dSGerd Hoffmann } 1004e058fa2dSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 1005e058fa2dSGerd Hoffmann for (i = 0; i < n; i++) { 1006e058fa2dSGerd Hoffmann if (libusb_get_bus_number(devs[i]) == bus && 1007e058fa2dSGerd Hoffmann libusb_get_device_address(devs[i]) == addr) { 1008e058fa2dSGerd Hoffmann ret = libusb_ref_device(devs[i]); 1009e058fa2dSGerd Hoffmann break; 1010e058fa2dSGerd Hoffmann } 1011e058fa2dSGerd Hoffmann } 1012e058fa2dSGerd Hoffmann libusb_free_device_list(devs, 1); 1013e058fa2dSGerd Hoffmann return ret; 1014e058fa2dSGerd Hoffmann } 1015e058fa2dSGerd Hoffmann 10162aa76dc1SGonglei static void usb_host_realize(USBDevice *udev, Error **errp) 10172b2325ffSGerd Hoffmann { 10182b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 1019e058fa2dSGerd Hoffmann libusb_device *ldev; 1020e058fa2dSGerd Hoffmann int rc; 10212b2325ffSGerd Hoffmann 1022f3cda6e0SGerd Hoffmann if (s->match.vendor_id > 0xffff) { 10232aa76dc1SGonglei error_setg(errp, "vendorid out of range"); 10242aa76dc1SGonglei return; 1025f3cda6e0SGerd Hoffmann } 1026f3cda6e0SGerd Hoffmann if (s->match.product_id > 0xffff) { 10272aa76dc1SGonglei error_setg(errp, "productid out of range"); 10282aa76dc1SGonglei return; 1029f3cda6e0SGerd Hoffmann } 1030f3cda6e0SGerd Hoffmann if (s->match.addr > 127) { 10312aa76dc1SGonglei error_setg(errp, "hostaddr out of range"); 10322aa76dc1SGonglei return; 1033f3cda6e0SGerd Hoffmann } 1034f3cda6e0SGerd Hoffmann 10352b2325ffSGerd Hoffmann loglevel = s->loglevel; 1036628e5485SGerd Hoffmann udev->flags |= (1 << USB_DEV_FLAG_IS_HOST); 10372b2325ffSGerd Hoffmann udev->auto_attach = 0; 10382b2325ffSGerd Hoffmann QTAILQ_INIT(&s->requests); 10392b2325ffSGerd Hoffmann QTAILQ_INIT(&s->isorings); 10402b2325ffSGerd Hoffmann 1041e058fa2dSGerd Hoffmann if (s->match.addr && s->match.bus_num && 1042e058fa2dSGerd Hoffmann !s->match.vendor_id && 1043e058fa2dSGerd Hoffmann !s->match.product_id && 1044e058fa2dSGerd Hoffmann !s->match.port) { 1045e058fa2dSGerd Hoffmann s->needs_autoscan = false; 1046e058fa2dSGerd Hoffmann ldev = usb_host_find_ref(s->match.bus_num, 1047e058fa2dSGerd Hoffmann s->match.addr); 1048e058fa2dSGerd Hoffmann if (!ldev) { 1049e058fa2dSGerd Hoffmann error_setg(errp, "failed to find host usb device %d:%d", 1050e058fa2dSGerd Hoffmann s->match.bus_num, s->match.addr); 1051e058fa2dSGerd Hoffmann return; 1052e058fa2dSGerd Hoffmann } 1053e058fa2dSGerd Hoffmann rc = usb_host_open(s, ldev); 1054e058fa2dSGerd Hoffmann libusb_unref_device(ldev); 1055e058fa2dSGerd Hoffmann if (rc < 0) { 1056e058fa2dSGerd Hoffmann error_setg(errp, "failed to open host usb device %d:%d", 1057e058fa2dSGerd Hoffmann s->match.bus_num, s->match.addr); 1058e058fa2dSGerd Hoffmann return; 1059e058fa2dSGerd Hoffmann } 1060e058fa2dSGerd Hoffmann } else { 1061e058fa2dSGerd Hoffmann s->needs_autoscan = true; 10622b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&hostdevs, s, next); 10632b2325ffSGerd Hoffmann usb_host_auto_check(NULL); 10642b2325ffSGerd Hoffmann } 10652b2325ffSGerd Hoffmann 1066e058fa2dSGerd Hoffmann s->exit.notify = usb_host_exit_notifier; 1067e058fa2dSGerd Hoffmann qemu_add_exit_notifier(&s->exit); 1068e058fa2dSGerd Hoffmann } 1069e058fa2dSGerd Hoffmann 1070e6adae52SGonglei static void usb_host_instance_init(Object *obj) 1071e6adae52SGonglei { 1072e6adae52SGonglei USBDevice *udev = USB_DEVICE(obj); 1073e6adae52SGonglei USBHostDevice *s = USB_HOST_DEVICE(udev); 1074e6adae52SGonglei 1075e6adae52SGonglei device_add_bootindex_property(obj, &s->bootindex, 1076e6adae52SGonglei "bootindex", NULL, 1077e6adae52SGonglei &udev->qdev, NULL); 1078e6adae52SGonglei } 1079e6adae52SGonglei 1080c4fe9700SMarc-André Lureau static void usb_host_unrealize(USBDevice *udev, Error **errp) 10812b2325ffSGerd Hoffmann { 10822b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 10832b2325ffSGerd Hoffmann 10842b2325ffSGerd Hoffmann qemu_remove_exit_notifier(&s->exit); 1085e058fa2dSGerd Hoffmann if (s->needs_autoscan) { 10862b2325ffSGerd Hoffmann QTAILQ_REMOVE(&hostdevs, s, next); 1087e058fa2dSGerd Hoffmann } 10882b2325ffSGerd Hoffmann usb_host_close(s); 10892b2325ffSGerd Hoffmann } 10902b2325ffSGerd Hoffmann 10912b2325ffSGerd Hoffmann static void usb_host_cancel_packet(USBDevice *udev, USBPacket *p) 10922b2325ffSGerd Hoffmann { 10932b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 10942b2325ffSGerd Hoffmann USBHostRequest *r; 10952b2325ffSGerd Hoffmann 10962b2325ffSGerd Hoffmann if (p->combined) { 10972b2325ffSGerd Hoffmann usb_combined_packet_cancel(udev, p); 10982b2325ffSGerd Hoffmann return; 10992b2325ffSGerd Hoffmann } 11002b2325ffSGerd Hoffmann 11012b2325ffSGerd Hoffmann trace_usb_host_req_canceled(s->bus_num, s->addr, p); 11022b2325ffSGerd Hoffmann 11032b2325ffSGerd Hoffmann r = usb_host_req_find(s, p); 11042b2325ffSGerd Hoffmann if (r && r->p) { 11052b2325ffSGerd Hoffmann r->p = NULL; /* mark as dead */ 11062b2325ffSGerd Hoffmann libusb_cancel_transfer(r->xfer); 11072b2325ffSGerd Hoffmann } 11082b2325ffSGerd Hoffmann } 11092b2325ffSGerd Hoffmann 11102b2325ffSGerd Hoffmann static void usb_host_detach_kernel(USBHostDevice *s) 11112b2325ffSGerd Hoffmann { 11122b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 11132b2325ffSGerd Hoffmann int rc, i; 11142b2325ffSGerd Hoffmann 11152b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11162b2325ffSGerd Hoffmann if (rc != 0) { 11172b2325ffSGerd Hoffmann return; 11182b2325ffSGerd Hoffmann } 1119896b6757SSamuel Brian for (i = 0; i < USB_MAX_INTERFACES; i++) { 11202b2325ffSGerd Hoffmann rc = libusb_kernel_driver_active(s->dh, i); 11212b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_kernel_driver_active", rc); 11222b2325ffSGerd Hoffmann if (rc != 1) { 11232b2325ffSGerd Hoffmann continue; 11242b2325ffSGerd Hoffmann } 11252b2325ffSGerd Hoffmann trace_usb_host_detach_kernel(s->bus_num, s->addr, i); 11262b2325ffSGerd Hoffmann rc = libusb_detach_kernel_driver(s->dh, i); 11272b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_detach_kernel_driver", rc); 11282b2325ffSGerd Hoffmann s->ifs[i].detached = true; 11292b2325ffSGerd Hoffmann } 11302b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11312b2325ffSGerd Hoffmann } 11322b2325ffSGerd Hoffmann 11332b2325ffSGerd Hoffmann static void usb_host_attach_kernel(USBHostDevice *s) 11342b2325ffSGerd Hoffmann { 11352b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 11362b2325ffSGerd Hoffmann int rc, i; 11372b2325ffSGerd Hoffmann 11382b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11392b2325ffSGerd Hoffmann if (rc != 0) { 11402b2325ffSGerd Hoffmann return; 11412b2325ffSGerd Hoffmann } 1142896b6757SSamuel Brian for (i = 0; i < USB_MAX_INTERFACES; i++) { 11432b2325ffSGerd Hoffmann if (!s->ifs[i].detached) { 11442b2325ffSGerd Hoffmann continue; 11452b2325ffSGerd Hoffmann } 11462b2325ffSGerd Hoffmann trace_usb_host_attach_kernel(s->bus_num, s->addr, i); 11472b2325ffSGerd Hoffmann libusb_attach_kernel_driver(s->dh, i); 11482b2325ffSGerd Hoffmann s->ifs[i].detached = false; 11492b2325ffSGerd Hoffmann } 11502b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11512b2325ffSGerd Hoffmann } 11522b2325ffSGerd Hoffmann 11532b2325ffSGerd Hoffmann static int usb_host_claim_interfaces(USBHostDevice *s, int configuration) 11542b2325ffSGerd Hoffmann { 11552b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 11562b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 1157896b6757SSamuel Brian int rc, i, claimed; 11582b2325ffSGerd Hoffmann 11592b2325ffSGerd Hoffmann for (i = 0; i < USB_MAX_INTERFACES; i++) { 11602b2325ffSGerd Hoffmann udev->altsetting[i] = 0; 11612b2325ffSGerd Hoffmann } 11622b2325ffSGerd Hoffmann udev->ninterfaces = 0; 11632b2325ffSGerd Hoffmann udev->configuration = 0; 11642b2325ffSGerd Hoffmann 11652b2325ffSGerd Hoffmann usb_host_detach_kernel(s); 11662b2325ffSGerd Hoffmann 11672b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11682b2325ffSGerd Hoffmann if (rc != 0) { 11691294ca79SHans de Goede if (rc == LIBUSB_ERROR_NOT_FOUND) { 11701294ca79SHans de Goede /* address state - ignore */ 11711294ca79SHans de Goede return USB_RET_SUCCESS; 11721294ca79SHans de Goede } 11732b2325ffSGerd Hoffmann return USB_RET_STALL; 11742b2325ffSGerd Hoffmann } 11752b2325ffSGerd Hoffmann 1176896b6757SSamuel Brian claimed = 0; 1177896b6757SSamuel Brian for (i = 0; i < USB_MAX_INTERFACES; i++) { 11782b2325ffSGerd Hoffmann trace_usb_host_claim_interface(s->bus_num, s->addr, configuration, i); 11792b2325ffSGerd Hoffmann rc = libusb_claim_interface(s->dh, i); 1180896b6757SSamuel Brian if (rc == 0) { 11812b2325ffSGerd Hoffmann s->ifs[i].claimed = true; 1182896b6757SSamuel Brian if (++claimed == conf->bNumInterfaces) { 1183896b6757SSamuel Brian break; 1184896b6757SSamuel Brian } 1185896b6757SSamuel Brian } 1186896b6757SSamuel Brian } 1187896b6757SSamuel Brian if (claimed != conf->bNumInterfaces) { 1188896b6757SSamuel Brian return USB_RET_STALL; 11892b2325ffSGerd Hoffmann } 11902b2325ffSGerd Hoffmann 11912b2325ffSGerd Hoffmann udev->ninterfaces = conf->bNumInterfaces; 11922b2325ffSGerd Hoffmann udev->configuration = configuration; 11932b2325ffSGerd Hoffmann 11942b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11952b2325ffSGerd Hoffmann return USB_RET_SUCCESS; 11962b2325ffSGerd Hoffmann } 11972b2325ffSGerd Hoffmann 11982b2325ffSGerd Hoffmann static void usb_host_release_interfaces(USBHostDevice *s) 11992b2325ffSGerd Hoffmann { 12002b2325ffSGerd Hoffmann int i, rc; 12012b2325ffSGerd Hoffmann 1202896b6757SSamuel Brian for (i = 0; i < USB_MAX_INTERFACES; i++) { 12032b2325ffSGerd Hoffmann if (!s->ifs[i].claimed) { 12042b2325ffSGerd Hoffmann continue; 12052b2325ffSGerd Hoffmann } 12062b2325ffSGerd Hoffmann trace_usb_host_release_interface(s->bus_num, s->addr, i); 12072b2325ffSGerd Hoffmann rc = libusb_release_interface(s->dh, i); 12082b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_release_interface", rc); 12092b2325ffSGerd Hoffmann s->ifs[i].claimed = false; 12102b2325ffSGerd Hoffmann } 12112b2325ffSGerd Hoffmann } 12122b2325ffSGerd Hoffmann 12132b2325ffSGerd Hoffmann static void usb_host_set_address(USBHostDevice *s, int addr) 12142b2325ffSGerd Hoffmann { 12152b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 12162b2325ffSGerd Hoffmann 12172b2325ffSGerd Hoffmann trace_usb_host_set_address(s->bus_num, s->addr, addr); 12182b2325ffSGerd Hoffmann udev->addr = addr; 12192b2325ffSGerd Hoffmann } 12202b2325ffSGerd Hoffmann 12212b2325ffSGerd Hoffmann static void usb_host_set_config(USBHostDevice *s, int config, USBPacket *p) 12222b2325ffSGerd Hoffmann { 12232b2325ffSGerd Hoffmann int rc; 12242b2325ffSGerd Hoffmann 12252b2325ffSGerd Hoffmann trace_usb_host_set_config(s->bus_num, s->addr, config); 12262b2325ffSGerd Hoffmann 12272b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 12282b2325ffSGerd Hoffmann rc = libusb_set_configuration(s->dh, config); 12292b2325ffSGerd Hoffmann if (rc != 0) { 12302b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_set_configuration", rc); 12312b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12322b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 12332b2325ffSGerd Hoffmann usb_host_nodev(s); 12342b2325ffSGerd Hoffmann } 12352b2325ffSGerd Hoffmann return; 12362b2325ffSGerd Hoffmann } 12372b2325ffSGerd Hoffmann p->status = usb_host_claim_interfaces(s, config); 12382b2325ffSGerd Hoffmann if (p->status != USB_RET_SUCCESS) { 12392b2325ffSGerd Hoffmann return; 12402b2325ffSGerd Hoffmann } 12412b2325ffSGerd Hoffmann usb_host_ep_update(s); 12422b2325ffSGerd Hoffmann } 12432b2325ffSGerd Hoffmann 12442b2325ffSGerd Hoffmann static void usb_host_set_interface(USBHostDevice *s, int iface, int alt, 12452b2325ffSGerd Hoffmann USBPacket *p) 12462b2325ffSGerd Hoffmann { 12472b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 12482b2325ffSGerd Hoffmann int rc; 12492b2325ffSGerd Hoffmann 12502b2325ffSGerd Hoffmann trace_usb_host_set_interface(s->bus_num, s->addr, iface, alt); 12512b2325ffSGerd Hoffmann 12522b2325ffSGerd Hoffmann usb_host_iso_free_all(s); 12532b2325ffSGerd Hoffmann 12542b2325ffSGerd Hoffmann if (iface >= USB_MAX_INTERFACES) { 12552b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12562b2325ffSGerd Hoffmann return; 12572b2325ffSGerd Hoffmann } 12582b2325ffSGerd Hoffmann 12592b2325ffSGerd Hoffmann rc = libusb_set_interface_alt_setting(s->dh, iface, alt); 12602b2325ffSGerd Hoffmann if (rc != 0) { 12612b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_set_interface_alt_setting", rc); 12622b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12632b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 12642b2325ffSGerd Hoffmann usb_host_nodev(s); 12652b2325ffSGerd Hoffmann } 12662b2325ffSGerd Hoffmann return; 12672b2325ffSGerd Hoffmann } 12682b2325ffSGerd Hoffmann 12692b2325ffSGerd Hoffmann udev->altsetting[iface] = alt; 12702b2325ffSGerd Hoffmann usb_host_ep_update(s); 12712b2325ffSGerd Hoffmann } 12722b2325ffSGerd Hoffmann 12732b2325ffSGerd Hoffmann static void usb_host_handle_control(USBDevice *udev, USBPacket *p, 12742b2325ffSGerd Hoffmann int request, int value, int index, 12752b2325ffSGerd Hoffmann int length, uint8_t *data) 12762b2325ffSGerd Hoffmann { 12772b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 12782b2325ffSGerd Hoffmann USBHostRequest *r; 12792b2325ffSGerd Hoffmann int rc; 12802b2325ffSGerd Hoffmann 12812b2325ffSGerd Hoffmann trace_usb_host_req_control(s->bus_num, s->addr, p, request, value, index); 12822b2325ffSGerd Hoffmann 12832b2325ffSGerd Hoffmann if (s->dh == NULL) { 12842b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 12852b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12862b2325ffSGerd Hoffmann return; 12872b2325ffSGerd Hoffmann } 12882b2325ffSGerd Hoffmann 12892b2325ffSGerd Hoffmann switch (request) { 12902b2325ffSGerd Hoffmann case DeviceOutRequest | USB_REQ_SET_ADDRESS: 12912b2325ffSGerd Hoffmann usb_host_set_address(s, value); 12922b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12932b2325ffSGerd Hoffmann return; 12942b2325ffSGerd Hoffmann 12952b2325ffSGerd Hoffmann case DeviceOutRequest | USB_REQ_SET_CONFIGURATION: 12962b2325ffSGerd Hoffmann usb_host_set_config(s, value & 0xff, p); 12972b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12982b2325ffSGerd Hoffmann return; 12992b2325ffSGerd Hoffmann 13002b2325ffSGerd Hoffmann case InterfaceOutRequest | USB_REQ_SET_INTERFACE: 13012b2325ffSGerd Hoffmann usb_host_set_interface(s, index, value, p); 13022b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13032b2325ffSGerd Hoffmann return; 13042b2325ffSGerd Hoffmann 13052b2325ffSGerd Hoffmann case EndpointOutRequest | USB_REQ_CLEAR_FEATURE: 13062b2325ffSGerd Hoffmann if (value == 0) { /* clear halt */ 13072b2325ffSGerd Hoffmann int pid = (index & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT; 13082b2325ffSGerd Hoffmann libusb_clear_halt(s->dh, index); 13092b2325ffSGerd Hoffmann usb_ep_set_halted(udev, pid, index & 0x0f, 0); 13102b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13112b2325ffSGerd Hoffmann return; 13122b2325ffSGerd Hoffmann } 13132b2325ffSGerd Hoffmann } 13142b2325ffSGerd Hoffmann 13152b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, (request >> 8) & USB_DIR_IN, length + 8); 13162b2325ffSGerd Hoffmann r->cbuf = data; 13172b2325ffSGerd Hoffmann r->clen = length; 13182b2325ffSGerd Hoffmann memcpy(r->buffer, udev->setup_buf, 8); 13192b2325ffSGerd Hoffmann if (!r->in) { 13202b2325ffSGerd Hoffmann memcpy(r->buffer + 8, r->cbuf, r->clen); 13212b2325ffSGerd Hoffmann } 13222b2325ffSGerd Hoffmann 1323b88a3e01SGerd Hoffmann /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices 1324b88a3e01SGerd Hoffmann * to work redirected to a not superspeed capable hcd */ 1325a9be4e7cSGerd Hoffmann if ((udev->speedmask & USB_SPEED_MASK_SUPER) && 132672517114Slijun !(udev->port->speedmask & USB_SPEED_MASK_SUPER) && 1327b88a3e01SGerd Hoffmann request == 0x8006 && value == 0x100 && index == 0) { 1328b88a3e01SGerd Hoffmann r->usb3ep0quirk = true; 1329b88a3e01SGerd Hoffmann } 1330b88a3e01SGerd Hoffmann 13312b2325ffSGerd Hoffmann libusb_fill_control_transfer(r->xfer, s->dh, r->buffer, 13322b2325ffSGerd Hoffmann usb_host_req_complete_ctrl, r, 13332b2325ffSGerd Hoffmann CONTROL_TIMEOUT); 13342b2325ffSGerd Hoffmann rc = libusb_submit_transfer(r->xfer); 13352b2325ffSGerd Hoffmann if (rc != 0) { 13362b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 13372b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 13382b2325ffSGerd Hoffmann p->status, p->actual_length); 13392b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 13402b2325ffSGerd Hoffmann usb_host_nodev(s); 13412b2325ffSGerd Hoffmann } 13422b2325ffSGerd Hoffmann return; 13432b2325ffSGerd Hoffmann } 13442b2325ffSGerd Hoffmann 13452b2325ffSGerd Hoffmann p->status = USB_RET_ASYNC; 13462b2325ffSGerd Hoffmann } 13472b2325ffSGerd Hoffmann 13482b2325ffSGerd Hoffmann static void usb_host_handle_data(USBDevice *udev, USBPacket *p) 13492b2325ffSGerd Hoffmann { 13502b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 13512b2325ffSGerd Hoffmann USBHostRequest *r; 13522b2325ffSGerd Hoffmann size_t size; 13532b2325ffSGerd Hoffmann int ep, rc; 13542b2325ffSGerd Hoffmann 13552b2325ffSGerd Hoffmann if (usb_host_use_combining(p->ep) && p->state == USB_PACKET_SETUP) { 13562b2325ffSGerd Hoffmann p->status = USB_RET_ADD_TO_QUEUE; 13572b2325ffSGerd Hoffmann return; 13582b2325ffSGerd Hoffmann } 13592b2325ffSGerd Hoffmann 13602b2325ffSGerd Hoffmann trace_usb_host_req_data(s->bus_num, s->addr, p, 13612b2325ffSGerd Hoffmann p->pid == USB_TOKEN_IN, 13622b2325ffSGerd Hoffmann p->ep->nr, p->iov.size); 13632b2325ffSGerd Hoffmann 13642b2325ffSGerd Hoffmann if (s->dh == NULL) { 13652b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 13662b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13672b2325ffSGerd Hoffmann return; 13682b2325ffSGerd Hoffmann } 13692b2325ffSGerd Hoffmann if (p->ep->halted) { 13702b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 13712b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13722b2325ffSGerd Hoffmann return; 13732b2325ffSGerd Hoffmann } 13742b2325ffSGerd Hoffmann 13752b2325ffSGerd Hoffmann switch (usb_ep_get_type(udev, p->pid, p->ep->nr)) { 13762b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_BULK: 13772b2325ffSGerd Hoffmann size = usb_packet_size(p); 13782b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, size); 13792b2325ffSGerd Hoffmann if (!r->in) { 13802b2325ffSGerd Hoffmann usb_packet_copy(p, r->buffer, size); 13812b2325ffSGerd Hoffmann } 13822b2325ffSGerd Hoffmann ep = p->ep->nr | (r->in ? USB_DIR_IN : 0); 13838d1bd3c9SHans de Goede if (p->stream) { 1384322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 13858d1bd3c9SHans de Goede libusb_fill_bulk_stream_transfer(r->xfer, s->dh, ep, p->stream, 13868d1bd3c9SHans de Goede r->buffer, size, 13878d1bd3c9SHans de Goede usb_host_req_complete_data, r, 13888d1bd3c9SHans de Goede BULK_TIMEOUT); 13898d1bd3c9SHans de Goede #else 13908d1bd3c9SHans de Goede usb_host_req_free(r); 13918d1bd3c9SHans de Goede p->status = USB_RET_STALL; 13928d1bd3c9SHans de Goede return; 13938d1bd3c9SHans de Goede #endif 13948d1bd3c9SHans de Goede } else { 13952b2325ffSGerd Hoffmann libusb_fill_bulk_transfer(r->xfer, s->dh, ep, 13962b2325ffSGerd Hoffmann r->buffer, size, 13972b2325ffSGerd Hoffmann usb_host_req_complete_data, r, 13982b2325ffSGerd Hoffmann BULK_TIMEOUT); 13998d1bd3c9SHans de Goede } 14002b2325ffSGerd Hoffmann break; 14012b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_INT: 14022b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, p->iov.size); 14032b2325ffSGerd Hoffmann if (!r->in) { 14042b2325ffSGerd Hoffmann usb_packet_copy(p, r->buffer, p->iov.size); 14052b2325ffSGerd Hoffmann } 14062b2325ffSGerd Hoffmann ep = p->ep->nr | (r->in ? USB_DIR_IN : 0); 14072b2325ffSGerd Hoffmann libusb_fill_interrupt_transfer(r->xfer, s->dh, ep, 14082b2325ffSGerd Hoffmann r->buffer, p->iov.size, 14092b2325ffSGerd Hoffmann usb_host_req_complete_data, r, 14102b2325ffSGerd Hoffmann INTR_TIMEOUT); 14112b2325ffSGerd Hoffmann break; 14122b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_ISOC: 14132b2325ffSGerd Hoffmann if (p->pid == USB_TOKEN_IN) { 14142b2325ffSGerd Hoffmann usb_host_iso_data_in(s, p); 14152b2325ffSGerd Hoffmann } else { 14162b2325ffSGerd Hoffmann usb_host_iso_data_out(s, p); 14172b2325ffSGerd Hoffmann } 14182b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 14192b2325ffSGerd Hoffmann p->status, p->actual_length); 14202b2325ffSGerd Hoffmann return; 14212b2325ffSGerd Hoffmann default: 14222b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 14232b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 14242b2325ffSGerd Hoffmann p->status, p->actual_length); 14252b2325ffSGerd Hoffmann return; 14262b2325ffSGerd Hoffmann } 14272b2325ffSGerd Hoffmann 14282b2325ffSGerd Hoffmann rc = libusb_submit_transfer(r->xfer); 14292b2325ffSGerd Hoffmann if (rc != 0) { 14302b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 14312b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 14322b2325ffSGerd Hoffmann p->status, p->actual_length); 14332b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 14342b2325ffSGerd Hoffmann usb_host_nodev(s); 14352b2325ffSGerd Hoffmann } 14362b2325ffSGerd Hoffmann return; 14372b2325ffSGerd Hoffmann } 14382b2325ffSGerd Hoffmann 14392b2325ffSGerd Hoffmann p->status = USB_RET_ASYNC; 14402b2325ffSGerd Hoffmann } 14412b2325ffSGerd Hoffmann 14422b2325ffSGerd Hoffmann static void usb_host_flush_ep_queue(USBDevice *dev, USBEndpoint *ep) 14432b2325ffSGerd Hoffmann { 14442b2325ffSGerd Hoffmann if (usb_host_use_combining(ep)) { 14452b2325ffSGerd Hoffmann usb_ep_combine_input_packets(ep); 14462b2325ffSGerd Hoffmann } 14472b2325ffSGerd Hoffmann } 14482b2325ffSGerd Hoffmann 14492b2325ffSGerd Hoffmann static void usb_host_handle_reset(USBDevice *udev) 14502b2325ffSGerd Hoffmann { 14512b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 14525af35d7fSHans de Goede int rc; 14532b2325ffSGerd Hoffmann 14542b2325ffSGerd Hoffmann trace_usb_host_reset(s->bus_num, s->addr); 14552b2325ffSGerd Hoffmann 14565af35d7fSHans de Goede rc = libusb_reset_device(s->dh); 14575af35d7fSHans de Goede if (rc != 0) { 14585af35d7fSHans de Goede usb_host_nodev(s); 14592b2325ffSGerd Hoffmann } 14602b2325ffSGerd Hoffmann } 14612b2325ffSGerd Hoffmann 146256a9f180SHans de Goede static int usb_host_alloc_streams(USBDevice *udev, USBEndpoint **eps, 146356a9f180SHans de Goede int nr_eps, int streams) 146456a9f180SHans de Goede { 1465322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 146656a9f180SHans de Goede USBHostDevice *s = USB_HOST_DEVICE(udev); 146756a9f180SHans de Goede unsigned char endpoints[30]; 146856a9f180SHans de Goede int i, rc; 146956a9f180SHans de Goede 147056a9f180SHans de Goede for (i = 0; i < nr_eps; i++) { 147156a9f180SHans de Goede endpoints[i] = eps[i]->nr; 147256a9f180SHans de Goede if (eps[i]->pid == USB_TOKEN_IN) { 147356a9f180SHans de Goede endpoints[i] |= 0x80; 147456a9f180SHans de Goede } 147556a9f180SHans de Goede } 147656a9f180SHans de Goede rc = libusb_alloc_streams(s->dh, streams, endpoints, nr_eps); 147756a9f180SHans de Goede if (rc < 0) { 147856a9f180SHans de Goede usb_host_libusb_error("libusb_alloc_streams", rc); 147956a9f180SHans de Goede } else if (rc != streams) { 14802e6a0dd1SGonglei error_report("libusb_alloc_streams: got less streams " 14812e6a0dd1SGonglei "then requested %d < %d", rc, streams); 148256a9f180SHans de Goede } 148356a9f180SHans de Goede 148456a9f180SHans de Goede return (rc == streams) ? 0 : -1; 148556a9f180SHans de Goede #else 14862e6a0dd1SGonglei error_report("libusb_alloc_streams: error not implemented"); 148756a9f180SHans de Goede return -1; 148856a9f180SHans de Goede #endif 148956a9f180SHans de Goede } 149056a9f180SHans de Goede 149156a9f180SHans de Goede static void usb_host_free_streams(USBDevice *udev, USBEndpoint **eps, 149256a9f180SHans de Goede int nr_eps) 149356a9f180SHans de Goede { 1494322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 149556a9f180SHans de Goede USBHostDevice *s = USB_HOST_DEVICE(udev); 149656a9f180SHans de Goede unsigned char endpoints[30]; 149756a9f180SHans de Goede int i; 149856a9f180SHans de Goede 149956a9f180SHans de Goede for (i = 0; i < nr_eps; i++) { 150056a9f180SHans de Goede endpoints[i] = eps[i]->nr; 150156a9f180SHans de Goede if (eps[i]->pid == USB_TOKEN_IN) { 150256a9f180SHans de Goede endpoints[i] |= 0x80; 150356a9f180SHans de Goede } 150456a9f180SHans de Goede } 150556a9f180SHans de Goede libusb_free_streams(s->dh, endpoints, nr_eps); 150656a9f180SHans de Goede #endif 150756a9f180SHans de Goede } 150856a9f180SHans de Goede 150995efb20cSGerd Hoffmann /* 151095efb20cSGerd Hoffmann * This is *NOT* about restoring state. We have absolutely no idea 151195efb20cSGerd Hoffmann * what state the host device is in at the moment and whenever it is 151295efb20cSGerd Hoffmann * still present in the first place. Attemping to contine where we 151395efb20cSGerd Hoffmann * left off is impossible. 151495efb20cSGerd Hoffmann * 1515b6af0975SDaniel P. Berrange * What we are going to do here is emulate a surprise removal of 151695efb20cSGerd Hoffmann * the usb device passed through, then kick host scan so the device 151795efb20cSGerd Hoffmann * will get re-attached (and re-initialized by the guest) in case it 151895efb20cSGerd Hoffmann * is still present. 151995efb20cSGerd Hoffmann * 152095efb20cSGerd Hoffmann * As the device removal will change the state of other devices (usb 152195efb20cSGerd Hoffmann * host controller, most likely interrupt controller too) we have to 152295efb20cSGerd Hoffmann * wait with it until *all* vmstate is loaded. Thus post_load just 152395efb20cSGerd Hoffmann * kicks a bottom half which then does the actual work. 152495efb20cSGerd Hoffmann */ 152595efb20cSGerd Hoffmann static void usb_host_post_load_bh(void *opaque) 152695efb20cSGerd Hoffmann { 152795efb20cSGerd Hoffmann USBHostDevice *dev = opaque; 152895efb20cSGerd Hoffmann USBDevice *udev = USB_DEVICE(dev); 152995efb20cSGerd Hoffmann 153095efb20cSGerd Hoffmann if (dev->dh != NULL) { 153195efb20cSGerd Hoffmann usb_host_close(dev); 153295efb20cSGerd Hoffmann } 153395efb20cSGerd Hoffmann if (udev->attached) { 153495efb20cSGerd Hoffmann usb_device_detach(udev); 153595efb20cSGerd Hoffmann } 1536*3280ea8eSGerd Hoffmann dev->bh_postld_pending = false; 153795efb20cSGerd Hoffmann usb_host_auto_check(NULL); 153895efb20cSGerd Hoffmann } 153995efb20cSGerd Hoffmann 154095efb20cSGerd Hoffmann static int usb_host_post_load(void *opaque, int version_id) 154195efb20cSGerd Hoffmann { 154295efb20cSGerd Hoffmann USBHostDevice *dev = opaque; 154395efb20cSGerd Hoffmann 154495efb20cSGerd Hoffmann if (!dev->bh_postld) { 154595efb20cSGerd Hoffmann dev->bh_postld = qemu_bh_new(usb_host_post_load_bh, dev); 154695efb20cSGerd Hoffmann } 154795efb20cSGerd Hoffmann qemu_bh_schedule(dev->bh_postld); 1548*3280ea8eSGerd Hoffmann dev->bh_postld_pending = true; 154995efb20cSGerd Hoffmann return 0; 155095efb20cSGerd Hoffmann } 155195efb20cSGerd Hoffmann 15522b2325ffSGerd Hoffmann static const VMStateDescription vmstate_usb_host = { 15532b2325ffSGerd Hoffmann .name = "usb-host", 155495efb20cSGerd Hoffmann .version_id = 1, 155595efb20cSGerd Hoffmann .minimum_version_id = 1, 155695efb20cSGerd Hoffmann .post_load = usb_host_post_load, 15572b2325ffSGerd Hoffmann .fields = (VMStateField[]) { 15582b2325ffSGerd Hoffmann VMSTATE_USB_DEVICE(parent_obj, USBHostDevice), 15592b2325ffSGerd Hoffmann VMSTATE_END_OF_LIST() 15602b2325ffSGerd Hoffmann } 15612b2325ffSGerd Hoffmann }; 15622b2325ffSGerd Hoffmann 15632b2325ffSGerd Hoffmann static Property usb_host_dev_properties[] = { 15642b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("hostbus", USBHostDevice, match.bus_num, 0), 15652b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("hostaddr", USBHostDevice, match.addr, 0), 15662b2325ffSGerd Hoffmann DEFINE_PROP_STRING("hostport", USBHostDevice, match.port), 1567c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT32("vendorid", USBHostDevice, match.vendor_id, 0), 1568c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT32("productid", USBHostDevice, match.product_id, 0), 15692b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("isobufs", USBHostDevice, iso_urb_count, 4), 15702b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("isobsize", USBHostDevice, iso_urb_frames, 32), 15712b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("loglevel", USBHostDevice, loglevel, 15722b2325ffSGerd Hoffmann LIBUSB_LOG_LEVEL_WARNING), 15732b2325ffSGerd Hoffmann DEFINE_PROP_BIT("pipeline", USBHostDevice, options, 15742b2325ffSGerd Hoffmann USB_HOST_OPT_PIPELINE, true), 15752b2325ffSGerd Hoffmann DEFINE_PROP_END_OF_LIST(), 15762b2325ffSGerd Hoffmann }; 15772b2325ffSGerd Hoffmann 15782b2325ffSGerd Hoffmann static void usb_host_class_initfn(ObjectClass *klass, void *data) 15792b2325ffSGerd Hoffmann { 15802b2325ffSGerd Hoffmann DeviceClass *dc = DEVICE_CLASS(klass); 15812b2325ffSGerd Hoffmann USBDeviceClass *uc = USB_DEVICE_CLASS(klass); 15822b2325ffSGerd Hoffmann 15832aa76dc1SGonglei uc->realize = usb_host_realize; 15842b2325ffSGerd Hoffmann uc->product_desc = "USB Host Device"; 15852b2325ffSGerd Hoffmann uc->cancel_packet = usb_host_cancel_packet; 15862b2325ffSGerd Hoffmann uc->handle_data = usb_host_handle_data; 15872b2325ffSGerd Hoffmann uc->handle_control = usb_host_handle_control; 15882b2325ffSGerd Hoffmann uc->handle_reset = usb_host_handle_reset; 1589c4fe9700SMarc-André Lureau uc->unrealize = usb_host_unrealize; 15902b2325ffSGerd Hoffmann uc->flush_ep_queue = usb_host_flush_ep_queue; 159156a9f180SHans de Goede uc->alloc_streams = usb_host_alloc_streams; 159256a9f180SHans de Goede uc->free_streams = usb_host_free_streams; 15932b2325ffSGerd Hoffmann dc->vmsd = &vmstate_usb_host; 15942b2325ffSGerd Hoffmann dc->props = usb_host_dev_properties; 1595125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); 15962b2325ffSGerd Hoffmann } 15972b2325ffSGerd Hoffmann 15982b2325ffSGerd Hoffmann static TypeInfo usb_host_dev_info = { 15992b2325ffSGerd Hoffmann .name = TYPE_USB_HOST_DEVICE, 16002b2325ffSGerd Hoffmann .parent = TYPE_USB_DEVICE, 16012b2325ffSGerd Hoffmann .instance_size = sizeof(USBHostDevice), 16022b2325ffSGerd Hoffmann .class_init = usb_host_class_initfn, 1603e6adae52SGonglei .instance_init = usb_host_instance_init, 16042b2325ffSGerd Hoffmann }; 16052b2325ffSGerd Hoffmann 16062b2325ffSGerd Hoffmann static void usb_host_register_types(void) 16072b2325ffSGerd Hoffmann { 16082b2325ffSGerd Hoffmann type_register_static(&usb_host_dev_info); 16092b2325ffSGerd Hoffmann } 16102b2325ffSGerd Hoffmann 16112b2325ffSGerd Hoffmann type_init(usb_host_register_types) 16122b2325ffSGerd Hoffmann 16132b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 16142b2325ffSGerd Hoffmann 16152b2325ffSGerd Hoffmann static QEMUTimer *usb_auto_timer; 16162b2325ffSGerd Hoffmann static VMChangeStateEntry *usb_vmstate; 16172b2325ffSGerd Hoffmann 16182b2325ffSGerd Hoffmann static void usb_host_vm_state(void *unused, int running, RunState state) 16192b2325ffSGerd Hoffmann { 16202b2325ffSGerd Hoffmann if (running) { 16212b2325ffSGerd Hoffmann usb_host_auto_check(unused); 16222b2325ffSGerd Hoffmann } 16232b2325ffSGerd Hoffmann } 16242b2325ffSGerd Hoffmann 16252b2325ffSGerd Hoffmann static void usb_host_auto_check(void *unused) 16262b2325ffSGerd Hoffmann { 16272b2325ffSGerd Hoffmann struct USBHostDevice *s; 16282b2325ffSGerd Hoffmann struct USBAutoFilter *f; 16293ce21445SJincheng Miao libusb_device **devs = NULL; 16302b2325ffSGerd Hoffmann struct libusb_device_descriptor ddesc; 16312b2325ffSGerd Hoffmann int unconnected = 0; 16322b2325ffSGerd Hoffmann int i, n; 16332b2325ffSGerd Hoffmann 16342b2325ffSGerd Hoffmann if (usb_host_init() != 0) { 16352b2325ffSGerd Hoffmann return; 16362b2325ffSGerd Hoffmann } 16372b2325ffSGerd Hoffmann 16382b2325ffSGerd Hoffmann if (runstate_is_running()) { 16392b2325ffSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 16402b2325ffSGerd Hoffmann for (i = 0; i < n; i++) { 16412b2325ffSGerd Hoffmann if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) { 16422b2325ffSGerd Hoffmann continue; 16432b2325ffSGerd Hoffmann } 16442b2325ffSGerd Hoffmann if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) { 16452b2325ffSGerd Hoffmann continue; 16462b2325ffSGerd Hoffmann } 16472b2325ffSGerd Hoffmann QTAILQ_FOREACH(s, &hostdevs, next) { 16482b2325ffSGerd Hoffmann f = &s->match; 16492b2325ffSGerd Hoffmann if (f->bus_num > 0 && 16502b2325ffSGerd Hoffmann f->bus_num != libusb_get_bus_number(devs[i])) { 16512b2325ffSGerd Hoffmann continue; 16522b2325ffSGerd Hoffmann } 16532b2325ffSGerd Hoffmann if (f->addr > 0 && 16542b2325ffSGerd Hoffmann f->addr != libusb_get_device_address(devs[i])) { 16552b2325ffSGerd Hoffmann continue; 16562b2325ffSGerd Hoffmann } 16572b2325ffSGerd Hoffmann if (f->port != NULL) { 16582b2325ffSGerd Hoffmann char port[16] = "-"; 16592b2325ffSGerd Hoffmann usb_host_get_port(devs[i], port, sizeof(port)); 16602b2325ffSGerd Hoffmann if (strcmp(f->port, port) != 0) { 16612b2325ffSGerd Hoffmann continue; 16622b2325ffSGerd Hoffmann } 16632b2325ffSGerd Hoffmann } 16642b2325ffSGerd Hoffmann if (f->vendor_id > 0 && 16652b2325ffSGerd Hoffmann f->vendor_id != ddesc.idVendor) { 16662b2325ffSGerd Hoffmann continue; 16672b2325ffSGerd Hoffmann } 16682b2325ffSGerd Hoffmann if (f->product_id > 0 && 16692b2325ffSGerd Hoffmann f->product_id != ddesc.idProduct) { 16702b2325ffSGerd Hoffmann continue; 16712b2325ffSGerd Hoffmann } 16722b2325ffSGerd Hoffmann 16732b2325ffSGerd Hoffmann /* We got a match */ 16742b2325ffSGerd Hoffmann s->seen++; 16752b2325ffSGerd Hoffmann if (s->errcount >= 3) { 16762b2325ffSGerd Hoffmann continue; 16772b2325ffSGerd Hoffmann } 16782b2325ffSGerd Hoffmann if (s->dh != NULL) { 16792b2325ffSGerd Hoffmann continue; 16802b2325ffSGerd Hoffmann } 16812b2325ffSGerd Hoffmann if (usb_host_open(s, devs[i]) < 0) { 16822b2325ffSGerd Hoffmann s->errcount++; 16832b2325ffSGerd Hoffmann continue; 16842b2325ffSGerd Hoffmann } 16852b2325ffSGerd Hoffmann break; 16862b2325ffSGerd Hoffmann } 16872b2325ffSGerd Hoffmann } 16882b2325ffSGerd Hoffmann libusb_free_device_list(devs, 1); 16892b2325ffSGerd Hoffmann 16902b2325ffSGerd Hoffmann QTAILQ_FOREACH(s, &hostdevs, next) { 16912b2325ffSGerd Hoffmann if (s->dh == NULL) { 16922b2325ffSGerd Hoffmann unconnected++; 16932b2325ffSGerd Hoffmann } 16942b2325ffSGerd Hoffmann if (s->seen == 0) { 16952b2325ffSGerd Hoffmann if (s->dh) { 16962b2325ffSGerd Hoffmann usb_host_close(s); 16972b2325ffSGerd Hoffmann } 16982b2325ffSGerd Hoffmann s->errcount = 0; 16992b2325ffSGerd Hoffmann } 17002b2325ffSGerd Hoffmann s->seen = 0; 17012b2325ffSGerd Hoffmann } 17022b2325ffSGerd Hoffmann 17032b2325ffSGerd Hoffmann #if 0 17042b2325ffSGerd Hoffmann if (unconnected == 0) { 17052b2325ffSGerd Hoffmann /* nothing to watch */ 17062b2325ffSGerd Hoffmann if (usb_auto_timer) { 1707bc72ad67SAlex Bligh timer_del(usb_auto_timer); 17082b2325ffSGerd Hoffmann trace_usb_host_auto_scan_disabled(); 17092b2325ffSGerd Hoffmann } 17102b2325ffSGerd Hoffmann return; 17112b2325ffSGerd Hoffmann } 17122b2325ffSGerd Hoffmann #endif 17132b2325ffSGerd Hoffmann } 17142b2325ffSGerd Hoffmann 17152b2325ffSGerd Hoffmann if (!usb_vmstate) { 17162b2325ffSGerd Hoffmann usb_vmstate = qemu_add_vm_change_state_handler(usb_host_vm_state, NULL); 17172b2325ffSGerd Hoffmann } 17182b2325ffSGerd Hoffmann if (!usb_auto_timer) { 1719bc72ad67SAlex Bligh usb_auto_timer = timer_new_ms(QEMU_CLOCK_REALTIME, usb_host_auto_check, NULL); 17202b2325ffSGerd Hoffmann if (!usb_auto_timer) { 17212b2325ffSGerd Hoffmann return; 17222b2325ffSGerd Hoffmann } 17232b2325ffSGerd Hoffmann trace_usb_host_auto_scan_enabled(); 17242b2325ffSGerd Hoffmann } 1725bc72ad67SAlex Bligh timer_mod(usb_auto_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 2000); 17262b2325ffSGerd Hoffmann } 17272b2325ffSGerd Hoffmann 1728b99260ebSThomas Huth /** 1729b99260ebSThomas Huth * Check whether USB host device has a USB mass storage SCSI interface 1730b99260ebSThomas Huth */ 1731b99260ebSThomas Huth bool usb_host_dev_is_scsi_storage(USBDevice *ud) 1732b99260ebSThomas Huth { 1733b99260ebSThomas Huth USBHostDevice *uhd = USB_HOST_DEVICE(ud); 1734b99260ebSThomas Huth struct libusb_config_descriptor *conf; 1735b99260ebSThomas Huth const struct libusb_interface_descriptor *intf; 1736b99260ebSThomas Huth bool is_scsi_storage = false; 1737b99260ebSThomas Huth int i; 1738b99260ebSThomas Huth 1739b99260ebSThomas Huth if (!uhd || libusb_get_active_config_descriptor(uhd->dev, &conf) != 0) { 1740b99260ebSThomas Huth return false; 1741b99260ebSThomas Huth } 1742b99260ebSThomas Huth 1743b99260ebSThomas Huth for (i = 0; i < conf->bNumInterfaces; i++) { 1744b99260ebSThomas Huth intf = &conf->interface[i].altsetting[ud->altsetting[i]]; 1745b99260ebSThomas Huth if (intf->bInterfaceClass == LIBUSB_CLASS_MASS_STORAGE && 1746b99260ebSThomas Huth intf->bInterfaceSubClass == 6) { /* 6 means SCSI */ 1747b99260ebSThomas Huth is_scsi_storage = true; 1748b99260ebSThomas Huth break; 1749b99260ebSThomas Huth } 1750b99260ebSThomas Huth } 1751b99260ebSThomas Huth 1752b99260ebSThomas Huth libusb_free_config_descriptor(conf); 1753b99260ebSThomas Huth 1754b99260ebSThomas Huth return is_scsi_storage; 1755b99260ebSThomas Huth } 1756b99260ebSThomas Huth 17571ce6be24SMarkus Armbruster void hmp_info_usbhost(Monitor *mon, const QDict *qdict) 17582b2325ffSGerd Hoffmann { 17593ce21445SJincheng Miao libusb_device **devs = NULL; 17602b2325ffSGerd Hoffmann struct libusb_device_descriptor ddesc; 17612b2325ffSGerd Hoffmann char port[16]; 17622b2325ffSGerd Hoffmann int i, n; 17632b2325ffSGerd Hoffmann 17642b2325ffSGerd Hoffmann if (usb_host_init() != 0) { 17652b2325ffSGerd Hoffmann return; 17662b2325ffSGerd Hoffmann } 17672b2325ffSGerd Hoffmann 17682b2325ffSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 17692b2325ffSGerd Hoffmann for (i = 0; i < n; i++) { 17702b2325ffSGerd Hoffmann if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) { 17712b2325ffSGerd Hoffmann continue; 17722b2325ffSGerd Hoffmann } 17732b2325ffSGerd Hoffmann if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) { 17742b2325ffSGerd Hoffmann continue; 17752b2325ffSGerd Hoffmann } 17762b2325ffSGerd Hoffmann usb_host_get_port(devs[i], port, sizeof(port)); 17772b2325ffSGerd Hoffmann monitor_printf(mon, " Bus %d, Addr %d, Port %s, Speed %s Mb/s\n", 17782b2325ffSGerd Hoffmann libusb_get_bus_number(devs[i]), 17792b2325ffSGerd Hoffmann libusb_get_device_address(devs[i]), 17802b2325ffSGerd Hoffmann port, 17812b2325ffSGerd Hoffmann speed_name[libusb_get_device_speed(devs[i])]); 17822b2325ffSGerd Hoffmann monitor_printf(mon, " Class %02x:", ddesc.bDeviceClass); 17832b2325ffSGerd Hoffmann monitor_printf(mon, " USB device %04x:%04x", 17842b2325ffSGerd Hoffmann ddesc.idVendor, ddesc.idProduct); 17852b2325ffSGerd Hoffmann if (ddesc.iProduct) { 17862b2325ffSGerd Hoffmann libusb_device_handle *handle; 17872b2325ffSGerd Hoffmann if (libusb_open(devs[i], &handle) == 0) { 17882b2325ffSGerd Hoffmann unsigned char name[64] = ""; 17892b2325ffSGerd Hoffmann libusb_get_string_descriptor_ascii(handle, 17902b2325ffSGerd Hoffmann ddesc.iProduct, 17912b2325ffSGerd Hoffmann name, sizeof(name)); 17922b2325ffSGerd Hoffmann libusb_close(handle); 17932b2325ffSGerd Hoffmann monitor_printf(mon, ", %s", name); 17942b2325ffSGerd Hoffmann } 17952b2325ffSGerd Hoffmann } 17962b2325ffSGerd Hoffmann monitor_printf(mon, "\n"); 17972b2325ffSGerd Hoffmann } 17982b2325ffSGerd Hoffmann libusb_free_device_list(devs, 1); 17992b2325ffSGerd Hoffmann } 1800