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; 1052b2325ffSGerd Hoffmann Notifier exit; 1062b2325ffSGerd Hoffmann 1072b2325ffSGerd Hoffmann /* request queues */ 1082b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostRequest) requests; 1092b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoRing) isorings; 1102b2325ffSGerd Hoffmann }; 1112b2325ffSGerd Hoffmann 1122b2325ffSGerd Hoffmann struct USBHostRequest { 1132b2325ffSGerd Hoffmann USBHostDevice *host; 1142b2325ffSGerd Hoffmann USBPacket *p; 1152b2325ffSGerd Hoffmann bool in; 1162b2325ffSGerd Hoffmann struct libusb_transfer *xfer; 1172b2325ffSGerd Hoffmann unsigned char *buffer; 1182b2325ffSGerd Hoffmann unsigned char *cbuf; 1192b2325ffSGerd Hoffmann unsigned int clen; 120b88a3e01SGerd Hoffmann bool usb3ep0quirk; 1212b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostRequest) next; 1222b2325ffSGerd Hoffmann }; 1232b2325ffSGerd Hoffmann 1242b2325ffSGerd Hoffmann struct USBHostIsoXfer { 1252b2325ffSGerd Hoffmann USBHostIsoRing *ring; 1262b2325ffSGerd Hoffmann struct libusb_transfer *xfer; 1272b2325ffSGerd Hoffmann bool copy_complete; 1282b2325ffSGerd Hoffmann unsigned int packet; 1292b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostIsoXfer) next; 1302b2325ffSGerd Hoffmann }; 1312b2325ffSGerd Hoffmann 1322b2325ffSGerd Hoffmann struct USBHostIsoRing { 1332b2325ffSGerd Hoffmann USBHostDevice *host; 1342b2325ffSGerd Hoffmann USBEndpoint *ep; 1352b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) unused; 1362b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) inflight; 1372b2325ffSGerd Hoffmann QTAILQ_HEAD(, USBHostIsoXfer) copy; 1382b2325ffSGerd Hoffmann QTAILQ_ENTRY(USBHostIsoRing) next; 1392b2325ffSGerd Hoffmann }; 1402b2325ffSGerd Hoffmann 1412b2325ffSGerd Hoffmann static QTAILQ_HEAD(, USBHostDevice) hostdevs = 1422b2325ffSGerd Hoffmann QTAILQ_HEAD_INITIALIZER(hostdevs); 1432b2325ffSGerd Hoffmann 1442b2325ffSGerd Hoffmann static void usb_host_auto_check(void *unused); 1452b2325ffSGerd Hoffmann static void usb_host_release_interfaces(USBHostDevice *s); 1462b2325ffSGerd Hoffmann static void usb_host_nodev(USBHostDevice *s); 147f34d5c75SHans de Goede static void usb_host_detach_kernel(USBHostDevice *s); 1482b2325ffSGerd Hoffmann static void usb_host_attach_kernel(USBHostDevice *s); 1492b2325ffSGerd Hoffmann 1502b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 1512b2325ffSGerd Hoffmann 1521e03e407SChris Johns #ifndef LIBUSB_LOG_LEVEL_WARNING /* older libusb didn't define these */ 1531e03e407SChris Johns #define LIBUSB_LOG_LEVEL_WARNING 2 1541e03e407SChris Johns #endif 1551e03e407SChris Johns 1561e03e407SChris Johns /* ------------------------------------------------------------------------ */ 1571e03e407SChris Johns 1582b2325ffSGerd Hoffmann #define CONTROL_TIMEOUT 10000 /* 10 sec */ 1592b2325ffSGerd Hoffmann #define BULK_TIMEOUT 0 /* unlimited */ 1602b2325ffSGerd Hoffmann #define INTR_TIMEOUT 0 /* unlimited */ 1612b2325ffSGerd Hoffmann 162322fd1f4SGerd Hoffmann #if LIBUSBX_API_VERSION >= 0x01000103 163322fd1f4SGerd Hoffmann # define HAVE_STREAMS 1 164322fd1f4SGerd Hoffmann #endif 165322fd1f4SGerd Hoffmann 1662b2325ffSGerd Hoffmann static const char *speed_name[] = { 1672b2325ffSGerd Hoffmann [LIBUSB_SPEED_UNKNOWN] = "?", 1682b2325ffSGerd Hoffmann [LIBUSB_SPEED_LOW] = "1.5", 1692b2325ffSGerd Hoffmann [LIBUSB_SPEED_FULL] = "12", 1702b2325ffSGerd Hoffmann [LIBUSB_SPEED_HIGH] = "480", 1712b2325ffSGerd Hoffmann [LIBUSB_SPEED_SUPER] = "5000", 1722b2325ffSGerd Hoffmann }; 1732b2325ffSGerd Hoffmann 1742b2325ffSGerd Hoffmann static const unsigned int speed_map[] = { 1752b2325ffSGerd Hoffmann [LIBUSB_SPEED_LOW] = USB_SPEED_LOW, 1762b2325ffSGerd Hoffmann [LIBUSB_SPEED_FULL] = USB_SPEED_FULL, 1772b2325ffSGerd Hoffmann [LIBUSB_SPEED_HIGH] = USB_SPEED_HIGH, 1782b2325ffSGerd Hoffmann [LIBUSB_SPEED_SUPER] = USB_SPEED_SUPER, 1792b2325ffSGerd Hoffmann }; 1802b2325ffSGerd Hoffmann 1812b2325ffSGerd Hoffmann static const unsigned int status_map[] = { 1822b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_COMPLETED] = USB_RET_SUCCESS, 1832b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_ERROR] = USB_RET_IOERROR, 1842b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_TIMED_OUT] = USB_RET_IOERROR, 1852b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_CANCELLED] = USB_RET_IOERROR, 1862b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_STALL] = USB_RET_STALL, 1872b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_NO_DEVICE] = USB_RET_NODEV, 1882b2325ffSGerd Hoffmann [LIBUSB_TRANSFER_OVERFLOW] = USB_RET_BABBLE, 1892b2325ffSGerd Hoffmann }; 1902b2325ffSGerd Hoffmann 1912b2325ffSGerd Hoffmann static const char *err_names[] = { 1922b2325ffSGerd Hoffmann [-LIBUSB_ERROR_IO] = "IO", 1932b2325ffSGerd Hoffmann [-LIBUSB_ERROR_INVALID_PARAM] = "INVALID_PARAM", 1942b2325ffSGerd Hoffmann [-LIBUSB_ERROR_ACCESS] = "ACCESS", 1952b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NO_DEVICE] = "NO_DEVICE", 1962b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NOT_FOUND] = "NOT_FOUND", 1972b2325ffSGerd Hoffmann [-LIBUSB_ERROR_BUSY] = "BUSY", 1982b2325ffSGerd Hoffmann [-LIBUSB_ERROR_TIMEOUT] = "TIMEOUT", 1992b2325ffSGerd Hoffmann [-LIBUSB_ERROR_OVERFLOW] = "OVERFLOW", 2002b2325ffSGerd Hoffmann [-LIBUSB_ERROR_PIPE] = "PIPE", 2012b2325ffSGerd Hoffmann [-LIBUSB_ERROR_INTERRUPTED] = "INTERRUPTED", 2022b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NO_MEM] = "NO_MEM", 2032b2325ffSGerd Hoffmann [-LIBUSB_ERROR_NOT_SUPPORTED] = "NOT_SUPPORTED", 2042b2325ffSGerd Hoffmann [-LIBUSB_ERROR_OTHER] = "OTHER", 2052b2325ffSGerd Hoffmann }; 2062b2325ffSGerd Hoffmann 2072b2325ffSGerd Hoffmann static libusb_context *ctx; 2082b2325ffSGerd Hoffmann static uint32_t loglevel; 2092b2325ffSGerd Hoffmann 210a277c3e0SStefan Weil #ifndef CONFIG_WIN32 211a277c3e0SStefan Weil 2122b2325ffSGerd Hoffmann static void usb_host_handle_fd(void *opaque) 2132b2325ffSGerd Hoffmann { 2142b2325ffSGerd Hoffmann struct timeval tv = { 0, 0 }; 2152b2325ffSGerd Hoffmann libusb_handle_events_timeout(ctx, &tv); 2162b2325ffSGerd Hoffmann } 2172b2325ffSGerd Hoffmann 2182b2325ffSGerd Hoffmann static void usb_host_add_fd(int fd, short events, void *user_data) 2192b2325ffSGerd Hoffmann { 2202b2325ffSGerd Hoffmann qemu_set_fd_handler(fd, 2212b2325ffSGerd Hoffmann (events & POLLIN) ? usb_host_handle_fd : NULL, 2222b2325ffSGerd Hoffmann (events & POLLOUT) ? usb_host_handle_fd : NULL, 2232b2325ffSGerd Hoffmann ctx); 2242b2325ffSGerd Hoffmann } 2252b2325ffSGerd Hoffmann 2262b2325ffSGerd Hoffmann static void usb_host_del_fd(int fd, void *user_data) 2272b2325ffSGerd Hoffmann { 2282b2325ffSGerd Hoffmann qemu_set_fd_handler(fd, NULL, NULL, NULL); 2292b2325ffSGerd Hoffmann } 2302b2325ffSGerd Hoffmann 231a277c3e0SStefan Weil #endif /* !CONFIG_WIN32 */ 232a277c3e0SStefan Weil 2332b2325ffSGerd Hoffmann static int usb_host_init(void) 2342b2325ffSGerd Hoffmann { 235a277c3e0SStefan Weil #ifndef CONFIG_WIN32 2362b2325ffSGerd Hoffmann const struct libusb_pollfd **poll; 237a277c3e0SStefan Weil #endif 238*3bf2b3a1SStefan Weil int rc; 2392b2325ffSGerd Hoffmann 2402b2325ffSGerd Hoffmann if (ctx) { 2412b2325ffSGerd Hoffmann return 0; 2422b2325ffSGerd Hoffmann } 2432b2325ffSGerd Hoffmann rc = libusb_init(&ctx); 2442b2325ffSGerd Hoffmann if (rc != 0) { 2452b2325ffSGerd Hoffmann return -1; 2462b2325ffSGerd Hoffmann } 2472b2325ffSGerd Hoffmann libusb_set_debug(ctx, loglevel); 248a277c3e0SStefan Weil #ifdef CONFIG_WIN32 249a277c3e0SStefan Weil /* FIXME: add support for Windows. */ 250a277c3e0SStefan Weil #else 2512b2325ffSGerd Hoffmann libusb_set_pollfd_notifiers(ctx, usb_host_add_fd, 2522b2325ffSGerd Hoffmann usb_host_del_fd, 2532b2325ffSGerd Hoffmann ctx); 2542b2325ffSGerd Hoffmann poll = libusb_get_pollfds(ctx); 2552b2325ffSGerd Hoffmann if (poll) { 256*3bf2b3a1SStefan Weil int i; 2572b2325ffSGerd Hoffmann for (i = 0; poll[i] != NULL; i++) { 2582b2325ffSGerd Hoffmann usb_host_add_fd(poll[i]->fd, poll[i]->events, ctx); 2592b2325ffSGerd Hoffmann } 2602b2325ffSGerd Hoffmann } 2612b2325ffSGerd Hoffmann free(poll); 262a277c3e0SStefan Weil #endif 2632b2325ffSGerd Hoffmann return 0; 2642b2325ffSGerd Hoffmann } 2652b2325ffSGerd Hoffmann 2662b2325ffSGerd Hoffmann static int usb_host_get_port(libusb_device *dev, char *port, size_t len) 2672b2325ffSGerd Hoffmann { 2682b2325ffSGerd Hoffmann uint8_t path[7]; 2692b2325ffSGerd Hoffmann size_t off; 2702b2325ffSGerd Hoffmann int rc, i; 2712b2325ffSGerd Hoffmann 272bc45de8cSHans de Goede #if LIBUSBX_API_VERSION >= 0x01000102 273bc45de8cSHans de Goede rc = libusb_get_port_numbers(dev, path, 7); 274bc45de8cSHans de Goede #else 2752b2325ffSGerd Hoffmann rc = libusb_get_port_path(ctx, dev, path, 7); 276bc45de8cSHans de Goede #endif 2772b2325ffSGerd Hoffmann if (rc < 0) { 2782b2325ffSGerd Hoffmann return 0; 2792b2325ffSGerd Hoffmann } 2802b2325ffSGerd Hoffmann off = snprintf(port, len, "%d", path[0]); 2812b2325ffSGerd Hoffmann for (i = 1; i < rc; i++) { 2822b2325ffSGerd Hoffmann off += snprintf(port+off, len-off, ".%d", path[i]); 2832b2325ffSGerd Hoffmann } 2842b2325ffSGerd Hoffmann return off; 2852b2325ffSGerd Hoffmann } 2862b2325ffSGerd Hoffmann 2872b2325ffSGerd Hoffmann static void usb_host_libusb_error(const char *func, int rc) 2882b2325ffSGerd Hoffmann { 2892b2325ffSGerd Hoffmann const char *errname; 2902b2325ffSGerd Hoffmann 2912b2325ffSGerd Hoffmann if (rc >= 0) { 2922b2325ffSGerd Hoffmann return; 2932b2325ffSGerd Hoffmann } 2942b2325ffSGerd Hoffmann 2952b2325ffSGerd Hoffmann if (-rc < ARRAY_SIZE(err_names) && err_names[-rc]) { 2962b2325ffSGerd Hoffmann errname = err_names[-rc]; 2972b2325ffSGerd Hoffmann } else { 2982b2325ffSGerd Hoffmann errname = "?"; 2992b2325ffSGerd Hoffmann } 3002e6a0dd1SGonglei error_report("%s: %d [%s]", func, rc, errname); 3012b2325ffSGerd Hoffmann } 3022b2325ffSGerd Hoffmann 3032b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 3042b2325ffSGerd Hoffmann 3052b2325ffSGerd Hoffmann static bool usb_host_use_combining(USBEndpoint *ep) 3062b2325ffSGerd Hoffmann { 3072b2325ffSGerd Hoffmann int type; 3082b2325ffSGerd Hoffmann 3092b2325ffSGerd Hoffmann if (!ep->pipeline) { 3102b2325ffSGerd Hoffmann return false; 3112b2325ffSGerd Hoffmann } 3122b2325ffSGerd Hoffmann if (ep->pid != USB_TOKEN_IN) { 3132b2325ffSGerd Hoffmann return false; 3142b2325ffSGerd Hoffmann } 3152b2325ffSGerd Hoffmann type = usb_ep_get_type(ep->dev, ep->pid, ep->nr); 3162b2325ffSGerd Hoffmann if (type != USB_ENDPOINT_XFER_BULK) { 3172b2325ffSGerd Hoffmann return false; 3182b2325ffSGerd Hoffmann } 3192b2325ffSGerd Hoffmann return true; 3202b2325ffSGerd Hoffmann } 3212b2325ffSGerd Hoffmann 3222b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 3232b2325ffSGerd Hoffmann 3242b2325ffSGerd Hoffmann static USBHostRequest *usb_host_req_alloc(USBHostDevice *s, USBPacket *p, 3252b2325ffSGerd Hoffmann bool in, size_t bufsize) 3262b2325ffSGerd Hoffmann { 3272b2325ffSGerd Hoffmann USBHostRequest *r = g_new0(USBHostRequest, 1); 3282b2325ffSGerd Hoffmann 3292b2325ffSGerd Hoffmann r->host = s; 3302b2325ffSGerd Hoffmann r->p = p; 3312b2325ffSGerd Hoffmann r->in = in; 3322b2325ffSGerd Hoffmann r->xfer = libusb_alloc_transfer(0); 3332b2325ffSGerd Hoffmann if (bufsize) { 3342b2325ffSGerd Hoffmann r->buffer = g_malloc(bufsize); 3352b2325ffSGerd Hoffmann } 3362b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&s->requests, r, next); 3372b2325ffSGerd Hoffmann return r; 3382b2325ffSGerd Hoffmann } 3392b2325ffSGerd Hoffmann 3402b2325ffSGerd Hoffmann static void usb_host_req_free(USBHostRequest *r) 3412b2325ffSGerd Hoffmann { 3422b2325ffSGerd Hoffmann if (r->host) { 3432b2325ffSGerd Hoffmann QTAILQ_REMOVE(&r->host->requests, r, next); 3442b2325ffSGerd Hoffmann } 3452b2325ffSGerd Hoffmann libusb_free_transfer(r->xfer); 3462b2325ffSGerd Hoffmann g_free(r->buffer); 3472b2325ffSGerd Hoffmann g_free(r); 3482b2325ffSGerd Hoffmann } 3492b2325ffSGerd Hoffmann 3502b2325ffSGerd Hoffmann static USBHostRequest *usb_host_req_find(USBHostDevice *s, USBPacket *p) 3512b2325ffSGerd Hoffmann { 3522b2325ffSGerd Hoffmann USBHostRequest *r; 3532b2325ffSGerd Hoffmann 3542b2325ffSGerd Hoffmann QTAILQ_FOREACH(r, &s->requests, next) { 3552b2325ffSGerd Hoffmann if (r->p == p) { 3562b2325ffSGerd Hoffmann return r; 3572b2325ffSGerd Hoffmann } 3582b2325ffSGerd Hoffmann } 3592b2325ffSGerd Hoffmann return NULL; 3602b2325ffSGerd Hoffmann } 3612b2325ffSGerd Hoffmann 3622b2325ffSGerd Hoffmann static void usb_host_req_complete_ctrl(struct libusb_transfer *xfer) 3632b2325ffSGerd Hoffmann { 3642b2325ffSGerd Hoffmann USBHostRequest *r = xfer->user_data; 3652b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 3662b2325ffSGerd Hoffmann bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE); 3672b2325ffSGerd Hoffmann 3682b2325ffSGerd Hoffmann if (r->p == NULL) { 3692b2325ffSGerd Hoffmann goto out; /* request was canceled */ 3702b2325ffSGerd Hoffmann } 3712b2325ffSGerd Hoffmann 3722b2325ffSGerd Hoffmann r->p->status = status_map[xfer->status]; 3732b2325ffSGerd Hoffmann r->p->actual_length = xfer->actual_length; 3742b2325ffSGerd Hoffmann if (r->in && xfer->actual_length) { 3752b2325ffSGerd Hoffmann memcpy(r->cbuf, r->buffer + 8, xfer->actual_length); 376b88a3e01SGerd Hoffmann 377b88a3e01SGerd Hoffmann /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices 378b88a3e01SGerd Hoffmann * to work redirected to a not superspeed capable hcd */ 379b88a3e01SGerd Hoffmann if (r->usb3ep0quirk && xfer->actual_length >= 18 && 380b88a3e01SGerd Hoffmann r->cbuf[7] == 9) { 381b88a3e01SGerd Hoffmann r->cbuf[7] = 64; 382b88a3e01SGerd Hoffmann } 3832b2325ffSGerd Hoffmann } 3842b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 3852b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 3862b2325ffSGerd Hoffmann usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p); 3872b2325ffSGerd Hoffmann 3882b2325ffSGerd Hoffmann out: 3892b2325ffSGerd Hoffmann usb_host_req_free(r); 3902b2325ffSGerd Hoffmann if (disconnect) { 3912b2325ffSGerd Hoffmann usb_host_nodev(s); 3922b2325ffSGerd Hoffmann } 3932b2325ffSGerd Hoffmann } 3942b2325ffSGerd Hoffmann 3952b2325ffSGerd Hoffmann static void usb_host_req_complete_data(struct libusb_transfer *xfer) 3962b2325ffSGerd Hoffmann { 3972b2325ffSGerd Hoffmann USBHostRequest *r = xfer->user_data; 3982b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 3992b2325ffSGerd Hoffmann bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE); 4002b2325ffSGerd Hoffmann 4012b2325ffSGerd Hoffmann if (r->p == NULL) { 4022b2325ffSGerd Hoffmann goto out; /* request was canceled */ 4032b2325ffSGerd Hoffmann } 4042b2325ffSGerd Hoffmann 4052b2325ffSGerd Hoffmann r->p->status = status_map[xfer->status]; 4062b2325ffSGerd Hoffmann if (r->in && xfer->actual_length) { 4072b2325ffSGerd Hoffmann usb_packet_copy(r->p, r->buffer, xfer->actual_length); 4082b2325ffSGerd Hoffmann } 4092b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 4102b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 4112b2325ffSGerd Hoffmann if (usb_host_use_combining(r->p->ep)) { 4122b2325ffSGerd Hoffmann usb_combined_input_packet_complete(USB_DEVICE(s), r->p); 4132b2325ffSGerd Hoffmann } else { 4142b2325ffSGerd Hoffmann usb_packet_complete(USB_DEVICE(s), r->p); 4152b2325ffSGerd Hoffmann } 4162b2325ffSGerd Hoffmann 4172b2325ffSGerd Hoffmann out: 4182b2325ffSGerd Hoffmann usb_host_req_free(r); 4192b2325ffSGerd Hoffmann if (disconnect) { 4202b2325ffSGerd Hoffmann usb_host_nodev(s); 4212b2325ffSGerd Hoffmann } 4222b2325ffSGerd Hoffmann } 4232b2325ffSGerd Hoffmann 4242b2325ffSGerd Hoffmann static void usb_host_req_abort(USBHostRequest *r) 4252b2325ffSGerd Hoffmann { 4262b2325ffSGerd Hoffmann USBHostDevice *s = r->host; 42745ec2671SEd Maste bool inflight = (r->p && r->p->state == USB_PACKET_ASYNC); 4282b2325ffSGerd Hoffmann 4292b2325ffSGerd Hoffmann if (inflight) { 4302b2325ffSGerd Hoffmann r->p->status = USB_RET_NODEV; 4312b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, r->p, 4322b2325ffSGerd Hoffmann r->p->status, r->p->actual_length); 4332b2325ffSGerd Hoffmann if (r->p->ep->nr == 0) { 4342b2325ffSGerd Hoffmann usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p); 4352b2325ffSGerd Hoffmann } else { 4362b2325ffSGerd Hoffmann usb_packet_complete(USB_DEVICE(s), r->p); 4372b2325ffSGerd Hoffmann } 4382b2325ffSGerd Hoffmann r->p = NULL; 4392b2325ffSGerd Hoffmann } 4402b2325ffSGerd Hoffmann 4412b2325ffSGerd Hoffmann QTAILQ_REMOVE(&r->host->requests, r, next); 4422b2325ffSGerd Hoffmann r->host = NULL; 4432b2325ffSGerd Hoffmann 4442b2325ffSGerd Hoffmann if (inflight) { 4452b2325ffSGerd Hoffmann libusb_cancel_transfer(r->xfer); 4462b2325ffSGerd Hoffmann } 4472b2325ffSGerd Hoffmann } 4482b2325ffSGerd Hoffmann 4492b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 4502b2325ffSGerd Hoffmann 4512b2325ffSGerd Hoffmann static void usb_host_req_complete_iso(struct libusb_transfer *transfer) 4522b2325ffSGerd Hoffmann { 4532b2325ffSGerd Hoffmann USBHostIsoXfer *xfer = transfer->user_data; 4542b2325ffSGerd Hoffmann 4552b2325ffSGerd Hoffmann if (!xfer) { 4562b2325ffSGerd Hoffmann /* USBHostIsoXfer released while inflight */ 4572b2325ffSGerd Hoffmann g_free(transfer->buffer); 4582b2325ffSGerd Hoffmann libusb_free_transfer(transfer); 4592b2325ffSGerd Hoffmann return; 4602b2325ffSGerd Hoffmann } 4612b2325ffSGerd Hoffmann 4622b2325ffSGerd Hoffmann QTAILQ_REMOVE(&xfer->ring->inflight, xfer, next); 4632b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&xfer->ring->inflight)) { 4642b2325ffSGerd Hoffmann USBHostDevice *s = xfer->ring->host; 4652b2325ffSGerd Hoffmann trace_usb_host_iso_stop(s->bus_num, s->addr, xfer->ring->ep->nr); 4662b2325ffSGerd Hoffmann } 4672b2325ffSGerd Hoffmann if (xfer->ring->ep->pid == USB_TOKEN_IN) { 4682b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&xfer->ring->copy, xfer, next); 469e206ddfbSGerd Hoffmann usb_wakeup(xfer->ring->ep, 0); 4702b2325ffSGerd Hoffmann } else { 4712b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&xfer->ring->unused, xfer, next); 4722b2325ffSGerd Hoffmann } 4732b2325ffSGerd Hoffmann } 4742b2325ffSGerd Hoffmann 4752b2325ffSGerd Hoffmann static USBHostIsoRing *usb_host_iso_alloc(USBHostDevice *s, USBEndpoint *ep) 4762b2325ffSGerd Hoffmann { 4772b2325ffSGerd Hoffmann USBHostIsoRing *ring = g_new0(USBHostIsoRing, 1); 4782b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 4792b2325ffSGerd Hoffmann /* FIXME: check interval (for now assume one xfer per frame) */ 4802b2325ffSGerd Hoffmann int packets = s->iso_urb_frames; 4812b2325ffSGerd Hoffmann int i; 4822b2325ffSGerd Hoffmann 4832b2325ffSGerd Hoffmann ring->host = s; 4842b2325ffSGerd Hoffmann ring->ep = ep; 4852b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->unused); 4862b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->inflight); 4872b2325ffSGerd Hoffmann QTAILQ_INIT(&ring->copy); 4882b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&s->isorings, ring, next); 4892b2325ffSGerd Hoffmann 4902b2325ffSGerd Hoffmann for (i = 0; i < s->iso_urb_count; i++) { 4912b2325ffSGerd Hoffmann xfer = g_new0(USBHostIsoXfer, 1); 4922b2325ffSGerd Hoffmann xfer->ring = ring; 4932b2325ffSGerd Hoffmann xfer->xfer = libusb_alloc_transfer(packets); 4942b2325ffSGerd Hoffmann xfer->xfer->dev_handle = s->dh; 4952b2325ffSGerd Hoffmann xfer->xfer->type = LIBUSB_TRANSFER_TYPE_ISOCHRONOUS; 4962b2325ffSGerd Hoffmann 4972b2325ffSGerd Hoffmann xfer->xfer->endpoint = ring->ep->nr; 4982b2325ffSGerd Hoffmann if (ring->ep->pid == USB_TOKEN_IN) { 4992b2325ffSGerd Hoffmann xfer->xfer->endpoint |= USB_DIR_IN; 5002b2325ffSGerd Hoffmann } 5012b2325ffSGerd Hoffmann xfer->xfer->callback = usb_host_req_complete_iso; 5022b2325ffSGerd Hoffmann xfer->xfer->user_data = xfer; 5032b2325ffSGerd Hoffmann 5042b2325ffSGerd Hoffmann xfer->xfer->num_iso_packets = packets; 5052b2325ffSGerd Hoffmann xfer->xfer->length = ring->ep->max_packet_size * packets; 5062b2325ffSGerd Hoffmann xfer->xfer->buffer = g_malloc0(xfer->xfer->length); 5072b2325ffSGerd Hoffmann 5082b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 5092b2325ffSGerd Hoffmann } 5102b2325ffSGerd Hoffmann 5112b2325ffSGerd Hoffmann return ring; 5122b2325ffSGerd Hoffmann } 5132b2325ffSGerd Hoffmann 5142b2325ffSGerd Hoffmann static USBHostIsoRing *usb_host_iso_find(USBHostDevice *s, USBEndpoint *ep) 5152b2325ffSGerd Hoffmann { 5162b2325ffSGerd Hoffmann USBHostIsoRing *ring; 5172b2325ffSGerd Hoffmann 5182b2325ffSGerd Hoffmann QTAILQ_FOREACH(ring, &s->isorings, next) { 5192b2325ffSGerd Hoffmann if (ring->ep == ep) { 5202b2325ffSGerd Hoffmann return ring; 5212b2325ffSGerd Hoffmann } 5222b2325ffSGerd Hoffmann } 5232b2325ffSGerd Hoffmann return NULL; 5242b2325ffSGerd Hoffmann } 5252b2325ffSGerd Hoffmann 5262b2325ffSGerd Hoffmann static void usb_host_iso_reset_xfer(USBHostIsoXfer *xfer) 5272b2325ffSGerd Hoffmann { 5282b2325ffSGerd Hoffmann libusb_set_iso_packet_lengths(xfer->xfer, 5292b2325ffSGerd Hoffmann xfer->ring->ep->max_packet_size); 5302b2325ffSGerd Hoffmann xfer->packet = 0; 5312b2325ffSGerd Hoffmann xfer->copy_complete = false; 5322b2325ffSGerd Hoffmann } 5332b2325ffSGerd Hoffmann 5342b2325ffSGerd Hoffmann static void usb_host_iso_free_xfer(USBHostIsoXfer *xfer, bool inflight) 5352b2325ffSGerd Hoffmann { 5362b2325ffSGerd Hoffmann if (inflight) { 5372b2325ffSGerd Hoffmann xfer->xfer->user_data = NULL; 5382b2325ffSGerd Hoffmann } else { 5392b2325ffSGerd Hoffmann g_free(xfer->xfer->buffer); 5402b2325ffSGerd Hoffmann libusb_free_transfer(xfer->xfer); 5412b2325ffSGerd Hoffmann } 5422b2325ffSGerd Hoffmann g_free(xfer); 5432b2325ffSGerd Hoffmann } 5442b2325ffSGerd Hoffmann 5452b2325ffSGerd Hoffmann static void usb_host_iso_free(USBHostIsoRing *ring) 5462b2325ffSGerd Hoffmann { 5472b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 5482b2325ffSGerd Hoffmann 5492b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->inflight)) != NULL) { 5502b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->inflight, xfer, next); 5512b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, true); 5522b2325ffSGerd Hoffmann } 5532b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) { 5542b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 5552b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, false); 5562b2325ffSGerd Hoffmann } 5572b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL) { 5582b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 5592b2325ffSGerd Hoffmann usb_host_iso_free_xfer(xfer, false); 5602b2325ffSGerd Hoffmann } 5612b2325ffSGerd Hoffmann 5622b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->host->isorings, ring, next); 5632b2325ffSGerd Hoffmann g_free(ring); 5642b2325ffSGerd Hoffmann } 5652b2325ffSGerd Hoffmann 5662b2325ffSGerd Hoffmann static void usb_host_iso_free_all(USBHostDevice *s) 5672b2325ffSGerd Hoffmann { 5682b2325ffSGerd Hoffmann USBHostIsoRing *ring; 5692b2325ffSGerd Hoffmann 5702b2325ffSGerd Hoffmann while ((ring = QTAILQ_FIRST(&s->isorings)) != NULL) { 5712b2325ffSGerd Hoffmann usb_host_iso_free(ring); 5722b2325ffSGerd Hoffmann } 5732b2325ffSGerd Hoffmann } 5742b2325ffSGerd Hoffmann 5752b2325ffSGerd Hoffmann static bool usb_host_iso_data_copy(USBHostIsoXfer *xfer, USBPacket *p) 5762b2325ffSGerd Hoffmann { 5772b2325ffSGerd Hoffmann unsigned int psize; 5782b2325ffSGerd Hoffmann unsigned char *buf; 5792b2325ffSGerd Hoffmann 5802b2325ffSGerd Hoffmann buf = libusb_get_iso_packet_buffer_simple(xfer->xfer, xfer->packet); 5812b2325ffSGerd Hoffmann if (p->pid == USB_TOKEN_OUT) { 5822b2325ffSGerd Hoffmann psize = p->iov.size; 5832b2325ffSGerd Hoffmann if (psize > xfer->ring->ep->max_packet_size) { 5842b2325ffSGerd Hoffmann /* should not happen (guest bug) */ 5852b2325ffSGerd Hoffmann psize = xfer->ring->ep->max_packet_size; 5862b2325ffSGerd Hoffmann } 5872b2325ffSGerd Hoffmann xfer->xfer->iso_packet_desc[xfer->packet].length = psize; 5882b2325ffSGerd Hoffmann } else { 5892b2325ffSGerd Hoffmann psize = xfer->xfer->iso_packet_desc[xfer->packet].actual_length; 5902b2325ffSGerd Hoffmann if (psize > p->iov.size) { 5912b2325ffSGerd Hoffmann /* should not happen (guest bug) */ 5922b2325ffSGerd Hoffmann psize = p->iov.size; 5932b2325ffSGerd Hoffmann } 5942b2325ffSGerd Hoffmann } 5952b2325ffSGerd Hoffmann usb_packet_copy(p, buf, psize); 5962b2325ffSGerd Hoffmann xfer->packet++; 5972b2325ffSGerd Hoffmann xfer->copy_complete = (xfer->packet == xfer->xfer->num_iso_packets); 5982b2325ffSGerd Hoffmann return xfer->copy_complete; 5992b2325ffSGerd Hoffmann } 6002b2325ffSGerd Hoffmann 6012b2325ffSGerd Hoffmann static void usb_host_iso_data_in(USBHostDevice *s, USBPacket *p) 6022b2325ffSGerd Hoffmann { 6032b2325ffSGerd Hoffmann USBHostIsoRing *ring; 6042b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 6052b2325ffSGerd Hoffmann bool disconnect = false; 6062b2325ffSGerd Hoffmann int rc; 6072b2325ffSGerd Hoffmann 6082b2325ffSGerd Hoffmann ring = usb_host_iso_find(s, p->ep); 6092b2325ffSGerd Hoffmann if (ring == NULL) { 6102b2325ffSGerd Hoffmann ring = usb_host_iso_alloc(s, p->ep); 6112b2325ffSGerd Hoffmann } 6122b2325ffSGerd Hoffmann 6132b2325ffSGerd Hoffmann /* copy data to guest */ 6142b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->copy); 6152b2325ffSGerd Hoffmann if (xfer != NULL) { 6162b2325ffSGerd Hoffmann if (usb_host_iso_data_copy(xfer, p)) { 6172b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 6182b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 6192b2325ffSGerd Hoffmann } 6202b2325ffSGerd Hoffmann } 6212b2325ffSGerd Hoffmann 6222b2325ffSGerd Hoffmann /* submit empty bufs to host */ 6232b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) { 6242b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 6252b2325ffSGerd Hoffmann usb_host_iso_reset_xfer(xfer); 6262b2325ffSGerd Hoffmann rc = libusb_submit_transfer(xfer->xfer); 6272b2325ffSGerd Hoffmann if (rc != 0) { 6282b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_submit_transfer [iso]", rc); 6292b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 6302b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 6312b2325ffSGerd Hoffmann disconnect = true; 6322b2325ffSGerd Hoffmann } 6332b2325ffSGerd Hoffmann break; 6342b2325ffSGerd Hoffmann } 6352b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 6362b2325ffSGerd Hoffmann trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr); 6372b2325ffSGerd Hoffmann } 6382b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next); 6392b2325ffSGerd Hoffmann } 6402b2325ffSGerd Hoffmann 6412b2325ffSGerd Hoffmann if (disconnect) { 6422b2325ffSGerd Hoffmann usb_host_nodev(s); 6432b2325ffSGerd Hoffmann } 6442b2325ffSGerd Hoffmann } 6452b2325ffSGerd Hoffmann 6462b2325ffSGerd Hoffmann static void usb_host_iso_data_out(USBHostDevice *s, USBPacket *p) 6472b2325ffSGerd Hoffmann { 6482b2325ffSGerd Hoffmann USBHostIsoRing *ring; 6492b2325ffSGerd Hoffmann USBHostIsoXfer *xfer; 6502b2325ffSGerd Hoffmann bool disconnect = false; 6512b2325ffSGerd Hoffmann int rc, filled = 0; 6522b2325ffSGerd Hoffmann 6532b2325ffSGerd Hoffmann ring = usb_host_iso_find(s, p->ep); 6542b2325ffSGerd Hoffmann if (ring == NULL) { 6552b2325ffSGerd Hoffmann ring = usb_host_iso_alloc(s, p->ep); 6562b2325ffSGerd Hoffmann } 6572b2325ffSGerd Hoffmann 6582b2325ffSGerd Hoffmann /* copy data from guest */ 6592b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->copy); 6602b2325ffSGerd Hoffmann while (xfer != NULL && xfer->copy_complete) { 6612b2325ffSGerd Hoffmann filled++; 6622b2325ffSGerd Hoffmann xfer = QTAILQ_NEXT(xfer, next); 6632b2325ffSGerd Hoffmann } 6642b2325ffSGerd Hoffmann if (xfer == NULL) { 6652b2325ffSGerd Hoffmann xfer = QTAILQ_FIRST(&ring->unused); 6662b2325ffSGerd Hoffmann if (xfer == NULL) { 6672b2325ffSGerd Hoffmann trace_usb_host_iso_out_of_bufs(s->bus_num, s->addr, p->ep->nr); 6682b2325ffSGerd Hoffmann return; 6692b2325ffSGerd Hoffmann } 6702b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->unused, xfer, next); 6712b2325ffSGerd Hoffmann usb_host_iso_reset_xfer(xfer); 6722b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->copy, xfer, next); 6732b2325ffSGerd Hoffmann } 6742b2325ffSGerd Hoffmann usb_host_iso_data_copy(xfer, p); 6752b2325ffSGerd Hoffmann 6762b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 6772b2325ffSGerd Hoffmann /* wait until half of our buffers are filled 6782b2325ffSGerd Hoffmann before kicking the iso out stream */ 6792b2325ffSGerd Hoffmann if (filled*2 < s->iso_urb_count) { 6802b2325ffSGerd Hoffmann return; 6812b2325ffSGerd Hoffmann } 6822b2325ffSGerd Hoffmann } 6832b2325ffSGerd Hoffmann 6842b2325ffSGerd Hoffmann /* submit filled bufs to host */ 6852b2325ffSGerd Hoffmann while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL && 6862b2325ffSGerd Hoffmann xfer->copy_complete) { 6872b2325ffSGerd Hoffmann QTAILQ_REMOVE(&ring->copy, xfer, next); 6882b2325ffSGerd Hoffmann rc = libusb_submit_transfer(xfer->xfer); 6892b2325ffSGerd Hoffmann if (rc != 0) { 6902b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_submit_transfer [iso]", rc); 6912b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->unused, xfer, next); 6922b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 6932b2325ffSGerd Hoffmann disconnect = true; 6942b2325ffSGerd Hoffmann } 6952b2325ffSGerd Hoffmann break; 6962b2325ffSGerd Hoffmann } 6972b2325ffSGerd Hoffmann if (QTAILQ_EMPTY(&ring->inflight)) { 6982b2325ffSGerd Hoffmann trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr); 6992b2325ffSGerd Hoffmann } 7002b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next); 7012b2325ffSGerd Hoffmann } 7022b2325ffSGerd Hoffmann 7032b2325ffSGerd Hoffmann if (disconnect) { 7042b2325ffSGerd Hoffmann usb_host_nodev(s); 7052b2325ffSGerd Hoffmann } 7062b2325ffSGerd Hoffmann } 7072b2325ffSGerd Hoffmann 7082b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 7092b2325ffSGerd Hoffmann 710b88a3e01SGerd Hoffmann static void usb_host_speed_compat(USBHostDevice *s) 711c3268cc1SGerd Hoffmann { 712b88a3e01SGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 713c3268cc1SGerd Hoffmann struct libusb_config_descriptor *conf; 714c3268cc1SGerd Hoffmann const struct libusb_interface_descriptor *intf; 715c3268cc1SGerd Hoffmann const struct libusb_endpoint_descriptor *endp; 716322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 717b88a3e01SGerd Hoffmann struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp; 718b88a3e01SGerd Hoffmann #endif 719b88a3e01SGerd Hoffmann bool compat_high = true; 720b88a3e01SGerd Hoffmann bool compat_full = true; 721c3268cc1SGerd Hoffmann uint8_t type; 722c3268cc1SGerd Hoffmann int rc, c, i, a, e; 723c3268cc1SGerd Hoffmann 724c3268cc1SGerd Hoffmann for (c = 0;; c++) { 725c3268cc1SGerd Hoffmann rc = libusb_get_config_descriptor(s->dev, c, &conf); 726c3268cc1SGerd Hoffmann if (rc != 0) { 727c3268cc1SGerd Hoffmann break; 728c3268cc1SGerd Hoffmann } 729c3268cc1SGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 730c3268cc1SGerd Hoffmann for (a = 0; a < conf->interface[i].num_altsetting; a++) { 731c3268cc1SGerd Hoffmann intf = &conf->interface[i].altsetting[a]; 732c3268cc1SGerd Hoffmann for (e = 0; e < intf->bNumEndpoints; e++) { 733c3268cc1SGerd Hoffmann endp = &intf->endpoint[e]; 734c3268cc1SGerd Hoffmann type = endp->bmAttributes & 0x3; 735c3268cc1SGerd Hoffmann switch (type) { 736c3268cc1SGerd Hoffmann case 0x01: /* ISO */ 737b88a3e01SGerd Hoffmann compat_full = false; 738b88a3e01SGerd Hoffmann compat_high = false; 739b88a3e01SGerd Hoffmann break; 740b88a3e01SGerd Hoffmann case 0x02: /* BULK */ 741322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 742b88a3e01SGerd Hoffmann rc = libusb_get_ss_endpoint_companion_descriptor 743b88a3e01SGerd Hoffmann (ctx, endp, &endp_ss_comp); 744b88a3e01SGerd Hoffmann if (rc == LIBUSB_SUCCESS) { 745b88a3e01SGerd Hoffmann libusb_free_ss_endpoint_companion_descriptor 746b88a3e01SGerd Hoffmann (endp_ss_comp); 747b88a3e01SGerd Hoffmann compat_full = false; 748b88a3e01SGerd Hoffmann compat_high = false; 749b88a3e01SGerd Hoffmann } 750b88a3e01SGerd Hoffmann #endif 751b88a3e01SGerd Hoffmann break; 752c3268cc1SGerd Hoffmann case 0x03: /* INTERRUPT */ 753c3268cc1SGerd Hoffmann if (endp->wMaxPacketSize > 64) { 754b88a3e01SGerd Hoffmann compat_full = false; 755b88a3e01SGerd Hoffmann } 756b88a3e01SGerd Hoffmann if (endp->wMaxPacketSize > 1024) { 757b88a3e01SGerd Hoffmann compat_high = false; 758c3268cc1SGerd Hoffmann } 759c3268cc1SGerd Hoffmann break; 760c3268cc1SGerd Hoffmann } 761c3268cc1SGerd Hoffmann } 762c3268cc1SGerd Hoffmann } 763c3268cc1SGerd Hoffmann } 764c3268cc1SGerd Hoffmann libusb_free_config_descriptor(conf); 765c3268cc1SGerd Hoffmann } 766b88a3e01SGerd Hoffmann 767b88a3e01SGerd Hoffmann udev->speedmask = (1 << udev->speed); 768b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_SUPER && compat_high) { 76979ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_HIGH; 770b88a3e01SGerd Hoffmann } 771b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_SUPER && compat_full) { 77279ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_FULL; 773b88a3e01SGerd Hoffmann } 774b88a3e01SGerd Hoffmann if (udev->speed == USB_SPEED_HIGH && compat_full) { 77579ae25afSGerd Hoffmann udev->speedmask |= USB_SPEED_MASK_FULL; 776b88a3e01SGerd Hoffmann } 777c3268cc1SGerd Hoffmann } 778c3268cc1SGerd Hoffmann 7792b2325ffSGerd Hoffmann static void usb_host_ep_update(USBHostDevice *s) 7802b2325ffSGerd Hoffmann { 7812b2325ffSGerd Hoffmann static const char *tname[] = { 7822b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_CONTROL] = "control", 7832b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_ISOC] = "isoc", 7842b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_BULK] = "bulk", 7852b2325ffSGerd Hoffmann [USB_ENDPOINT_XFER_INT] = "int", 7862b2325ffSGerd Hoffmann }; 7872b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 7882b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 7892b2325ffSGerd Hoffmann const struct libusb_interface_descriptor *intf; 7902b2325ffSGerd Hoffmann const struct libusb_endpoint_descriptor *endp; 791322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 792b664b80fSHans de Goede struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp; 793b664b80fSHans de Goede #endif 7942b2325ffSGerd Hoffmann uint8_t devep, type; 7952b2325ffSGerd Hoffmann int pid, ep; 7962b2325ffSGerd Hoffmann int rc, i, e; 7972b2325ffSGerd Hoffmann 7982b2325ffSGerd Hoffmann usb_ep_reset(udev); 7992b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 8002b2325ffSGerd Hoffmann if (rc != 0) { 8012b2325ffSGerd Hoffmann return; 8022b2325ffSGerd Hoffmann } 8032b2325ffSGerd Hoffmann trace_usb_host_parse_config(s->bus_num, s->addr, 8042b2325ffSGerd Hoffmann conf->bConfigurationValue, true); 8052b2325ffSGerd Hoffmann 8062b2325ffSGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 8072b2325ffSGerd Hoffmann assert(udev->altsetting[i] < conf->interface[i].num_altsetting); 8082b2325ffSGerd Hoffmann intf = &conf->interface[i].altsetting[udev->altsetting[i]]; 8092b2325ffSGerd Hoffmann trace_usb_host_parse_interface(s->bus_num, s->addr, 8102b2325ffSGerd Hoffmann intf->bInterfaceNumber, 8112b2325ffSGerd Hoffmann intf->bAlternateSetting, true); 8122b2325ffSGerd Hoffmann for (e = 0; e < intf->bNumEndpoints; e++) { 8132b2325ffSGerd Hoffmann endp = &intf->endpoint[e]; 8142b2325ffSGerd Hoffmann 8152b2325ffSGerd Hoffmann devep = endp->bEndpointAddress; 8162b2325ffSGerd Hoffmann pid = (devep & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT; 8172b2325ffSGerd Hoffmann ep = devep & 0xf; 8182b2325ffSGerd Hoffmann type = endp->bmAttributes & 0x3; 8192b2325ffSGerd Hoffmann 8202b2325ffSGerd Hoffmann if (ep == 0) { 8212b2325ffSGerd Hoffmann trace_usb_host_parse_error(s->bus_num, s->addr, 8222b2325ffSGerd Hoffmann "invalid endpoint address"); 8232b2325ffSGerd Hoffmann return; 8242b2325ffSGerd Hoffmann } 8252b2325ffSGerd Hoffmann if (usb_ep_get_type(udev, pid, ep) != USB_ENDPOINT_XFER_INVALID) { 8262b2325ffSGerd Hoffmann trace_usb_host_parse_error(s->bus_num, s->addr, 8272b2325ffSGerd Hoffmann "duplicate endpoint address"); 8282b2325ffSGerd Hoffmann return; 8292b2325ffSGerd Hoffmann } 8302b2325ffSGerd Hoffmann 8312b2325ffSGerd Hoffmann trace_usb_host_parse_endpoint(s->bus_num, s->addr, ep, 8322b2325ffSGerd Hoffmann (devep & USB_DIR_IN) ? "in" : "out", 8332b2325ffSGerd Hoffmann tname[type], true); 8342b2325ffSGerd Hoffmann usb_ep_set_max_packet_size(udev, pid, ep, 8352b2325ffSGerd Hoffmann endp->wMaxPacketSize); 8362b2325ffSGerd Hoffmann usb_ep_set_type(udev, pid, ep, type); 8372b2325ffSGerd Hoffmann usb_ep_set_ifnum(udev, pid, ep, i); 8382b2325ffSGerd Hoffmann usb_ep_set_halted(udev, pid, ep, 0); 839322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 840b664b80fSHans de Goede if (type == LIBUSB_TRANSFER_TYPE_BULK && 841b664b80fSHans de Goede libusb_get_ss_endpoint_companion_descriptor(ctx, endp, 842b664b80fSHans de Goede &endp_ss_comp) == LIBUSB_SUCCESS) { 843b664b80fSHans de Goede usb_ep_set_max_streams(udev, pid, ep, 844b664b80fSHans de Goede endp_ss_comp->bmAttributes); 845b664b80fSHans de Goede libusb_free_ss_endpoint_companion_descriptor(endp_ss_comp); 846b664b80fSHans de Goede } 847b664b80fSHans de Goede #endif 8482b2325ffSGerd Hoffmann } 8492b2325ffSGerd Hoffmann } 8502b2325ffSGerd Hoffmann 8512b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 8522b2325ffSGerd Hoffmann } 8532b2325ffSGerd Hoffmann 8542b2325ffSGerd Hoffmann static int usb_host_open(USBHostDevice *s, libusb_device *dev) 8552b2325ffSGerd Hoffmann { 8562b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 8572b2325ffSGerd Hoffmann int bus_num = libusb_get_bus_number(dev); 8582b2325ffSGerd Hoffmann int addr = libusb_get_device_address(dev); 8592b2325ffSGerd Hoffmann int rc; 8607d553f27SGonglei Error *local_err = NULL; 8612b2325ffSGerd Hoffmann 8622b2325ffSGerd Hoffmann trace_usb_host_open_started(bus_num, addr); 8632b2325ffSGerd Hoffmann 8642b2325ffSGerd Hoffmann if (s->dh != NULL) { 8652b2325ffSGerd Hoffmann goto fail; 8662b2325ffSGerd Hoffmann } 8672b2325ffSGerd Hoffmann rc = libusb_open(dev, &s->dh); 8682b2325ffSGerd Hoffmann if (rc != 0) { 8692b2325ffSGerd Hoffmann goto fail; 8702b2325ffSGerd Hoffmann } 8712b2325ffSGerd Hoffmann 8722b2325ffSGerd Hoffmann s->dev = dev; 8732b2325ffSGerd Hoffmann s->bus_num = bus_num; 8742b2325ffSGerd Hoffmann s->addr = addr; 875f34d5c75SHans de Goede 876f34d5c75SHans de Goede usb_host_detach_kernel(s); 877f34d5c75SHans de Goede 878f34d5c75SHans de Goede libusb_get_device_descriptor(dev, &s->ddesc); 8792b2325ffSGerd Hoffmann usb_host_get_port(s->dev, s->port, sizeof(s->port)); 8802b2325ffSGerd Hoffmann 8812b2325ffSGerd Hoffmann usb_ep_init(udev); 8822b2325ffSGerd Hoffmann usb_host_ep_update(s); 8832b2325ffSGerd Hoffmann 8842b2325ffSGerd Hoffmann udev->speed = speed_map[libusb_get_device_speed(dev)]; 885b88a3e01SGerd Hoffmann usb_host_speed_compat(s); 8862b2325ffSGerd Hoffmann 8872b2325ffSGerd Hoffmann if (s->ddesc.iProduct) { 8882b2325ffSGerd Hoffmann libusb_get_string_descriptor_ascii(s->dh, s->ddesc.iProduct, 8892b2325ffSGerd Hoffmann (unsigned char *)udev->product_desc, 8902b2325ffSGerd Hoffmann sizeof(udev->product_desc)); 8912b2325ffSGerd Hoffmann } else { 8922b2325ffSGerd Hoffmann snprintf(udev->product_desc, sizeof(udev->product_desc), 8932b2325ffSGerd Hoffmann "host:%d.%d", bus_num, addr); 8942b2325ffSGerd Hoffmann } 8952b2325ffSGerd Hoffmann 8967d553f27SGonglei usb_device_attach(udev, &local_err); 8977d553f27SGonglei if (local_err) { 898565f65d2SMarkus Armbruster error_report_err(local_err); 8992b2325ffSGerd Hoffmann goto fail; 9002b2325ffSGerd Hoffmann } 9012b2325ffSGerd Hoffmann 9022b2325ffSGerd Hoffmann trace_usb_host_open_success(bus_num, addr); 9032b2325ffSGerd Hoffmann return 0; 9042b2325ffSGerd Hoffmann 9052b2325ffSGerd Hoffmann fail: 9062b2325ffSGerd Hoffmann trace_usb_host_open_failure(bus_num, addr); 9072b2325ffSGerd Hoffmann if (s->dh != NULL) { 9086110ce59SLin Ma usb_host_release_interfaces(s); 9096110ce59SLin Ma libusb_reset_device(s->dh); 9106110ce59SLin Ma usb_host_attach_kernel(s); 9112b2325ffSGerd Hoffmann libusb_close(s->dh); 9122b2325ffSGerd Hoffmann s->dh = NULL; 9132b2325ffSGerd Hoffmann s->dev = NULL; 9142b2325ffSGerd Hoffmann } 9152b2325ffSGerd Hoffmann return -1; 9162b2325ffSGerd Hoffmann } 9172b2325ffSGerd Hoffmann 9182b2325ffSGerd Hoffmann static void usb_host_abort_xfers(USBHostDevice *s) 9192b2325ffSGerd Hoffmann { 9202b2325ffSGerd Hoffmann USBHostRequest *r, *rtmp; 9212b2325ffSGerd Hoffmann 9222b2325ffSGerd Hoffmann QTAILQ_FOREACH_SAFE(r, &s->requests, next, rtmp) { 9232b2325ffSGerd Hoffmann usb_host_req_abort(r); 9242b2325ffSGerd Hoffmann } 9252b2325ffSGerd Hoffmann } 9262b2325ffSGerd Hoffmann 9272b2325ffSGerd Hoffmann static int usb_host_close(USBHostDevice *s) 9282b2325ffSGerd Hoffmann { 9292b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 9302b2325ffSGerd Hoffmann 9312b2325ffSGerd Hoffmann if (s->dh == NULL) { 9322b2325ffSGerd Hoffmann return -1; 9332b2325ffSGerd Hoffmann } 9342b2325ffSGerd Hoffmann 9352b2325ffSGerd Hoffmann trace_usb_host_close(s->bus_num, s->addr); 9362b2325ffSGerd Hoffmann 9372b2325ffSGerd Hoffmann usb_host_abort_xfers(s); 9382b2325ffSGerd Hoffmann usb_host_iso_free_all(s); 9392b2325ffSGerd Hoffmann 9402b2325ffSGerd Hoffmann if (udev->attached) { 9412b2325ffSGerd Hoffmann usb_device_detach(udev); 9422b2325ffSGerd Hoffmann } 9432b2325ffSGerd Hoffmann 9442b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 9452b2325ffSGerd Hoffmann libusb_reset_device(s->dh); 9462b2325ffSGerd Hoffmann usb_host_attach_kernel(s); 9472b2325ffSGerd Hoffmann libusb_close(s->dh); 9482b2325ffSGerd Hoffmann s->dh = NULL; 9492b2325ffSGerd Hoffmann s->dev = NULL; 9502b2325ffSGerd Hoffmann 9512b2325ffSGerd Hoffmann usb_host_auto_check(NULL); 9522b2325ffSGerd Hoffmann return 0; 9532b2325ffSGerd Hoffmann } 9542b2325ffSGerd Hoffmann 9552b2325ffSGerd Hoffmann static void usb_host_nodev_bh(void *opaque) 9562b2325ffSGerd Hoffmann { 9572b2325ffSGerd Hoffmann USBHostDevice *s = opaque; 9582b2325ffSGerd Hoffmann usb_host_close(s); 9592b2325ffSGerd Hoffmann } 9602b2325ffSGerd Hoffmann 9612b2325ffSGerd Hoffmann static void usb_host_nodev(USBHostDevice *s) 9622b2325ffSGerd Hoffmann { 96395efb20cSGerd Hoffmann if (!s->bh_nodev) { 96495efb20cSGerd Hoffmann s->bh_nodev = qemu_bh_new(usb_host_nodev_bh, s); 9652b2325ffSGerd Hoffmann } 96695efb20cSGerd Hoffmann qemu_bh_schedule(s->bh_nodev); 9672b2325ffSGerd Hoffmann } 9682b2325ffSGerd Hoffmann 9692b2325ffSGerd Hoffmann static void usb_host_exit_notifier(struct Notifier *n, void *data) 9702b2325ffSGerd Hoffmann { 9712b2325ffSGerd Hoffmann USBHostDevice *s = container_of(n, USBHostDevice, exit); 9722b2325ffSGerd Hoffmann 9732b2325ffSGerd Hoffmann if (s->dh) { 9742b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 9752b2325ffSGerd Hoffmann usb_host_attach_kernel(s); 9762b2325ffSGerd Hoffmann } 9772b2325ffSGerd Hoffmann } 9782b2325ffSGerd Hoffmann 979e058fa2dSGerd Hoffmann static libusb_device *usb_host_find_ref(int bus, int addr) 980e058fa2dSGerd Hoffmann { 981e058fa2dSGerd Hoffmann libusb_device **devs = NULL; 982e058fa2dSGerd Hoffmann libusb_device *ret = NULL; 983e058fa2dSGerd Hoffmann int i, n; 984e058fa2dSGerd Hoffmann 985e058fa2dSGerd Hoffmann if (usb_host_init() != 0) { 986e058fa2dSGerd Hoffmann return NULL; 987e058fa2dSGerd Hoffmann } 988e058fa2dSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 989e058fa2dSGerd Hoffmann for (i = 0; i < n; i++) { 990e058fa2dSGerd Hoffmann if (libusb_get_bus_number(devs[i]) == bus && 991e058fa2dSGerd Hoffmann libusb_get_device_address(devs[i]) == addr) { 992e058fa2dSGerd Hoffmann ret = libusb_ref_device(devs[i]); 993e058fa2dSGerd Hoffmann break; 994e058fa2dSGerd Hoffmann } 995e058fa2dSGerd Hoffmann } 996e058fa2dSGerd Hoffmann libusb_free_device_list(devs, 1); 997e058fa2dSGerd Hoffmann return ret; 998e058fa2dSGerd Hoffmann } 999e058fa2dSGerd Hoffmann 10002aa76dc1SGonglei static void usb_host_realize(USBDevice *udev, Error **errp) 10012b2325ffSGerd Hoffmann { 10022b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 1003e058fa2dSGerd Hoffmann libusb_device *ldev; 1004e058fa2dSGerd Hoffmann int rc; 10052b2325ffSGerd Hoffmann 1006f3cda6e0SGerd Hoffmann if (s->match.vendor_id > 0xffff) { 10072aa76dc1SGonglei error_setg(errp, "vendorid out of range"); 10082aa76dc1SGonglei return; 1009f3cda6e0SGerd Hoffmann } 1010f3cda6e0SGerd Hoffmann if (s->match.product_id > 0xffff) { 10112aa76dc1SGonglei error_setg(errp, "productid out of range"); 10122aa76dc1SGonglei return; 1013f3cda6e0SGerd Hoffmann } 1014f3cda6e0SGerd Hoffmann if (s->match.addr > 127) { 10152aa76dc1SGonglei error_setg(errp, "hostaddr out of range"); 10162aa76dc1SGonglei return; 1017f3cda6e0SGerd Hoffmann } 1018f3cda6e0SGerd Hoffmann 10192b2325ffSGerd Hoffmann loglevel = s->loglevel; 1020628e5485SGerd Hoffmann udev->flags |= (1 << USB_DEV_FLAG_IS_HOST); 10212b2325ffSGerd Hoffmann udev->auto_attach = 0; 10222b2325ffSGerd Hoffmann QTAILQ_INIT(&s->requests); 10232b2325ffSGerd Hoffmann QTAILQ_INIT(&s->isorings); 10242b2325ffSGerd Hoffmann 1025e058fa2dSGerd Hoffmann if (s->match.addr && s->match.bus_num && 1026e058fa2dSGerd Hoffmann !s->match.vendor_id && 1027e058fa2dSGerd Hoffmann !s->match.product_id && 1028e058fa2dSGerd Hoffmann !s->match.port) { 1029e058fa2dSGerd Hoffmann s->needs_autoscan = false; 1030e058fa2dSGerd Hoffmann ldev = usb_host_find_ref(s->match.bus_num, 1031e058fa2dSGerd Hoffmann s->match.addr); 1032e058fa2dSGerd Hoffmann if (!ldev) { 1033e058fa2dSGerd Hoffmann error_setg(errp, "failed to find host usb device %d:%d", 1034e058fa2dSGerd Hoffmann s->match.bus_num, s->match.addr); 1035e058fa2dSGerd Hoffmann return; 1036e058fa2dSGerd Hoffmann } 1037e058fa2dSGerd Hoffmann rc = usb_host_open(s, ldev); 1038e058fa2dSGerd Hoffmann libusb_unref_device(ldev); 1039e058fa2dSGerd Hoffmann if (rc < 0) { 1040e058fa2dSGerd Hoffmann error_setg(errp, "failed to open host usb device %d:%d", 1041e058fa2dSGerd Hoffmann s->match.bus_num, s->match.addr); 1042e058fa2dSGerd Hoffmann return; 1043e058fa2dSGerd Hoffmann } 1044e058fa2dSGerd Hoffmann } else { 1045e058fa2dSGerd Hoffmann s->needs_autoscan = true; 10462b2325ffSGerd Hoffmann QTAILQ_INSERT_TAIL(&hostdevs, s, next); 10472b2325ffSGerd Hoffmann usb_host_auto_check(NULL); 10482b2325ffSGerd Hoffmann } 10492b2325ffSGerd Hoffmann 1050e058fa2dSGerd Hoffmann s->exit.notify = usb_host_exit_notifier; 1051e058fa2dSGerd Hoffmann qemu_add_exit_notifier(&s->exit); 1052e058fa2dSGerd Hoffmann } 1053e058fa2dSGerd Hoffmann 1054e6adae52SGonglei static void usb_host_instance_init(Object *obj) 1055e6adae52SGonglei { 1056e6adae52SGonglei USBDevice *udev = USB_DEVICE(obj); 1057e6adae52SGonglei USBHostDevice *s = USB_HOST_DEVICE(udev); 1058e6adae52SGonglei 1059e6adae52SGonglei device_add_bootindex_property(obj, &s->bootindex, 1060e6adae52SGonglei "bootindex", NULL, 1061e6adae52SGonglei &udev->qdev, NULL); 1062e6adae52SGonglei } 1063e6adae52SGonglei 10642b2325ffSGerd Hoffmann static void usb_host_handle_destroy(USBDevice *udev) 10652b2325ffSGerd Hoffmann { 10662b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 10672b2325ffSGerd Hoffmann 10682b2325ffSGerd Hoffmann qemu_remove_exit_notifier(&s->exit); 1069e058fa2dSGerd Hoffmann if (s->needs_autoscan) { 10702b2325ffSGerd Hoffmann QTAILQ_REMOVE(&hostdevs, s, next); 1071e058fa2dSGerd Hoffmann } 10722b2325ffSGerd Hoffmann usb_host_close(s); 10732b2325ffSGerd Hoffmann } 10742b2325ffSGerd Hoffmann 10752b2325ffSGerd Hoffmann static void usb_host_cancel_packet(USBDevice *udev, USBPacket *p) 10762b2325ffSGerd Hoffmann { 10772b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 10782b2325ffSGerd Hoffmann USBHostRequest *r; 10792b2325ffSGerd Hoffmann 10802b2325ffSGerd Hoffmann if (p->combined) { 10812b2325ffSGerd Hoffmann usb_combined_packet_cancel(udev, p); 10822b2325ffSGerd Hoffmann return; 10832b2325ffSGerd Hoffmann } 10842b2325ffSGerd Hoffmann 10852b2325ffSGerd Hoffmann trace_usb_host_req_canceled(s->bus_num, s->addr, p); 10862b2325ffSGerd Hoffmann 10872b2325ffSGerd Hoffmann r = usb_host_req_find(s, p); 10882b2325ffSGerd Hoffmann if (r && r->p) { 10892b2325ffSGerd Hoffmann r->p = NULL; /* mark as dead */ 10902b2325ffSGerd Hoffmann libusb_cancel_transfer(r->xfer); 10912b2325ffSGerd Hoffmann } 10922b2325ffSGerd Hoffmann } 10932b2325ffSGerd Hoffmann 10942b2325ffSGerd Hoffmann static void usb_host_detach_kernel(USBHostDevice *s) 10952b2325ffSGerd Hoffmann { 10962b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 10972b2325ffSGerd Hoffmann int rc, i; 10982b2325ffSGerd Hoffmann 10992b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11002b2325ffSGerd Hoffmann if (rc != 0) { 11012b2325ffSGerd Hoffmann return; 11022b2325ffSGerd Hoffmann } 11032b2325ffSGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 11042b2325ffSGerd Hoffmann rc = libusb_kernel_driver_active(s->dh, i); 11052b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_kernel_driver_active", rc); 11062b2325ffSGerd Hoffmann if (rc != 1) { 11072b2325ffSGerd Hoffmann continue; 11082b2325ffSGerd Hoffmann } 11092b2325ffSGerd Hoffmann trace_usb_host_detach_kernel(s->bus_num, s->addr, i); 11102b2325ffSGerd Hoffmann rc = libusb_detach_kernel_driver(s->dh, i); 11112b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_detach_kernel_driver", rc); 11122b2325ffSGerd Hoffmann s->ifs[i].detached = true; 11132b2325ffSGerd Hoffmann } 11142b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11152b2325ffSGerd Hoffmann } 11162b2325ffSGerd Hoffmann 11172b2325ffSGerd Hoffmann static void usb_host_attach_kernel(USBHostDevice *s) 11182b2325ffSGerd Hoffmann { 11192b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 11202b2325ffSGerd Hoffmann int rc, i; 11212b2325ffSGerd Hoffmann 11222b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11232b2325ffSGerd Hoffmann if (rc != 0) { 11242b2325ffSGerd Hoffmann return; 11252b2325ffSGerd Hoffmann } 11262b2325ffSGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 11272b2325ffSGerd Hoffmann if (!s->ifs[i].detached) { 11282b2325ffSGerd Hoffmann continue; 11292b2325ffSGerd Hoffmann } 11302b2325ffSGerd Hoffmann trace_usb_host_attach_kernel(s->bus_num, s->addr, i); 11312b2325ffSGerd Hoffmann libusb_attach_kernel_driver(s->dh, i); 11322b2325ffSGerd Hoffmann s->ifs[i].detached = false; 11332b2325ffSGerd Hoffmann } 11342b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11352b2325ffSGerd Hoffmann } 11362b2325ffSGerd Hoffmann 11372b2325ffSGerd Hoffmann static int usb_host_claim_interfaces(USBHostDevice *s, int configuration) 11382b2325ffSGerd Hoffmann { 11392b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 11402b2325ffSGerd Hoffmann struct libusb_config_descriptor *conf; 11412b2325ffSGerd Hoffmann int rc, i; 11422b2325ffSGerd Hoffmann 11432b2325ffSGerd Hoffmann for (i = 0; i < USB_MAX_INTERFACES; i++) { 11442b2325ffSGerd Hoffmann udev->altsetting[i] = 0; 11452b2325ffSGerd Hoffmann } 11462b2325ffSGerd Hoffmann udev->ninterfaces = 0; 11472b2325ffSGerd Hoffmann udev->configuration = 0; 11482b2325ffSGerd Hoffmann 11492b2325ffSGerd Hoffmann usb_host_detach_kernel(s); 11502b2325ffSGerd Hoffmann 11512b2325ffSGerd Hoffmann rc = libusb_get_active_config_descriptor(s->dev, &conf); 11522b2325ffSGerd Hoffmann if (rc != 0) { 11531294ca79SHans de Goede if (rc == LIBUSB_ERROR_NOT_FOUND) { 11541294ca79SHans de Goede /* address state - ignore */ 11551294ca79SHans de Goede return USB_RET_SUCCESS; 11561294ca79SHans de Goede } 11572b2325ffSGerd Hoffmann return USB_RET_STALL; 11582b2325ffSGerd Hoffmann } 11592b2325ffSGerd Hoffmann 11602b2325ffSGerd Hoffmann for (i = 0; i < conf->bNumInterfaces; i++) { 11612b2325ffSGerd Hoffmann trace_usb_host_claim_interface(s->bus_num, s->addr, configuration, i); 11622b2325ffSGerd Hoffmann rc = libusb_claim_interface(s->dh, i); 11632b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_claim_interface", rc); 11642b2325ffSGerd Hoffmann if (rc != 0) { 11652b2325ffSGerd Hoffmann return USB_RET_STALL; 11662b2325ffSGerd Hoffmann } 11672b2325ffSGerd Hoffmann s->ifs[i].claimed = true; 11682b2325ffSGerd Hoffmann } 11692b2325ffSGerd Hoffmann 11702b2325ffSGerd Hoffmann udev->ninterfaces = conf->bNumInterfaces; 11712b2325ffSGerd Hoffmann udev->configuration = configuration; 11722b2325ffSGerd Hoffmann 11732b2325ffSGerd Hoffmann libusb_free_config_descriptor(conf); 11742b2325ffSGerd Hoffmann return USB_RET_SUCCESS; 11752b2325ffSGerd Hoffmann } 11762b2325ffSGerd Hoffmann 11772b2325ffSGerd Hoffmann static void usb_host_release_interfaces(USBHostDevice *s) 11782b2325ffSGerd Hoffmann { 11792b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 11802b2325ffSGerd Hoffmann int i, rc; 11812b2325ffSGerd Hoffmann 11822b2325ffSGerd Hoffmann for (i = 0; i < udev->ninterfaces; i++) { 11832b2325ffSGerd Hoffmann if (!s->ifs[i].claimed) { 11842b2325ffSGerd Hoffmann continue; 11852b2325ffSGerd Hoffmann } 11862b2325ffSGerd Hoffmann trace_usb_host_release_interface(s->bus_num, s->addr, i); 11872b2325ffSGerd Hoffmann rc = libusb_release_interface(s->dh, i); 11882b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_release_interface", rc); 11892b2325ffSGerd Hoffmann s->ifs[i].claimed = false; 11902b2325ffSGerd Hoffmann } 11912b2325ffSGerd Hoffmann } 11922b2325ffSGerd Hoffmann 11932b2325ffSGerd Hoffmann static void usb_host_set_address(USBHostDevice *s, int addr) 11942b2325ffSGerd Hoffmann { 11952b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 11962b2325ffSGerd Hoffmann 11972b2325ffSGerd Hoffmann trace_usb_host_set_address(s->bus_num, s->addr, addr); 11982b2325ffSGerd Hoffmann udev->addr = addr; 11992b2325ffSGerd Hoffmann } 12002b2325ffSGerd Hoffmann 12012b2325ffSGerd Hoffmann static void usb_host_set_config(USBHostDevice *s, int config, USBPacket *p) 12022b2325ffSGerd Hoffmann { 12032b2325ffSGerd Hoffmann int rc; 12042b2325ffSGerd Hoffmann 12052b2325ffSGerd Hoffmann trace_usb_host_set_config(s->bus_num, s->addr, config); 12062b2325ffSGerd Hoffmann 12072b2325ffSGerd Hoffmann usb_host_release_interfaces(s); 12082b2325ffSGerd Hoffmann rc = libusb_set_configuration(s->dh, config); 12092b2325ffSGerd Hoffmann if (rc != 0) { 12102b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_set_configuration", rc); 12112b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12122b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 12132b2325ffSGerd Hoffmann usb_host_nodev(s); 12142b2325ffSGerd Hoffmann } 12152b2325ffSGerd Hoffmann return; 12162b2325ffSGerd Hoffmann } 12172b2325ffSGerd Hoffmann p->status = usb_host_claim_interfaces(s, config); 12182b2325ffSGerd Hoffmann if (p->status != USB_RET_SUCCESS) { 12192b2325ffSGerd Hoffmann return; 12202b2325ffSGerd Hoffmann } 12212b2325ffSGerd Hoffmann usb_host_ep_update(s); 12222b2325ffSGerd Hoffmann } 12232b2325ffSGerd Hoffmann 12242b2325ffSGerd Hoffmann static void usb_host_set_interface(USBHostDevice *s, int iface, int alt, 12252b2325ffSGerd Hoffmann USBPacket *p) 12262b2325ffSGerd Hoffmann { 12272b2325ffSGerd Hoffmann USBDevice *udev = USB_DEVICE(s); 12282b2325ffSGerd Hoffmann int rc; 12292b2325ffSGerd Hoffmann 12302b2325ffSGerd Hoffmann trace_usb_host_set_interface(s->bus_num, s->addr, iface, alt); 12312b2325ffSGerd Hoffmann 12322b2325ffSGerd Hoffmann usb_host_iso_free_all(s); 12332b2325ffSGerd Hoffmann 12342b2325ffSGerd Hoffmann if (iface >= USB_MAX_INTERFACES) { 12352b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12362b2325ffSGerd Hoffmann return; 12372b2325ffSGerd Hoffmann } 12382b2325ffSGerd Hoffmann 12392b2325ffSGerd Hoffmann rc = libusb_set_interface_alt_setting(s->dh, iface, alt); 12402b2325ffSGerd Hoffmann if (rc != 0) { 12412b2325ffSGerd Hoffmann usb_host_libusb_error("libusb_set_interface_alt_setting", rc); 12422b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 12432b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 12442b2325ffSGerd Hoffmann usb_host_nodev(s); 12452b2325ffSGerd Hoffmann } 12462b2325ffSGerd Hoffmann return; 12472b2325ffSGerd Hoffmann } 12482b2325ffSGerd Hoffmann 12492b2325ffSGerd Hoffmann udev->altsetting[iface] = alt; 12502b2325ffSGerd Hoffmann usb_host_ep_update(s); 12512b2325ffSGerd Hoffmann } 12522b2325ffSGerd Hoffmann 12532b2325ffSGerd Hoffmann static void usb_host_handle_control(USBDevice *udev, USBPacket *p, 12542b2325ffSGerd Hoffmann int request, int value, int index, 12552b2325ffSGerd Hoffmann int length, uint8_t *data) 12562b2325ffSGerd Hoffmann { 12572b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 12582b2325ffSGerd Hoffmann USBHostRequest *r; 12592b2325ffSGerd Hoffmann int rc; 12602b2325ffSGerd Hoffmann 12612b2325ffSGerd Hoffmann trace_usb_host_req_control(s->bus_num, s->addr, p, request, value, index); 12622b2325ffSGerd Hoffmann 12632b2325ffSGerd Hoffmann if (s->dh == NULL) { 12642b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 12652b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12662b2325ffSGerd Hoffmann return; 12672b2325ffSGerd Hoffmann } 12682b2325ffSGerd Hoffmann 12692b2325ffSGerd Hoffmann switch (request) { 12702b2325ffSGerd Hoffmann case DeviceOutRequest | USB_REQ_SET_ADDRESS: 12712b2325ffSGerd Hoffmann usb_host_set_address(s, value); 12722b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12732b2325ffSGerd Hoffmann return; 12742b2325ffSGerd Hoffmann 12752b2325ffSGerd Hoffmann case DeviceOutRequest | USB_REQ_SET_CONFIGURATION: 12762b2325ffSGerd Hoffmann usb_host_set_config(s, value & 0xff, p); 12772b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12782b2325ffSGerd Hoffmann return; 12792b2325ffSGerd Hoffmann 12802b2325ffSGerd Hoffmann case InterfaceOutRequest | USB_REQ_SET_INTERFACE: 12812b2325ffSGerd Hoffmann usb_host_set_interface(s, index, value, p); 12822b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12832b2325ffSGerd Hoffmann return; 12842b2325ffSGerd Hoffmann 12852b2325ffSGerd Hoffmann case EndpointOutRequest | USB_REQ_CLEAR_FEATURE: 12862b2325ffSGerd Hoffmann if (value == 0) { /* clear halt */ 12872b2325ffSGerd Hoffmann int pid = (index & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT; 12882b2325ffSGerd Hoffmann libusb_clear_halt(s->dh, index); 12892b2325ffSGerd Hoffmann usb_ep_set_halted(udev, pid, index & 0x0f, 0); 12902b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 12912b2325ffSGerd Hoffmann return; 12922b2325ffSGerd Hoffmann } 12932b2325ffSGerd Hoffmann } 12942b2325ffSGerd Hoffmann 12952b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, (request >> 8) & USB_DIR_IN, length + 8); 12962b2325ffSGerd Hoffmann r->cbuf = data; 12972b2325ffSGerd Hoffmann r->clen = length; 12982b2325ffSGerd Hoffmann memcpy(r->buffer, udev->setup_buf, 8); 12992b2325ffSGerd Hoffmann if (!r->in) { 13002b2325ffSGerd Hoffmann memcpy(r->buffer + 8, r->cbuf, r->clen); 13012b2325ffSGerd Hoffmann } 13022b2325ffSGerd Hoffmann 1303b88a3e01SGerd Hoffmann /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices 1304b88a3e01SGerd Hoffmann * to work redirected to a not superspeed capable hcd */ 1305a9be4e7cSGerd Hoffmann if ((udev->speedmask & USB_SPEED_MASK_SUPER) && 130672517114Slijun !(udev->port->speedmask & USB_SPEED_MASK_SUPER) && 1307b88a3e01SGerd Hoffmann request == 0x8006 && value == 0x100 && index == 0) { 1308b88a3e01SGerd Hoffmann r->usb3ep0quirk = true; 1309b88a3e01SGerd Hoffmann } 1310b88a3e01SGerd Hoffmann 13112b2325ffSGerd Hoffmann libusb_fill_control_transfer(r->xfer, s->dh, r->buffer, 13122b2325ffSGerd Hoffmann usb_host_req_complete_ctrl, r, 13132b2325ffSGerd Hoffmann CONTROL_TIMEOUT); 13142b2325ffSGerd Hoffmann rc = libusb_submit_transfer(r->xfer); 13152b2325ffSGerd Hoffmann if (rc != 0) { 13162b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 13172b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 13182b2325ffSGerd Hoffmann p->status, p->actual_length); 13192b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 13202b2325ffSGerd Hoffmann usb_host_nodev(s); 13212b2325ffSGerd Hoffmann } 13222b2325ffSGerd Hoffmann return; 13232b2325ffSGerd Hoffmann } 13242b2325ffSGerd Hoffmann 13252b2325ffSGerd Hoffmann p->status = USB_RET_ASYNC; 13262b2325ffSGerd Hoffmann } 13272b2325ffSGerd Hoffmann 13282b2325ffSGerd Hoffmann static void usb_host_handle_data(USBDevice *udev, USBPacket *p) 13292b2325ffSGerd Hoffmann { 13302b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 13312b2325ffSGerd Hoffmann USBHostRequest *r; 13322b2325ffSGerd Hoffmann size_t size; 13332b2325ffSGerd Hoffmann int ep, rc; 13342b2325ffSGerd Hoffmann 13352b2325ffSGerd Hoffmann if (usb_host_use_combining(p->ep) && p->state == USB_PACKET_SETUP) { 13362b2325ffSGerd Hoffmann p->status = USB_RET_ADD_TO_QUEUE; 13372b2325ffSGerd Hoffmann return; 13382b2325ffSGerd Hoffmann } 13392b2325ffSGerd Hoffmann 13402b2325ffSGerd Hoffmann trace_usb_host_req_data(s->bus_num, s->addr, p, 13412b2325ffSGerd Hoffmann p->pid == USB_TOKEN_IN, 13422b2325ffSGerd Hoffmann p->ep->nr, p->iov.size); 13432b2325ffSGerd Hoffmann 13442b2325ffSGerd Hoffmann if (s->dh == NULL) { 13452b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 13462b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13472b2325ffSGerd Hoffmann return; 13482b2325ffSGerd Hoffmann } 13492b2325ffSGerd Hoffmann if (p->ep->halted) { 13502b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 13512b2325ffSGerd Hoffmann trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status); 13522b2325ffSGerd Hoffmann return; 13532b2325ffSGerd Hoffmann } 13542b2325ffSGerd Hoffmann 13552b2325ffSGerd Hoffmann switch (usb_ep_get_type(udev, p->pid, p->ep->nr)) { 13562b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_BULK: 13572b2325ffSGerd Hoffmann size = usb_packet_size(p); 13582b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, size); 13592b2325ffSGerd Hoffmann if (!r->in) { 13602b2325ffSGerd Hoffmann usb_packet_copy(p, r->buffer, size); 13612b2325ffSGerd Hoffmann } 13622b2325ffSGerd Hoffmann ep = p->ep->nr | (r->in ? USB_DIR_IN : 0); 13638d1bd3c9SHans de Goede if (p->stream) { 1364322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 13658d1bd3c9SHans de Goede libusb_fill_bulk_stream_transfer(r->xfer, s->dh, ep, p->stream, 13668d1bd3c9SHans de Goede r->buffer, size, 13678d1bd3c9SHans de Goede usb_host_req_complete_data, r, 13688d1bd3c9SHans de Goede BULK_TIMEOUT); 13698d1bd3c9SHans de Goede #else 13708d1bd3c9SHans de Goede usb_host_req_free(r); 13718d1bd3c9SHans de Goede p->status = USB_RET_STALL; 13728d1bd3c9SHans de Goede return; 13738d1bd3c9SHans de Goede #endif 13748d1bd3c9SHans de Goede } else { 13752b2325ffSGerd Hoffmann libusb_fill_bulk_transfer(r->xfer, s->dh, ep, 13762b2325ffSGerd Hoffmann r->buffer, size, 13772b2325ffSGerd Hoffmann usb_host_req_complete_data, r, 13782b2325ffSGerd Hoffmann BULK_TIMEOUT); 13798d1bd3c9SHans de Goede } 13802b2325ffSGerd Hoffmann break; 13812b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_INT: 13822b2325ffSGerd Hoffmann r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, p->iov.size); 13832b2325ffSGerd Hoffmann if (!r->in) { 13842b2325ffSGerd Hoffmann usb_packet_copy(p, r->buffer, p->iov.size); 13852b2325ffSGerd Hoffmann } 13862b2325ffSGerd Hoffmann ep = p->ep->nr | (r->in ? USB_DIR_IN : 0); 13872b2325ffSGerd Hoffmann libusb_fill_interrupt_transfer(r->xfer, s->dh, ep, 13882b2325ffSGerd Hoffmann r->buffer, p->iov.size, 13892b2325ffSGerd Hoffmann usb_host_req_complete_data, r, 13902b2325ffSGerd Hoffmann INTR_TIMEOUT); 13912b2325ffSGerd Hoffmann break; 13922b2325ffSGerd Hoffmann case USB_ENDPOINT_XFER_ISOC: 13932b2325ffSGerd Hoffmann if (p->pid == USB_TOKEN_IN) { 13942b2325ffSGerd Hoffmann usb_host_iso_data_in(s, p); 13952b2325ffSGerd Hoffmann } else { 13962b2325ffSGerd Hoffmann usb_host_iso_data_out(s, p); 13972b2325ffSGerd Hoffmann } 13982b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 13992b2325ffSGerd Hoffmann p->status, p->actual_length); 14002b2325ffSGerd Hoffmann return; 14012b2325ffSGerd Hoffmann default: 14022b2325ffSGerd Hoffmann p->status = USB_RET_STALL; 14032b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 14042b2325ffSGerd Hoffmann p->status, p->actual_length); 14052b2325ffSGerd Hoffmann return; 14062b2325ffSGerd Hoffmann } 14072b2325ffSGerd Hoffmann 14082b2325ffSGerd Hoffmann rc = libusb_submit_transfer(r->xfer); 14092b2325ffSGerd Hoffmann if (rc != 0) { 14102b2325ffSGerd Hoffmann p->status = USB_RET_NODEV; 14112b2325ffSGerd Hoffmann trace_usb_host_req_complete(s->bus_num, s->addr, p, 14122b2325ffSGerd Hoffmann p->status, p->actual_length); 14132b2325ffSGerd Hoffmann if (rc == LIBUSB_ERROR_NO_DEVICE) { 14142b2325ffSGerd Hoffmann usb_host_nodev(s); 14152b2325ffSGerd Hoffmann } 14162b2325ffSGerd Hoffmann return; 14172b2325ffSGerd Hoffmann } 14182b2325ffSGerd Hoffmann 14192b2325ffSGerd Hoffmann p->status = USB_RET_ASYNC; 14202b2325ffSGerd Hoffmann } 14212b2325ffSGerd Hoffmann 14222b2325ffSGerd Hoffmann static void usb_host_flush_ep_queue(USBDevice *dev, USBEndpoint *ep) 14232b2325ffSGerd Hoffmann { 14242b2325ffSGerd Hoffmann if (usb_host_use_combining(ep)) { 14252b2325ffSGerd Hoffmann usb_ep_combine_input_packets(ep); 14262b2325ffSGerd Hoffmann } 14272b2325ffSGerd Hoffmann } 14282b2325ffSGerd Hoffmann 14292b2325ffSGerd Hoffmann static void usb_host_handle_reset(USBDevice *udev) 14302b2325ffSGerd Hoffmann { 14312b2325ffSGerd Hoffmann USBHostDevice *s = USB_HOST_DEVICE(udev); 14325af35d7fSHans de Goede int rc; 14332b2325ffSGerd Hoffmann 14342b2325ffSGerd Hoffmann trace_usb_host_reset(s->bus_num, s->addr); 14352b2325ffSGerd Hoffmann 14365af35d7fSHans de Goede rc = libusb_reset_device(s->dh); 14375af35d7fSHans de Goede if (rc != 0) { 14385af35d7fSHans de Goede usb_host_nodev(s); 14392b2325ffSGerd Hoffmann } 14402b2325ffSGerd Hoffmann } 14412b2325ffSGerd Hoffmann 144256a9f180SHans de Goede static int usb_host_alloc_streams(USBDevice *udev, USBEndpoint **eps, 144356a9f180SHans de Goede int nr_eps, int streams) 144456a9f180SHans de Goede { 1445322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 144656a9f180SHans de Goede USBHostDevice *s = USB_HOST_DEVICE(udev); 144756a9f180SHans de Goede unsigned char endpoints[30]; 144856a9f180SHans de Goede int i, rc; 144956a9f180SHans de Goede 145056a9f180SHans de Goede for (i = 0; i < nr_eps; i++) { 145156a9f180SHans de Goede endpoints[i] = eps[i]->nr; 145256a9f180SHans de Goede if (eps[i]->pid == USB_TOKEN_IN) { 145356a9f180SHans de Goede endpoints[i] |= 0x80; 145456a9f180SHans de Goede } 145556a9f180SHans de Goede } 145656a9f180SHans de Goede rc = libusb_alloc_streams(s->dh, streams, endpoints, nr_eps); 145756a9f180SHans de Goede if (rc < 0) { 145856a9f180SHans de Goede usb_host_libusb_error("libusb_alloc_streams", rc); 145956a9f180SHans de Goede } else if (rc != streams) { 14602e6a0dd1SGonglei error_report("libusb_alloc_streams: got less streams " 14612e6a0dd1SGonglei "then requested %d < %d", rc, streams); 146256a9f180SHans de Goede } 146356a9f180SHans de Goede 146456a9f180SHans de Goede return (rc == streams) ? 0 : -1; 146556a9f180SHans de Goede #else 14662e6a0dd1SGonglei error_report("libusb_alloc_streams: error not implemented"); 146756a9f180SHans de Goede return -1; 146856a9f180SHans de Goede #endif 146956a9f180SHans de Goede } 147056a9f180SHans de Goede 147156a9f180SHans de Goede static void usb_host_free_streams(USBDevice *udev, USBEndpoint **eps, 147256a9f180SHans de Goede int nr_eps) 147356a9f180SHans de Goede { 1474322fd1f4SGerd Hoffmann #ifdef HAVE_STREAMS 147556a9f180SHans de Goede USBHostDevice *s = USB_HOST_DEVICE(udev); 147656a9f180SHans de Goede unsigned char endpoints[30]; 147756a9f180SHans de Goede int i; 147856a9f180SHans de Goede 147956a9f180SHans de Goede for (i = 0; i < nr_eps; i++) { 148056a9f180SHans de Goede endpoints[i] = eps[i]->nr; 148156a9f180SHans de Goede if (eps[i]->pid == USB_TOKEN_IN) { 148256a9f180SHans de Goede endpoints[i] |= 0x80; 148356a9f180SHans de Goede } 148456a9f180SHans de Goede } 148556a9f180SHans de Goede libusb_free_streams(s->dh, endpoints, nr_eps); 148656a9f180SHans de Goede #endif 148756a9f180SHans de Goede } 148856a9f180SHans de Goede 148995efb20cSGerd Hoffmann /* 149095efb20cSGerd Hoffmann * This is *NOT* about restoring state. We have absolutely no idea 149195efb20cSGerd Hoffmann * what state the host device is in at the moment and whenever it is 149295efb20cSGerd Hoffmann * still present in the first place. Attemping to contine where we 149395efb20cSGerd Hoffmann * left off is impossible. 149495efb20cSGerd Hoffmann * 1495b6af0975SDaniel P. Berrange * What we are going to do here is emulate a surprise removal of 149695efb20cSGerd Hoffmann * the usb device passed through, then kick host scan so the device 149795efb20cSGerd Hoffmann * will get re-attached (and re-initialized by the guest) in case it 149895efb20cSGerd Hoffmann * is still present. 149995efb20cSGerd Hoffmann * 150095efb20cSGerd Hoffmann * As the device removal will change the state of other devices (usb 150195efb20cSGerd Hoffmann * host controller, most likely interrupt controller too) we have to 150295efb20cSGerd Hoffmann * wait with it until *all* vmstate is loaded. Thus post_load just 150395efb20cSGerd Hoffmann * kicks a bottom half which then does the actual work. 150495efb20cSGerd Hoffmann */ 150595efb20cSGerd Hoffmann static void usb_host_post_load_bh(void *opaque) 150695efb20cSGerd Hoffmann { 150795efb20cSGerd Hoffmann USBHostDevice *dev = opaque; 150895efb20cSGerd Hoffmann USBDevice *udev = USB_DEVICE(dev); 150995efb20cSGerd Hoffmann 151095efb20cSGerd Hoffmann if (dev->dh != NULL) { 151195efb20cSGerd Hoffmann usb_host_close(dev); 151295efb20cSGerd Hoffmann } 151395efb20cSGerd Hoffmann if (udev->attached) { 151495efb20cSGerd Hoffmann usb_device_detach(udev); 151595efb20cSGerd Hoffmann } 151695efb20cSGerd Hoffmann usb_host_auto_check(NULL); 151795efb20cSGerd Hoffmann } 151895efb20cSGerd Hoffmann 151995efb20cSGerd Hoffmann static int usb_host_post_load(void *opaque, int version_id) 152095efb20cSGerd Hoffmann { 152195efb20cSGerd Hoffmann USBHostDevice *dev = opaque; 152295efb20cSGerd Hoffmann 152395efb20cSGerd Hoffmann if (!dev->bh_postld) { 152495efb20cSGerd Hoffmann dev->bh_postld = qemu_bh_new(usb_host_post_load_bh, dev); 152595efb20cSGerd Hoffmann } 152695efb20cSGerd Hoffmann qemu_bh_schedule(dev->bh_postld); 152795efb20cSGerd Hoffmann return 0; 152895efb20cSGerd Hoffmann } 152995efb20cSGerd Hoffmann 15302b2325ffSGerd Hoffmann static const VMStateDescription vmstate_usb_host = { 15312b2325ffSGerd Hoffmann .name = "usb-host", 153295efb20cSGerd Hoffmann .version_id = 1, 153395efb20cSGerd Hoffmann .minimum_version_id = 1, 153495efb20cSGerd Hoffmann .post_load = usb_host_post_load, 15352b2325ffSGerd Hoffmann .fields = (VMStateField[]) { 15362b2325ffSGerd Hoffmann VMSTATE_USB_DEVICE(parent_obj, USBHostDevice), 15372b2325ffSGerd Hoffmann VMSTATE_END_OF_LIST() 15382b2325ffSGerd Hoffmann } 15392b2325ffSGerd Hoffmann }; 15402b2325ffSGerd Hoffmann 15412b2325ffSGerd Hoffmann static Property usb_host_dev_properties[] = { 15422b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("hostbus", USBHostDevice, match.bus_num, 0), 15432b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("hostaddr", USBHostDevice, match.addr, 0), 15442b2325ffSGerd Hoffmann DEFINE_PROP_STRING("hostport", USBHostDevice, match.port), 1545c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT32("vendorid", USBHostDevice, match.vendor_id, 0), 1546c7bcc85dSPaolo Bonzini DEFINE_PROP_UINT32("productid", USBHostDevice, match.product_id, 0), 15472b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("isobufs", USBHostDevice, iso_urb_count, 4), 15482b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("isobsize", USBHostDevice, iso_urb_frames, 32), 15492b2325ffSGerd Hoffmann DEFINE_PROP_UINT32("loglevel", USBHostDevice, loglevel, 15502b2325ffSGerd Hoffmann LIBUSB_LOG_LEVEL_WARNING), 15512b2325ffSGerd Hoffmann DEFINE_PROP_BIT("pipeline", USBHostDevice, options, 15522b2325ffSGerd Hoffmann USB_HOST_OPT_PIPELINE, true), 15532b2325ffSGerd Hoffmann DEFINE_PROP_END_OF_LIST(), 15542b2325ffSGerd Hoffmann }; 15552b2325ffSGerd Hoffmann 15562b2325ffSGerd Hoffmann static void usb_host_class_initfn(ObjectClass *klass, void *data) 15572b2325ffSGerd Hoffmann { 15582b2325ffSGerd Hoffmann DeviceClass *dc = DEVICE_CLASS(klass); 15592b2325ffSGerd Hoffmann USBDeviceClass *uc = USB_DEVICE_CLASS(klass); 15602b2325ffSGerd Hoffmann 15612aa76dc1SGonglei uc->realize = usb_host_realize; 15622b2325ffSGerd Hoffmann uc->product_desc = "USB Host Device"; 15632b2325ffSGerd Hoffmann uc->cancel_packet = usb_host_cancel_packet; 15642b2325ffSGerd Hoffmann uc->handle_data = usb_host_handle_data; 15652b2325ffSGerd Hoffmann uc->handle_control = usb_host_handle_control; 15662b2325ffSGerd Hoffmann uc->handle_reset = usb_host_handle_reset; 15672b2325ffSGerd Hoffmann uc->handle_destroy = usb_host_handle_destroy; 15682b2325ffSGerd Hoffmann uc->flush_ep_queue = usb_host_flush_ep_queue; 156956a9f180SHans de Goede uc->alloc_streams = usb_host_alloc_streams; 157056a9f180SHans de Goede uc->free_streams = usb_host_free_streams; 15712b2325ffSGerd Hoffmann dc->vmsd = &vmstate_usb_host; 15722b2325ffSGerd Hoffmann dc->props = usb_host_dev_properties; 1573125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); 15742b2325ffSGerd Hoffmann } 15752b2325ffSGerd Hoffmann 15762b2325ffSGerd Hoffmann static TypeInfo usb_host_dev_info = { 15772b2325ffSGerd Hoffmann .name = TYPE_USB_HOST_DEVICE, 15782b2325ffSGerd Hoffmann .parent = TYPE_USB_DEVICE, 15792b2325ffSGerd Hoffmann .instance_size = sizeof(USBHostDevice), 15802b2325ffSGerd Hoffmann .class_init = usb_host_class_initfn, 1581e6adae52SGonglei .instance_init = usb_host_instance_init, 15822b2325ffSGerd Hoffmann }; 15832b2325ffSGerd Hoffmann 15842b2325ffSGerd Hoffmann static void usb_host_register_types(void) 15852b2325ffSGerd Hoffmann { 15862b2325ffSGerd Hoffmann type_register_static(&usb_host_dev_info); 15872b2325ffSGerd Hoffmann } 15882b2325ffSGerd Hoffmann 15892b2325ffSGerd Hoffmann type_init(usb_host_register_types) 15902b2325ffSGerd Hoffmann 15912b2325ffSGerd Hoffmann /* ------------------------------------------------------------------------ */ 15922b2325ffSGerd Hoffmann 15932b2325ffSGerd Hoffmann static QEMUTimer *usb_auto_timer; 15942b2325ffSGerd Hoffmann static VMChangeStateEntry *usb_vmstate; 15952b2325ffSGerd Hoffmann 15962b2325ffSGerd Hoffmann static void usb_host_vm_state(void *unused, int running, RunState state) 15972b2325ffSGerd Hoffmann { 15982b2325ffSGerd Hoffmann if (running) { 15992b2325ffSGerd Hoffmann usb_host_auto_check(unused); 16002b2325ffSGerd Hoffmann } 16012b2325ffSGerd Hoffmann } 16022b2325ffSGerd Hoffmann 16032b2325ffSGerd Hoffmann static void usb_host_auto_check(void *unused) 16042b2325ffSGerd Hoffmann { 16052b2325ffSGerd Hoffmann struct USBHostDevice *s; 16062b2325ffSGerd Hoffmann struct USBAutoFilter *f; 16073ce21445SJincheng Miao libusb_device **devs = NULL; 16082b2325ffSGerd Hoffmann struct libusb_device_descriptor ddesc; 16092b2325ffSGerd Hoffmann int unconnected = 0; 16102b2325ffSGerd Hoffmann int i, n; 16112b2325ffSGerd Hoffmann 16122b2325ffSGerd Hoffmann if (usb_host_init() != 0) { 16132b2325ffSGerd Hoffmann return; 16142b2325ffSGerd Hoffmann } 16152b2325ffSGerd Hoffmann 16162b2325ffSGerd Hoffmann if (runstate_is_running()) { 16172b2325ffSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 16182b2325ffSGerd Hoffmann for (i = 0; i < n; i++) { 16192b2325ffSGerd Hoffmann if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) { 16202b2325ffSGerd Hoffmann continue; 16212b2325ffSGerd Hoffmann } 16222b2325ffSGerd Hoffmann if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) { 16232b2325ffSGerd Hoffmann continue; 16242b2325ffSGerd Hoffmann } 16252b2325ffSGerd Hoffmann QTAILQ_FOREACH(s, &hostdevs, next) { 16262b2325ffSGerd Hoffmann f = &s->match; 16272b2325ffSGerd Hoffmann if (f->bus_num > 0 && 16282b2325ffSGerd Hoffmann f->bus_num != libusb_get_bus_number(devs[i])) { 16292b2325ffSGerd Hoffmann continue; 16302b2325ffSGerd Hoffmann } 16312b2325ffSGerd Hoffmann if (f->addr > 0 && 16322b2325ffSGerd Hoffmann f->addr != libusb_get_device_address(devs[i])) { 16332b2325ffSGerd Hoffmann continue; 16342b2325ffSGerd Hoffmann } 16352b2325ffSGerd Hoffmann if (f->port != NULL) { 16362b2325ffSGerd Hoffmann char port[16] = "-"; 16372b2325ffSGerd Hoffmann usb_host_get_port(devs[i], port, sizeof(port)); 16382b2325ffSGerd Hoffmann if (strcmp(f->port, port) != 0) { 16392b2325ffSGerd Hoffmann continue; 16402b2325ffSGerd Hoffmann } 16412b2325ffSGerd Hoffmann } 16422b2325ffSGerd Hoffmann if (f->vendor_id > 0 && 16432b2325ffSGerd Hoffmann f->vendor_id != ddesc.idVendor) { 16442b2325ffSGerd Hoffmann continue; 16452b2325ffSGerd Hoffmann } 16462b2325ffSGerd Hoffmann if (f->product_id > 0 && 16472b2325ffSGerd Hoffmann f->product_id != ddesc.idProduct) { 16482b2325ffSGerd Hoffmann continue; 16492b2325ffSGerd Hoffmann } 16502b2325ffSGerd Hoffmann 16512b2325ffSGerd Hoffmann /* We got a match */ 16522b2325ffSGerd Hoffmann s->seen++; 16532b2325ffSGerd Hoffmann if (s->errcount >= 3) { 16542b2325ffSGerd Hoffmann continue; 16552b2325ffSGerd Hoffmann } 16562b2325ffSGerd Hoffmann if (s->dh != NULL) { 16572b2325ffSGerd Hoffmann continue; 16582b2325ffSGerd Hoffmann } 16592b2325ffSGerd Hoffmann if (usb_host_open(s, devs[i]) < 0) { 16602b2325ffSGerd Hoffmann s->errcount++; 16612b2325ffSGerd Hoffmann continue; 16622b2325ffSGerd Hoffmann } 16632b2325ffSGerd Hoffmann break; 16642b2325ffSGerd Hoffmann } 16652b2325ffSGerd Hoffmann } 16662b2325ffSGerd Hoffmann libusb_free_device_list(devs, 1); 16672b2325ffSGerd Hoffmann 16682b2325ffSGerd Hoffmann QTAILQ_FOREACH(s, &hostdevs, next) { 16692b2325ffSGerd Hoffmann if (s->dh == NULL) { 16702b2325ffSGerd Hoffmann unconnected++; 16712b2325ffSGerd Hoffmann } 16722b2325ffSGerd Hoffmann if (s->seen == 0) { 16732b2325ffSGerd Hoffmann if (s->dh) { 16742b2325ffSGerd Hoffmann usb_host_close(s); 16752b2325ffSGerd Hoffmann } 16762b2325ffSGerd Hoffmann s->errcount = 0; 16772b2325ffSGerd Hoffmann } 16782b2325ffSGerd Hoffmann s->seen = 0; 16792b2325ffSGerd Hoffmann } 16802b2325ffSGerd Hoffmann 16812b2325ffSGerd Hoffmann #if 0 16822b2325ffSGerd Hoffmann if (unconnected == 0) { 16832b2325ffSGerd Hoffmann /* nothing to watch */ 16842b2325ffSGerd Hoffmann if (usb_auto_timer) { 1685bc72ad67SAlex Bligh timer_del(usb_auto_timer); 16862b2325ffSGerd Hoffmann trace_usb_host_auto_scan_disabled(); 16872b2325ffSGerd Hoffmann } 16882b2325ffSGerd Hoffmann return; 16892b2325ffSGerd Hoffmann } 16902b2325ffSGerd Hoffmann #endif 16912b2325ffSGerd Hoffmann } 16922b2325ffSGerd Hoffmann 16932b2325ffSGerd Hoffmann if (!usb_vmstate) { 16942b2325ffSGerd Hoffmann usb_vmstate = qemu_add_vm_change_state_handler(usb_host_vm_state, NULL); 16952b2325ffSGerd Hoffmann } 16962b2325ffSGerd Hoffmann if (!usb_auto_timer) { 1697bc72ad67SAlex Bligh usb_auto_timer = timer_new_ms(QEMU_CLOCK_REALTIME, usb_host_auto_check, NULL); 16982b2325ffSGerd Hoffmann if (!usb_auto_timer) { 16992b2325ffSGerd Hoffmann return; 17002b2325ffSGerd Hoffmann } 17012b2325ffSGerd Hoffmann trace_usb_host_auto_scan_enabled(); 17022b2325ffSGerd Hoffmann } 1703bc72ad67SAlex Bligh timer_mod(usb_auto_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 2000); 17042b2325ffSGerd Hoffmann } 17052b2325ffSGerd Hoffmann 17061ce6be24SMarkus Armbruster void hmp_info_usbhost(Monitor *mon, const QDict *qdict) 17072b2325ffSGerd Hoffmann { 17083ce21445SJincheng Miao libusb_device **devs = NULL; 17092b2325ffSGerd Hoffmann struct libusb_device_descriptor ddesc; 17102b2325ffSGerd Hoffmann char port[16]; 17112b2325ffSGerd Hoffmann int i, n; 17122b2325ffSGerd Hoffmann 17132b2325ffSGerd Hoffmann if (usb_host_init() != 0) { 17142b2325ffSGerd Hoffmann return; 17152b2325ffSGerd Hoffmann } 17162b2325ffSGerd Hoffmann 17172b2325ffSGerd Hoffmann n = libusb_get_device_list(ctx, &devs); 17182b2325ffSGerd Hoffmann for (i = 0; i < n; i++) { 17192b2325ffSGerd Hoffmann if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) { 17202b2325ffSGerd Hoffmann continue; 17212b2325ffSGerd Hoffmann } 17222b2325ffSGerd Hoffmann if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) { 17232b2325ffSGerd Hoffmann continue; 17242b2325ffSGerd Hoffmann } 17252b2325ffSGerd Hoffmann usb_host_get_port(devs[i], port, sizeof(port)); 17262b2325ffSGerd Hoffmann monitor_printf(mon, " Bus %d, Addr %d, Port %s, Speed %s Mb/s\n", 17272b2325ffSGerd Hoffmann libusb_get_bus_number(devs[i]), 17282b2325ffSGerd Hoffmann libusb_get_device_address(devs[i]), 17292b2325ffSGerd Hoffmann port, 17302b2325ffSGerd Hoffmann speed_name[libusb_get_device_speed(devs[i])]); 17312b2325ffSGerd Hoffmann monitor_printf(mon, " Class %02x:", ddesc.bDeviceClass); 17322b2325ffSGerd Hoffmann monitor_printf(mon, " USB device %04x:%04x", 17332b2325ffSGerd Hoffmann ddesc.idVendor, ddesc.idProduct); 17342b2325ffSGerd Hoffmann if (ddesc.iProduct) { 17352b2325ffSGerd Hoffmann libusb_device_handle *handle; 17362b2325ffSGerd Hoffmann if (libusb_open(devs[i], &handle) == 0) { 17372b2325ffSGerd Hoffmann unsigned char name[64] = ""; 17382b2325ffSGerd Hoffmann libusb_get_string_descriptor_ascii(handle, 17392b2325ffSGerd Hoffmann ddesc.iProduct, 17402b2325ffSGerd Hoffmann name, sizeof(name)); 17412b2325ffSGerd Hoffmann libusb_close(handle); 17422b2325ffSGerd Hoffmann monitor_printf(mon, ", %s", name); 17432b2325ffSGerd Hoffmann } 17442b2325ffSGerd Hoffmann } 17452b2325ffSGerd Hoffmann monitor_printf(mon, "\n"); 17462b2325ffSGerd Hoffmann } 17472b2325ffSGerd Hoffmann libusb_free_device_list(devs, 1); 17482b2325ffSGerd Hoffmann } 1749