?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
hw/isa/Kconfig: Add missing dependency VIA VT82C686 -> APM
[qemu/ar7.git] / hw / usb / host-libusb.c
blob2518306f527f17d2be30138192c723154a5f114c
1 /*
2 * Linux host USB redirector
3 *
4 * Copyright (c) 2005 Fabrice Bellard
5 *
6 * Copyright (c) 2008 Max Krasnyansky
7 * Support for host device auto connect & disconnect
8 * Major rewrite to support fully async operation
9 *
10 * Copyright 2008 TJ <linux@tjworld.net>
11 * Added flexible support for /dev/bus/usb /sys/bus/usb/devices in addition
12 * to the legacy /proc/bus/usb USB device discovery and handling
13 *
14 * (c) 2012 Gerd Hoffmann <kraxel@redhat.com>
15 * Completely rewritten to use libusb instead of usbfs ioctls.
16 *
17 * Permission is hereby granted, free of charge, to any person obtaining a copy
18 * of this software and associated documentation files (the "Software"), to deal
19 * in the Software without restriction, including without limitation the rights
20 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
21 * copies of the Software, and to permit persons to whom the Software is
22 * furnished to do so, subject to the following conditions:
23 *
24 * The above copyright notice and this permission notice shall be included in
25 * all copies or substantial portions of the Software.
26 *
27 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
28 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
29 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
30 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
31 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
32 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
33 * THE SOFTWARE.
34 */
35
36 #include "qemu/osdep.h"
37 #include "qom/object.h"
38 #ifndef CONFIG_WIN32
39 #include <poll.h>
40 #endif
41 #include <libusb.h>
42
43 #ifdef CONFIG_LINUX
44 #include <sys/ioctl.h>
45 #include <linux/usbdevice_fs.h>
46 #endif
47
48 #include "qapi/error.h"
49 #include "migration/vmstate.h"
50 #include "monitor/monitor.h"
51 #include "qemu/error-report.h"
52 #include "qemu/main-loop.h"
53 #include "qemu/module.h"
54 #include "sysemu/runstate.h"
55 #include "sysemu/sysemu.h"
56 #include "trace.h"
57
58 #include "hw/qdev-properties.h"
59 #include "hw/usb.h"
60
61 /* ------------------------------------------------------------------------ */
62
63 #define TYPE_USB_HOST_DEVICE "usb-host"
64 OBJECT_DECLARE_SIMPLE_TYPE(USBHostDevice, USB_HOST_DEVICE)
65
66 typedef struct USBHostRequest USBHostRequest;
67 typedef struct USBHostIsoXfer USBHostIsoXfer;
68 typedef struct USBHostIsoRing USBHostIsoRing;
69
70 struct USBAutoFilter {
71 uint32_t bus_num;
72 uint32_t addr;
73 char *port;
74 uint32_t vendor_id;
75 uint32_t product_id;
76 };
77
78 enum USBHostDeviceOptions {
79 USB_HOST_OPT_PIPELINE,
80 };
81
82 struct USBHostDevice {
83 USBDevice parent_obj;
84
85 /* properties */
86 struct USBAutoFilter match;
87 char *hostdevice;
88 int32_t bootindex;
89 uint32_t iso_urb_count;
90 uint32_t iso_urb_frames;
91 uint32_t options;
92 uint32_t loglevel;
93 bool needs_autoscan;
94 bool allow_one_guest_reset;
95 bool allow_all_guest_resets;
96 bool suppress_remote_wake;
97
98 /* state */
99 QTAILQ_ENTRY(USBHostDevice) next;
100 int seen, errcount;
101 int bus_num;
102 int addr;
103 char port[16];
104
105 int hostfd;
106 libusb_device *dev;
107 libusb_device_handle *dh;
108 struct libusb_device_descriptor ddesc;
109
110 struct {
111 bool detached;
112 bool claimed;
113 } ifs[USB_MAX_INTERFACES];
114
115 /* callbacks & friends */
116 QEMUBH *bh_nodev;
117 QEMUBH *bh_postld;
118 bool bh_postld_pending;
119 Notifier exit;
120
121 /* request queues */
122 QTAILQ_HEAD(, USBHostRequest) requests;
123 QTAILQ_HEAD(, USBHostIsoRing) isorings;
124 };
125
126 struct USBHostRequest {
127 USBHostDevice *host;
128 USBPacket *p;
129 bool in;
130 struct libusb_transfer *xfer;
131 unsigned char *buffer;
132 unsigned char *cbuf;
133 unsigned int clen;
134 bool usb3ep0quirk;
135 QTAILQ_ENTRY(USBHostRequest) next;
136 };
137
138 struct USBHostIsoXfer {
139 USBHostIsoRing *ring;
140 struct libusb_transfer *xfer;
141 bool copy_complete;
142 unsigned int packet;
143 QTAILQ_ENTRY(USBHostIsoXfer) next;
144 };
145
146 struct USBHostIsoRing {
147 USBHostDevice *host;
148 USBEndpoint *ep;
149 QTAILQ_HEAD(, USBHostIsoXfer) unused;
150 QTAILQ_HEAD(, USBHostIsoXfer) inflight;
151 QTAILQ_HEAD(, USBHostIsoXfer) copy;
152 QTAILQ_ENTRY(USBHostIsoRing) next;
153 };
154
155 static QTAILQ_HEAD(, USBHostDevice) hostdevs =
156 QTAILQ_HEAD_INITIALIZER(hostdevs);
157
158 static void usb_host_auto_check(void *unused);
159 static void usb_host_release_interfaces(USBHostDevice *s);
160 static void usb_host_nodev(USBHostDevice *s);
161 static void usb_host_detach_kernel(USBHostDevice *s);
162 static void usb_host_attach_kernel(USBHostDevice *s);
163
164 /* ------------------------------------------------------------------------ */
165
166 #ifndef LIBUSB_LOG_LEVEL_WARNING /* older libusb didn't define these */
167 #define LIBUSB_LOG_LEVEL_WARNING 2
168 #endif
169
170 /* ------------------------------------------------------------------------ */
171
172 #define CONTROL_TIMEOUT 10000 /* 10 sec */
173 #define BULK_TIMEOUT 0 /* unlimited */
174 #define INTR_TIMEOUT 0 /* unlimited */
175
176 #ifndef LIBUSB_API_VERSION
177 # define LIBUSB_API_VERSION LIBUSBX_API_VERSION
178 #endif
179 #if LIBUSB_API_VERSION >= 0x01000103
180 # define HAVE_STREAMS 1
181 #endif
182 #if LIBUSB_API_VERSION >= 0x01000106
183 # define HAVE_SUPER_PLUS 1
184 #endif
185
186 static const char *speed_name[] = {
187 [LIBUSB_SPEED_UNKNOWN] = "?",
188 [LIBUSB_SPEED_LOW] = "1.5",
189 [LIBUSB_SPEED_FULL] = "12",
190 [LIBUSB_SPEED_HIGH] = "480",
191 [LIBUSB_SPEED_SUPER] = "5000",
192 #ifdef HAVE_SUPER_PLUS
193 [LIBUSB_SPEED_SUPER_PLUS] = "5000+",
194 #endif
195 };
196
197 static const unsigned int speed_map[] = {
198 [LIBUSB_SPEED_LOW] = USB_SPEED_LOW,
199 [LIBUSB_SPEED_FULL] = USB_SPEED_FULL,
200 [LIBUSB_SPEED_HIGH] = USB_SPEED_HIGH,
201 [LIBUSB_SPEED_SUPER] = USB_SPEED_SUPER,
202 #ifdef HAVE_SUPER_PLUS
203 [LIBUSB_SPEED_SUPER_PLUS] = USB_SPEED_SUPER,
204 #endif
205 };
206
207 static const unsigned int status_map[] = {
208 [LIBUSB_TRANSFER_COMPLETED] = USB_RET_SUCCESS,
209 [LIBUSB_TRANSFER_ERROR] = USB_RET_IOERROR,
210 [LIBUSB_TRANSFER_TIMED_OUT] = USB_RET_IOERROR,
211 [LIBUSB_TRANSFER_CANCELLED] = USB_RET_IOERROR,
212 [LIBUSB_TRANSFER_STALL] = USB_RET_STALL,
213 [LIBUSB_TRANSFER_NO_DEVICE] = USB_RET_NODEV,
214 [LIBUSB_TRANSFER_OVERFLOW] = USB_RET_BABBLE,
215 };
216
217 static const char *err_names[] = {
218 [-LIBUSB_ERROR_IO] = "IO",
219 [-LIBUSB_ERROR_INVALID_PARAM] = "INVALID_PARAM",
220 [-LIBUSB_ERROR_ACCESS] = "ACCESS",
221 [-LIBUSB_ERROR_NO_DEVICE] = "NO_DEVICE",
222 [-LIBUSB_ERROR_NOT_FOUND] = "NOT_FOUND",
223 [-LIBUSB_ERROR_BUSY] = "BUSY",
224 [-LIBUSB_ERROR_TIMEOUT] = "TIMEOUT",
225 [-LIBUSB_ERROR_OVERFLOW] = "OVERFLOW",
226 [-LIBUSB_ERROR_PIPE] = "PIPE",
227 [-LIBUSB_ERROR_INTERRUPTED] = "INTERRUPTED",
228 [-LIBUSB_ERROR_NO_MEM] = "NO_MEM",
229 [-LIBUSB_ERROR_NOT_SUPPORTED] = "NOT_SUPPORTED",
230 [-LIBUSB_ERROR_OTHER] = "OTHER",
231 };
232
233 static libusb_context *ctx;
234 static uint32_t loglevel;
235
236 #ifndef CONFIG_WIN32
237
238 static void usb_host_handle_fd(void *opaque)
239 {
240 struct timeval tv = { 0, 0 };
241 libusb_handle_events_timeout(ctx, &tv);
242 }
243
244 static void usb_host_add_fd(int fd, short events, void *user_data)
245 {
246 qemu_set_fd_handler(fd,
247 (events & POLLIN) ? usb_host_handle_fd : NULL,
248 (events & POLLOUT) ? usb_host_handle_fd : NULL,
249 ctx);
250 }
251
252 static void usb_host_del_fd(int fd, void *user_data)
253 {
254 qemu_set_fd_handler(fd, NULL, NULL, NULL);
255 }
256
257 #endif /* !CONFIG_WIN32 */
258
259 static int usb_host_init(void)
260 {
261 #ifndef CONFIG_WIN32
262 const struct libusb_pollfd **poll;
263 #endif
264 int rc;
265
266 if (ctx) {
267 return 0;
268 }
269 rc = libusb_init(&ctx);
270 if (rc != 0) {
271 return -1;
272 }
273 #if LIBUSB_API_VERSION >= 0x01000106
274 libusb_set_option(ctx, LIBUSB_OPTION_LOG_LEVEL, loglevel);
275 #else
276 libusb_set_debug(ctx, loglevel);
277 #endif
278 #ifdef CONFIG_WIN32
279 /* FIXME: add support for Windows. */
280 #else
281 libusb_set_pollfd_notifiers(ctx, usb_host_add_fd,
282 usb_host_del_fd,
283 ctx);
284 poll = libusb_get_pollfds(ctx);
285 if (poll) {
286 int i;
287 for (i = 0; poll[i] != NULL; i++) {
288 usb_host_add_fd(poll[i]->fd, poll[i]->events, ctx);
289 }
290 }
291 free(poll);
292 #endif
293 return 0;
294 }
295
296 static int usb_host_get_port(libusb_device *dev, char *port, size_t len)
297 {
298 uint8_t path[7];
299 size_t off;
300 int rc, i;
301
302 #if LIBUSB_API_VERSION >= 0x01000102
303 rc = libusb_get_port_numbers(dev, path, 7);
304 #else
305 rc = libusb_get_port_path(ctx, dev, path, 7);
306 #endif
307 if (rc < 0) {
308 return 0;
309 }
310 off = snprintf(port, len, "%d", path[0]);
311 for (i = 1; i < rc; i++) {
312 off += snprintf(port+off, len-off, ".%d", path[i]);
313 }
314 return off;
315 }
316
317 static void usb_host_libusb_error(const char *func, int rc)
318 {
319 const char *errname;
320
321 if (rc >= 0) {
322 return;
323 }
324
325 if (-rc < ARRAY_SIZE(err_names) && err_names[-rc]) {
326 errname = err_names[-rc];
327 } else {
328 errname = "?";
329 }
330 error_report("%s: %d [%s]", func, rc, errname);
331 }
332
333 /* ------------------------------------------------------------------------ */
334
335 static bool usb_host_use_combining(USBEndpoint *ep)
336 {
337 int type;
338
339 if (!ep->pipeline) {
340 return false;
341 }
342 if (ep->pid != USB_TOKEN_IN) {
343 return false;
344 }
345 type = usb_ep_get_type(ep->dev, ep->pid, ep->nr);
346 if (type != USB_ENDPOINT_XFER_BULK) {
347 return false;
348 }
349 return true;
350 }
351
352 /* ------------------------------------------------------------------------ */
353
354 static USBHostRequest *usb_host_req_alloc(USBHostDevice *s, USBPacket *p,
355 bool in, size_t bufsize)
356 {
357 USBHostRequest *r = g_new0(USBHostRequest, 1);
358
359 r->host = s;
360 r->p = p;
361 r->in = in;
362 r->xfer = libusb_alloc_transfer(0);
363 if (bufsize) {
364 r->buffer = g_malloc(bufsize);
365 }
366 QTAILQ_INSERT_TAIL(&s->requests, r, next);
367 return r;
368 }
369
370 static void usb_host_req_free(USBHostRequest *r)
371 {
372 QTAILQ_REMOVE(&r->host->requests, r, next);
373 libusb_free_transfer(r->xfer);
374 g_free(r->buffer);
375 g_free(r);
376 }
377
378 static USBHostRequest *usb_host_req_find(USBHostDevice *s, USBPacket *p)
379 {
380 USBHostRequest *r;
381
382 QTAILQ_FOREACH(r, &s->requests, next) {
383 if (r->p == p) {
384 return r;
385 }
386 }
387 return NULL;
388 }
389
390 static void LIBUSB_CALL usb_host_req_complete_ctrl(struct libusb_transfer *xfer)
391 {
392 USBHostRequest *r = xfer->user_data;
393 USBHostDevice *s = r->host;
394 bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE);
395
396 if (r->p == NULL) {
397 goto out; /* request was canceled */
398 }
399
400 r->p->status = status_map[xfer->status];
401 r->p->actual_length = xfer->actual_length;
402 if (r->in && xfer->actual_length) {
403 USBDevice *udev = USB_DEVICE(s);
404 struct libusb_config_descriptor *conf = (void *)r->cbuf;
405 memcpy(r->cbuf, r->buffer + 8, xfer->actual_length);
406
407 /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices
408 * to work redirected to a not superspeed capable hcd */
409 if (r->usb3ep0quirk && xfer->actual_length >= 18 &&
410 r->cbuf[7] == 9) {
411 r->cbuf[7] = 64;
412 }
413 /*
414 *If this is GET_DESCRIPTOR request for configuration descriptor,
415 * remove 'remote wakeup' flag from it to prevent idle power down
416 * in Windows guest
417 */
418 if (s->suppress_remote_wake &&
419 udev->setup_buf[0] == USB_DIR_IN &&
420 udev->setup_buf[1] == USB_REQ_GET_DESCRIPTOR &&
421 udev->setup_buf[3] == USB_DT_CONFIG && udev->setup_buf[2] == 0 &&
422 xfer->actual_length >
423 offsetof(struct libusb_config_descriptor, bmAttributes) &&
424 (conf->bmAttributes & USB_CFG_ATT_WAKEUP)) {
425 trace_usb_host_remote_wakeup_removed(s->bus_num, s->addr);
426 conf->bmAttributes &= ~USB_CFG_ATT_WAKEUP;
427 }
428 }
429 trace_usb_host_req_complete(s->bus_num, s->addr, r->p,
430 r->p->status, r->p->actual_length);
431 usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p);
432
433 out:
434 usb_host_req_free(r);
435 if (disconnect) {
436 usb_host_nodev(s);
437 }
438 }
439
440 static void LIBUSB_CALL usb_host_req_complete_data(struct libusb_transfer *xfer)
441 {
442 USBHostRequest *r = xfer->user_data;
443 USBHostDevice *s = r->host;
444 bool disconnect = (xfer->status == LIBUSB_TRANSFER_NO_DEVICE);
445
446 if (r->p == NULL) {
447 goto out; /* request was canceled */
448 }
449
450 r->p->status = status_map[xfer->status];
451 if (r->in && xfer->actual_length) {
452 usb_packet_copy(r->p, r->buffer, xfer->actual_length);
453 }
454 trace_usb_host_req_complete(s->bus_num, s->addr, r->p,
455 r->p->status, r->p->actual_length);
456 if (usb_host_use_combining(r->p->ep)) {
457 usb_combined_input_packet_complete(USB_DEVICE(s), r->p);
458 } else {
459 usb_packet_complete(USB_DEVICE(s), r->p);
460 }
461
462 out:
463 usb_host_req_free(r);
464 if (disconnect) {
465 usb_host_nodev(s);
466 }
467 }
468
469 static void usb_host_req_abort(USBHostRequest *r)
470 {
471 USBHostDevice *s = r->host;
472 bool inflight = (r->p && r->p->state == USB_PACKET_ASYNC);
473
474 if (inflight) {
475 r->p->status = USB_RET_NODEV;
476 trace_usb_host_req_complete(s->bus_num, s->addr, r->p,
477 r->p->status, r->p->actual_length);
478 if (r->p->ep->nr == 0) {
479 usb_generic_async_ctrl_complete(USB_DEVICE(s), r->p);
480 } else {
481 usb_packet_complete(USB_DEVICE(s), r->p);
482 }
483 r->p = NULL;
484
485 libusb_cancel_transfer(r->xfer);
486 }
487 }
488
489 /* ------------------------------------------------------------------------ */
490
491 static void LIBUSB_CALL
492 usb_host_req_complete_iso(struct libusb_transfer *transfer)
493 {
494 USBHostIsoXfer *xfer = transfer->user_data;
495
496 if (!xfer) {
497 /* USBHostIsoXfer released while inflight */
498 g_free(transfer->buffer);
499 libusb_free_transfer(transfer);
500 return;
501 }
502
503 QTAILQ_REMOVE(&xfer->ring->inflight, xfer, next);
504 if (QTAILQ_EMPTY(&xfer->ring->inflight)) {
505 USBHostDevice *s = xfer->ring->host;
506 trace_usb_host_iso_stop(s->bus_num, s->addr, xfer->ring->ep->nr);
507 }
508 if (xfer->ring->ep->pid == USB_TOKEN_IN) {
509 QTAILQ_INSERT_TAIL(&xfer->ring->copy, xfer, next);
510 usb_wakeup(xfer->ring->ep, 0);
511 } else {
512 QTAILQ_INSERT_TAIL(&xfer->ring->unused, xfer, next);
513 }
514 }
515
516 static USBHostIsoRing *usb_host_iso_alloc(USBHostDevice *s, USBEndpoint *ep)
517 {
518 USBHostIsoRing *ring = g_new0(USBHostIsoRing, 1);
519 USBHostIsoXfer *xfer;
520 /* FIXME: check interval (for now assume one xfer per frame) */
521 int packets = s->iso_urb_frames;
522 int i;
523
524 ring->host = s;
525 ring->ep = ep;
526 QTAILQ_INIT(&ring->unused);
527 QTAILQ_INIT(&ring->inflight);
528 QTAILQ_INIT(&ring->copy);
529 QTAILQ_INSERT_TAIL(&s->isorings, ring, next);
530
531 for (i = 0; i < s->iso_urb_count; i++) {
532 xfer = g_new0(USBHostIsoXfer, 1);
533 xfer->ring = ring;
534 xfer->xfer = libusb_alloc_transfer(packets);
535 xfer->xfer->dev_handle = s->dh;
536 xfer->xfer->type = LIBUSB_TRANSFER_TYPE_ISOCHRONOUS;
537
538 xfer->xfer->endpoint = ring->ep->nr;
539 if (ring->ep->pid == USB_TOKEN_IN) {
540 xfer->xfer->endpoint |= USB_DIR_IN;
541 }
542 xfer->xfer->callback = usb_host_req_complete_iso;
543 xfer->xfer->user_data = xfer;
544
545 xfer->xfer->num_iso_packets = packets;
546 xfer->xfer->length = ring->ep->max_packet_size * packets;
547 xfer->xfer->buffer = g_malloc0(xfer->xfer->length);
548
549 QTAILQ_INSERT_TAIL(&ring->unused, xfer, next);
550 }
551
552 return ring;
553 }
554
555 static USBHostIsoRing *usb_host_iso_find(USBHostDevice *s, USBEndpoint *ep)
556 {
557 USBHostIsoRing *ring;
558
559 QTAILQ_FOREACH(ring, &s->isorings, next) {
560 if (ring->ep == ep) {
561 return ring;
562 }
563 }
564 return NULL;
565 }
566
567 static void usb_host_iso_reset_xfer(USBHostIsoXfer *xfer)
568 {
569 libusb_set_iso_packet_lengths(xfer->xfer,
570 xfer->ring->ep->max_packet_size);
571 xfer->packet = 0;
572 xfer->copy_complete = false;
573 }
574
575 static void usb_host_iso_free_xfer(USBHostIsoXfer *xfer, bool inflight)
576 {
577 if (inflight) {
578 xfer->xfer->user_data = NULL;
579 } else {
580 g_free(xfer->xfer->buffer);
581 libusb_free_transfer(xfer->xfer);
582 }
583 g_free(xfer);
584 }
585
586 static void usb_host_iso_free(USBHostIsoRing *ring)
587 {
588 USBHostIsoXfer *xfer;
589
590 while ((xfer = QTAILQ_FIRST(&ring->inflight)) != NULL) {
591 QTAILQ_REMOVE(&ring->inflight, xfer, next);
592 usb_host_iso_free_xfer(xfer, true);
593 }
594 while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) {
595 QTAILQ_REMOVE(&ring->unused, xfer, next);
596 usb_host_iso_free_xfer(xfer, false);
597 }
598 while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL) {
599 QTAILQ_REMOVE(&ring->copy, xfer, next);
600 usb_host_iso_free_xfer(xfer, false);
601 }
602
603 QTAILQ_REMOVE(&ring->host->isorings, ring, next);
604 g_free(ring);
605 }
606
607 static void usb_host_iso_free_all(USBHostDevice *s)
608 {
609 USBHostIsoRing *ring;
610
611 while ((ring = QTAILQ_FIRST(&s->isorings)) != NULL) {
612 usb_host_iso_free(ring);
613 }
614 }
615
616 static bool usb_host_iso_data_copy(USBHostIsoXfer *xfer, USBPacket *p)
617 {
618 unsigned int psize;
619 unsigned char *buf;
620
621 buf = libusb_get_iso_packet_buffer_simple(xfer->xfer, xfer->packet);
622 if (p->pid == USB_TOKEN_OUT) {
623 psize = p->iov.size;
624 if (psize > xfer->ring->ep->max_packet_size) {
625 /* should not happen (guest bug) */
626 psize = xfer->ring->ep->max_packet_size;
627 }
628 xfer->xfer->iso_packet_desc[xfer->packet].length = psize;
629 } else {
630 psize = xfer->xfer->iso_packet_desc[xfer->packet].actual_length;
631 if (psize > p->iov.size) {
632 /* should not happen (guest bug) */
633 psize = p->iov.size;
634 }
635 }
636 usb_packet_copy(p, buf, psize);
637 xfer->packet++;
638 xfer->copy_complete = (xfer->packet == xfer->xfer->num_iso_packets);
639 return xfer->copy_complete;
640 }
641
642 static void usb_host_iso_data_in(USBHostDevice *s, USBPacket *p)
643 {
644 USBHostIsoRing *ring;
645 USBHostIsoXfer *xfer;
646 bool disconnect = false;
647 int rc;
648
649 ring = usb_host_iso_find(s, p->ep);
650 if (ring == NULL) {
651 ring = usb_host_iso_alloc(s, p->ep);
652 }
653
654 /* copy data to guest */
655 xfer = QTAILQ_FIRST(&ring->copy);
656 if (xfer != NULL) {
657 if (usb_host_iso_data_copy(xfer, p)) {
658 QTAILQ_REMOVE(&ring->copy, xfer, next);
659 QTAILQ_INSERT_TAIL(&ring->unused, xfer, next);
660 }
661 }
662
663 /* submit empty bufs to host */
664 while ((xfer = QTAILQ_FIRST(&ring->unused)) != NULL) {
665 QTAILQ_REMOVE(&ring->unused, xfer, next);
666 usb_host_iso_reset_xfer(xfer);
667 rc = libusb_submit_transfer(xfer->xfer);
668 if (rc != 0) {
669 usb_host_libusb_error("libusb_submit_transfer [iso]", rc);
670 QTAILQ_INSERT_TAIL(&ring->unused, xfer, next);
671 if (rc == LIBUSB_ERROR_NO_DEVICE) {
672 disconnect = true;
673 }
674 break;
675 }
676 if (QTAILQ_EMPTY(&ring->inflight)) {
677 trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr);
678 }
679 QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next);
680 }
681
682 if (disconnect) {
683 usb_host_nodev(s);
684 }
685 }
686
687 static void usb_host_iso_data_out(USBHostDevice *s, USBPacket *p)
688 {
689 USBHostIsoRing *ring;
690 USBHostIsoXfer *xfer;
691 bool disconnect = false;
692 int rc, filled = 0;
693
694 ring = usb_host_iso_find(s, p->ep);
695 if (ring == NULL) {
696 ring = usb_host_iso_alloc(s, p->ep);
697 }
698
699 /* copy data from guest */
700 xfer = QTAILQ_FIRST(&ring->copy);
701 while (xfer != NULL && xfer->copy_complete) {
702 filled++;
703 xfer = QTAILQ_NEXT(xfer, next);
704 }
705 if (xfer == NULL) {
706 xfer = QTAILQ_FIRST(&ring->unused);
707 if (xfer == NULL) {
708 trace_usb_host_iso_out_of_bufs(s->bus_num, s->addr, p->ep->nr);
709 return;
710 }
711 QTAILQ_REMOVE(&ring->unused, xfer, next);
712 usb_host_iso_reset_xfer(xfer);
713 QTAILQ_INSERT_TAIL(&ring->copy, xfer, next);
714 }
715 usb_host_iso_data_copy(xfer, p);
716
717 if (QTAILQ_EMPTY(&ring->inflight)) {
718 /* wait until half of our buffers are filled
719 before kicking the iso out stream */
720 if (filled*2 < s->iso_urb_count) {
721 return;
722 }
723 }
724
725 /* submit filled bufs to host */
726 while ((xfer = QTAILQ_FIRST(&ring->copy)) != NULL &&
727 xfer->copy_complete) {
728 QTAILQ_REMOVE(&ring->copy, xfer, next);
729 rc = libusb_submit_transfer(xfer->xfer);
730 if (rc != 0) {
731 usb_host_libusb_error("libusb_submit_transfer [iso]", rc);
732 QTAILQ_INSERT_TAIL(&ring->unused, xfer, next);
733 if (rc == LIBUSB_ERROR_NO_DEVICE) {
734 disconnect = true;
735 }
736 break;
737 }
738 if (QTAILQ_EMPTY(&ring->inflight)) {
739 trace_usb_host_iso_start(s->bus_num, s->addr, p->ep->nr);
740 }
741 QTAILQ_INSERT_TAIL(&ring->inflight, xfer, next);
742 }
743
744 if (disconnect) {
745 usb_host_nodev(s);
746 }
747 }
748
749 /* ------------------------------------------------------------------------ */
750
751 static void usb_host_speed_compat(USBHostDevice *s)
752 {
753 USBDevice *udev = USB_DEVICE(s);
754 struct libusb_config_descriptor *conf;
755 const struct libusb_interface_descriptor *intf;
756 const struct libusb_endpoint_descriptor *endp;
757 #ifdef HAVE_STREAMS
758 struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp;
759 #endif
760 bool compat_high = true;
761 bool compat_full = true;
762 uint8_t type;
763 int rc, c, i, a, e;
764
765 for (c = 0;; c++) {
766 rc = libusb_get_config_descriptor(s->dev, c, &conf);
767 if (rc != 0) {
768 break;
769 }
770 for (i = 0; i < conf->bNumInterfaces; i++) {
771 for (a = 0; a < conf->interface[i].num_altsetting; a++) {
772 intf = &conf->interface[i].altsetting[a];
773 for (e = 0; e < intf->bNumEndpoints; e++) {
774 endp = &intf->endpoint[e];
775 type = endp->bmAttributes & 0x3;
776 switch (type) {
777 case 0x01: /* ISO */
778 compat_full = false;
779 compat_high = false;
780 break;
781 case 0x02: /* BULK */
782 #ifdef HAVE_STREAMS
783 rc = libusb_get_ss_endpoint_companion_descriptor
784 (ctx, endp, &endp_ss_comp);
785 if (rc == LIBUSB_SUCCESS) {
786 int streams = endp_ss_comp->bmAttributes & 0x1f;
787 if (streams) {
788 compat_full = false;
789 compat_high = false;
790 }
791 libusb_free_ss_endpoint_companion_descriptor
792 (endp_ss_comp);
793 }
794 #endif
795 break;
796 case 0x03: /* INTERRUPT */
797 if (endp->wMaxPacketSize > 64) {
798 compat_full = false;
799 }
800 if (endp->wMaxPacketSize > 1024) {
801 compat_high = false;
802 }
803 break;
804 }
805 }
806 }
807 }
808 libusb_free_config_descriptor(conf);
809 }
810
811 udev->speedmask = (1 << udev->speed);
812 if (udev->speed == USB_SPEED_SUPER && compat_high) {
813 udev->speedmask |= USB_SPEED_MASK_HIGH;
814 }
815 if (udev->speed == USB_SPEED_SUPER && compat_full) {
816 udev->speedmask |= USB_SPEED_MASK_FULL;
817 }
818 if (udev->speed == USB_SPEED_HIGH && compat_full) {
819 udev->speedmask |= USB_SPEED_MASK_FULL;
820 }
821 }
822
823 static void usb_host_ep_update(USBHostDevice *s)
824 {
825 static const char *tname[] = {
826 [USB_ENDPOINT_XFER_CONTROL] = "control",
827 [USB_ENDPOINT_XFER_ISOC] = "isoc",
828 [USB_ENDPOINT_XFER_BULK] = "bulk",
829 [USB_ENDPOINT_XFER_INT] = "int",
830 };
831 USBDevice *udev = USB_DEVICE(s);
832 struct libusb_config_descriptor *conf;
833 const struct libusb_interface_descriptor *intf;
834 const struct libusb_endpoint_descriptor *endp;
835 #ifdef HAVE_STREAMS
836 struct libusb_ss_endpoint_companion_descriptor *endp_ss_comp;
837 #endif
838 uint8_t devep, type;
839 int pid, ep, alt;
840 int rc, i, e;
841
842 usb_ep_reset(udev);
843 rc = libusb_get_active_config_descriptor(s->dev, &conf);
844 if (rc != 0) {
845 return;
846 }
847 trace_usb_host_parse_config(s->bus_num, s->addr,
848 conf->bConfigurationValue, true);
849
850 for (i = 0; i < conf->bNumInterfaces; i++) {
851 /*
852 * The udev->altsetting array indexes alternate settings
853 * by the interface number. Get the 0th alternate setting
854 * first so that we can grab the interface number, and
855 * then correct the alternate setting value if necessary.
856 */
857 intf = &conf->interface[i].altsetting[0];
858 alt = udev->altsetting[intf->bInterfaceNumber];
859
860 if (alt != 0) {
861 assert(alt < conf->interface[i].num_altsetting);
862 intf = &conf->interface[i].altsetting[alt];
863 }
864
865 trace_usb_host_parse_interface(s->bus_num, s->addr,
866 intf->bInterfaceNumber,
867 intf->bAlternateSetting, true);
868 for (e = 0; e < intf->bNumEndpoints; e++) {
869 endp = &intf->endpoint[e];
870
871 devep = endp->bEndpointAddress;
872 pid = (devep & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT;
873 ep = devep & 0xf;
874 type = endp->bmAttributes & 0x3;
875
876 if (ep == 0) {
877 trace_usb_host_parse_error(s->bus_num, s->addr,
878 "invalid endpoint address");
879 return;
880 }
881 if (usb_ep_get_type(udev, pid, ep) != USB_ENDPOINT_XFER_INVALID) {
882 trace_usb_host_parse_error(s->bus_num, s->addr,
883 "duplicate endpoint address");
884 return;
885 }
886
887 trace_usb_host_parse_endpoint(s->bus_num, s->addr, ep,
888 (devep & USB_DIR_IN) ? "in" : "out",
889 tname[type], true);
890 usb_ep_set_max_packet_size(udev, pid, ep,
891 endp->wMaxPacketSize);
892 usb_ep_set_type(udev, pid, ep, type);
893 usb_ep_set_ifnum(udev, pid, ep, i);
894 usb_ep_set_halted(udev, pid, ep, 0);
895 #ifdef HAVE_STREAMS
896 if (type == LIBUSB_TRANSFER_TYPE_BULK &&
897 libusb_get_ss_endpoint_companion_descriptor(ctx, endp,
898 &endp_ss_comp) == LIBUSB_SUCCESS) {
899 usb_ep_set_max_streams(udev, pid, ep,
900 endp_ss_comp->bmAttributes);
901 libusb_free_ss_endpoint_companion_descriptor(endp_ss_comp);
902 }
903 #endif
904 }
905 }
906
907 libusb_free_config_descriptor(conf);
908 }
909
910 static int usb_host_open(USBHostDevice *s, libusb_device *dev, int hostfd)
911 {
912 USBDevice *udev = USB_DEVICE(s);
913 int libusb_speed;
914 int bus_num = 0;
915 int addr = 0;
916 int rc;
917 Error *local_err = NULL;
918
919 if (s->bh_postld_pending) {
920 return -1;
921 }
922 if (s->dh != NULL) {
923 goto fail;
924 }
925
926 if (dev) {
927 bus_num = libusb_get_bus_number(dev);
928 addr = libusb_get_device_address(dev);
929 trace_usb_host_open_started(bus_num, addr);
930
931 rc = libusb_open(dev, &s->dh);
932 if (rc != 0) {
933 goto fail;
934 }
935 } else {
936 #if LIBUSB_API_VERSION >= 0x01000107 && !defined(CONFIG_WIN32)
937 trace_usb_host_open_hostfd(hostfd);
938
939 rc = libusb_wrap_sys_device(ctx, hostfd, &s->dh);
940 if (rc != 0) {
941 goto fail;
942 }
943 s->hostfd = hostfd;
944 dev = libusb_get_device(s->dh);
945 bus_num = libusb_get_bus_number(dev);
946 addr = libusb_get_device_address(dev);
947 #else
948 g_assert_not_reached();
949 #endif
950 }
951
952 s->dev = dev;
953 s->bus_num = bus_num;
954 s->addr = addr;
955
956 usb_host_detach_kernel(s);
957
958 libusb_get_device_descriptor(dev, &s->ddesc);
959 usb_host_get_port(s->dev, s->port, sizeof(s->port));
960
961 usb_ep_init(udev);
962 usb_host_ep_update(s);
963
964 libusb_speed = libusb_get_device_speed(dev);
965 #if LIBUSB_API_VERSION >= 0x01000107 && defined(CONFIG_LINUX) && \
966 defined(USBDEVFS_GET_SPEED)
967 if (hostfd && libusb_speed == 0) {
968 /*
969 * Workaround libusb bug: libusb_get_device_speed() does not
970 * work for libusb_wrap_sys_device() devices in v1.0.23.
971 *
972 * Speeds are defined in linux/usb/ch9.h, file not included
973 * due to name conflicts.
974 */
975 int rc = ioctl(hostfd, USBDEVFS_GET_SPEED, NULL);
976 switch (rc) {
977 case 1: /* low */
978 libusb_speed = LIBUSB_SPEED_LOW;
979 break;
980 case 2: /* full */
981 libusb_speed = LIBUSB_SPEED_FULL;
982 break;
983 case 3: /* high */
984 case 4: /* wireless */
985 libusb_speed = LIBUSB_SPEED_HIGH;
986 break;
987 case 5: /* super */
988 libusb_speed = LIBUSB_SPEED_SUPER;
989 break;
990 case 6: /* super plus */
991 #ifdef HAVE_SUPER_PLUS
992 libusb_speed = LIBUSB_SPEED_SUPER_PLUS;
993 #else
994 libusb_speed = LIBUSB_SPEED_SUPER;
995 #endif
996 break;
997 }
998 }
999 #endif
1000 udev->speed = speed_map[libusb_speed];
1001 usb_host_speed_compat(s);
1002
1003 if (s->ddesc.iProduct) {
1004 libusb_get_string_descriptor_ascii(s->dh, s->ddesc.iProduct,
1005 (unsigned char *)udev->product_desc,
1006 sizeof(udev->product_desc));
1007 } else {
1008 snprintf(udev->product_desc, sizeof(udev->product_desc),
1009 "host:%d.%d", bus_num, addr);
1010 }
1011
1012 usb_device_attach(udev, &local_err);
1013 if (local_err) {
1014 error_report_err(local_err);
1015 goto fail;
1016 }
1017
1018 trace_usb_host_open_success(bus_num, addr);
1019 return 0;
1020
1021 fail:
1022 trace_usb_host_open_failure(bus_num, addr);
1023 if (s->dh != NULL) {
1024 usb_host_release_interfaces(s);
1025 libusb_reset_device(s->dh);
1026 usb_host_attach_kernel(s);
1027 libusb_close(s->dh);
1028 s->dh = NULL;
1029 s->dev = NULL;
1030 }
1031 return -1;
1032 }
1033
1034 static void usb_host_abort_xfers(USBHostDevice *s)
1035 {
1036 USBHostRequest *r, *rtmp;
1037 int limit = 100;
1038
1039 QTAILQ_FOREACH_SAFE(r, &s->requests, next, rtmp) {
1040 usb_host_req_abort(r);
1041 }
1042
1043 while (QTAILQ_FIRST(&s->requests) != NULL) {
1044 struct timeval tv;
1045 memset(&tv, 0, sizeof(tv));
1046 tv.tv_usec = 2500;
1047 libusb_handle_events_timeout(ctx, &tv);
1048 if (--limit == 0) {
1049 /*
1050 * Don't wait forever for libusb calling the complete
1051 * callback (which will unlink and free the request).
1052 *
1053 * Leaking memory here, to make sure libusb will not
1054 * access memory which we have released already.
1055 */
1056 QTAILQ_FOREACH_SAFE(r, &s->requests, next, rtmp) {
1057 QTAILQ_REMOVE(&s->requests, r, next);
1058 }
1059 return;
1060 }
1061 }
1062 }
1063
1064 static int usb_host_close(USBHostDevice *s)
1065 {
1066 USBDevice *udev = USB_DEVICE(s);
1067
1068 if (s->dh == NULL) {
1069 return -1;
1070 }
1071
1072 trace_usb_host_close(s->bus_num, s->addr);
1073
1074 usb_host_abort_xfers(s);
1075 usb_host_iso_free_all(s);
1076
1077 if (udev->attached) {
1078 usb_device_detach(udev);
1079 }
1080
1081 usb_host_release_interfaces(s);
1082 libusb_reset_device(s->dh);
1083 usb_host_attach_kernel(s);
1084 libusb_close(s->dh);
1085 s->dh = NULL;
1086 s->dev = NULL;
1087
1088 if (s->hostfd != -1) {
1089 close(s->hostfd);
1090 s->hostfd = -1;
1091 }
1092
1093 usb_host_auto_check(NULL);
1094 return 0;
1095 }
1096
1097 static void usb_host_nodev_bh(void *opaque)
1098 {
1099 USBHostDevice *s = opaque;
1100 usb_host_close(s);
1101 }
1102
1103 static void usb_host_nodev(USBHostDevice *s)
1104 {
1105 if (!s->bh_nodev) {
1106 s->bh_nodev = qemu_bh_new(usb_host_nodev_bh, s);
1107 }
1108 qemu_bh_schedule(s->bh_nodev);
1109 }
1110
1111 static void usb_host_exit_notifier(struct Notifier *n, void *data)
1112 {
1113 USBHostDevice *s = container_of(n, USBHostDevice, exit);
1114
1115 if (s->dh) {
1116 usb_host_abort_xfers(s);
1117 usb_host_release_interfaces(s);
1118 libusb_reset_device(s->dh);
1119 usb_host_attach_kernel(s);
1120 libusb_close(s->dh);
1121 }
1122 }
1123
1124 static libusb_device *usb_host_find_ref(int bus, int addr)
1125 {
1126 libusb_device **devs = NULL;
1127 libusb_device *ret = NULL;
1128 int i, n;
1129
1130 n = libusb_get_device_list(ctx, &devs);
1131 for (i = 0; i < n; i++) {
1132 if (libusb_get_bus_number(devs[i]) == bus &&
1133 libusb_get_device_address(devs[i]) == addr) {
1134 ret = libusb_ref_device(devs[i]);
1135 break;
1136 }
1137 }
1138 libusb_free_device_list(devs, 1);
1139 return ret;
1140 }
1141
1142 static void usb_host_realize(USBDevice *udev, Error **errp)
1143 {
1144 USBHostDevice *s = USB_HOST_DEVICE(udev);
1145 libusb_device *ldev;
1146 int rc;
1147
1148 if (usb_host_init() != 0) {
1149 error_setg(errp, "failed to init libusb");
1150 return;
1151 }
1152 if (s->match.vendor_id > 0xffff) {
1153 error_setg(errp, "vendorid out of range");
1154 return;
1155 }
1156 if (s->match.product_id > 0xffff) {
1157 error_setg(errp, "productid out of range");
1158 return;
1159 }
1160 if (s->match.addr > 127) {
1161 error_setg(errp, "hostaddr out of range");
1162 return;
1163 }
1164
1165 loglevel = s->loglevel;
1166 udev->flags |= (1 << USB_DEV_FLAG_IS_HOST);
1167 udev->auto_attach = 0;
1168 QTAILQ_INIT(&s->requests);
1169 QTAILQ_INIT(&s->isorings);
1170 s->hostfd = -1;
1171
1172 #if LIBUSB_API_VERSION >= 0x01000107 && !defined(CONFIG_WIN32)
1173 if (s->hostdevice) {
1174 int fd;
1175 s->needs_autoscan = false;
1176 fd = qemu_open_old(s->hostdevice, O_RDWR);
1177 if (fd < 0) {
1178 error_setg_errno(errp, errno, "failed to open %s", s->hostdevice);
1179 return;
1180 }
1181 rc = usb_host_open(s, NULL, fd);
1182 if (rc < 0) {
1183 error_setg(errp, "failed to open host usb device %s", s->hostdevice);
1184 return;
1185 }
1186 } else
1187 #endif
1188 if (s->match.addr && s->match.bus_num &&
1189 !s->match.vendor_id &&
1190 !s->match.product_id &&
1191 !s->match.port) {
1192 s->needs_autoscan = false;
1193 ldev = usb_host_find_ref(s->match.bus_num,
1194 s->match.addr);
1195 if (!ldev) {
1196 error_setg(errp, "failed to find host usb device %d:%d",
1197 s->match.bus_num, s->match.addr);
1198 return;
1199 }
1200 rc = usb_host_open(s, ldev, 0);
1201 libusb_unref_device(ldev);
1202 if (rc < 0) {
1203 error_setg(errp, "failed to open host usb device %d:%d",
1204 s->match.bus_num, s->match.addr);
1205 return;
1206 }
1207 } else {
1208 s->needs_autoscan = true;
1209 QTAILQ_INSERT_TAIL(&hostdevs, s, next);
1210 usb_host_auto_check(NULL);
1211 }
1212
1213 s->exit.notify = usb_host_exit_notifier;
1214 qemu_add_exit_notifier(&s->exit);
1215 }
1216
1217 static void usb_host_instance_init(Object *obj)
1218 {
1219 USBDevice *udev = USB_DEVICE(obj);
1220 USBHostDevice *s = USB_HOST_DEVICE(udev);
1221
1222 device_add_bootindex_property(obj, &s->bootindex,
1223 "bootindex", NULL,
1224 &udev->qdev);
1225 }
1226
1227 static void usb_host_unrealize(USBDevice *udev)
1228 {
1229 USBHostDevice *s = USB_HOST_DEVICE(udev);
1230
1231 qemu_remove_exit_notifier(&s->exit);
1232 if (s->needs_autoscan) {
1233 QTAILQ_REMOVE(&hostdevs, s, next);
1234 }
1235 usb_host_close(s);
1236 }
1237
1238 static void usb_host_cancel_packet(USBDevice *udev, USBPacket *p)
1239 {
1240 USBHostDevice *s = USB_HOST_DEVICE(udev);
1241 USBHostRequest *r;
1242
1243 if (p->combined) {
1244 usb_combined_packet_cancel(udev, p);
1245 return;
1246 }
1247
1248 trace_usb_host_req_canceled(s->bus_num, s->addr, p);
1249
1250 r = usb_host_req_find(s, p);
1251 if (r && r->p) {
1252 r->p = NULL; /* mark as dead */
1253 libusb_cancel_transfer(r->xfer);
1254 }
1255 }
1256
1257 static void usb_host_detach_kernel(USBHostDevice *s)
1258 {
1259 struct libusb_config_descriptor *conf;
1260 int rc, i;
1261
1262 rc = libusb_get_active_config_descriptor(s->dev, &conf);
1263 if (rc != 0) {
1264 return;
1265 }
1266 for (i = 0; i < USB_MAX_INTERFACES; i++) {
1267 rc = libusb_kernel_driver_active(s->dh, i);
1268 usb_host_libusb_error("libusb_kernel_driver_active", rc);
1269 if (rc != 1) {
1270 if (rc == 0) {
1271 s->ifs[i].detached = true;
1272 }
1273 continue;
1274 }
1275 trace_usb_host_detach_kernel(s->bus_num, s->addr, i);
1276 rc = libusb_detach_kernel_driver(s->dh, i);
1277 usb_host_libusb_error("libusb_detach_kernel_driver", rc);
1278 s->ifs[i].detached = true;
1279 }
1280 libusb_free_config_descriptor(conf);
1281 }
1282
1283 static void usb_host_attach_kernel(USBHostDevice *s)
1284 {
1285 struct libusb_config_descriptor *conf;
1286 int rc, i;
1287
1288 rc = libusb_get_active_config_descriptor(s->dev, &conf);
1289 if (rc != 0) {
1290 return;
1291 }
1292 for (i = 0; i < USB_MAX_INTERFACES; i++) {
1293 if (!s->ifs[i].detached) {
1294 continue;
1295 }
1296 trace_usb_host_attach_kernel(s->bus_num, s->addr, i);
1297 libusb_attach_kernel_driver(s->dh, i);
1298 s->ifs[i].detached = false;
1299 }
1300 libusb_free_config_descriptor(conf);
1301 }
1302
1303 static int usb_host_claim_interfaces(USBHostDevice *s, int configuration)
1304 {
1305 USBDevice *udev = USB_DEVICE(s);
1306 struct libusb_config_descriptor *conf;
1307 int rc, i, claimed;
1308
1309 for (i = 0; i < USB_MAX_INTERFACES; i++) {
1310 udev->altsetting[i] = 0;
1311 }
1312 udev->ninterfaces = 0;
1313 udev->configuration = 0;
1314
1315 usb_host_detach_kernel(s);
1316
1317 rc = libusb_get_active_config_descriptor(s->dev, &conf);
1318 if (rc != 0) {
1319 if (rc == LIBUSB_ERROR_NOT_FOUND) {
1320 /* address state - ignore */
1321 return USB_RET_SUCCESS;
1322 }
1323 return USB_RET_STALL;
1324 }
1325
1326 claimed = 0;
1327 for (i = 0; i < USB_MAX_INTERFACES; i++) {
1328 trace_usb_host_claim_interface(s->bus_num, s->addr, configuration, i);
1329 rc = libusb_claim_interface(s->dh, i);
1330 if (rc == 0) {
1331 s->ifs[i].claimed = true;
1332 if (++claimed == conf->bNumInterfaces) {
1333 break;
1334 }
1335 }
1336 }
1337 if (claimed != conf->bNumInterfaces) {
1338 return USB_RET_STALL;
1339 }
1340
1341 udev->ninterfaces = conf->bNumInterfaces;
1342 udev->configuration = configuration;
1343
1344 libusb_free_config_descriptor(conf);
1345 return USB_RET_SUCCESS;
1346 }
1347
1348 static void usb_host_release_interfaces(USBHostDevice *s)
1349 {
1350 int i, rc;
1351
1352 for (i = 0; i < USB_MAX_INTERFACES; i++) {
1353 if (!s->ifs[i].claimed) {
1354 continue;
1355 }
1356 trace_usb_host_release_interface(s->bus_num, s->addr, i);
1357 rc = libusb_release_interface(s->dh, i);
1358 usb_host_libusb_error("libusb_release_interface", rc);
1359 s->ifs[i].claimed = false;
1360 }
1361 }
1362
1363 static void usb_host_set_address(USBHostDevice *s, int addr)
1364 {
1365 USBDevice *udev = USB_DEVICE(s);
1366
1367 trace_usb_host_set_address(s->bus_num, s->addr, addr);
1368 udev->addr = addr;
1369 }
1370
1371 static void usb_host_set_config(USBHostDevice *s, int config, USBPacket *p)
1372 {
1373 int rc = 0;
1374
1375 trace_usb_host_set_config(s->bus_num, s->addr, config);
1376
1377 usb_host_release_interfaces(s);
1378 if (s->ddesc.bNumConfigurations != 1) {
1379 rc = libusb_set_configuration(s->dh, config);
1380 if (rc != 0) {
1381 usb_host_libusb_error("libusb_set_configuration", rc);
1382 p->status = USB_RET_STALL;
1383 if (rc == LIBUSB_ERROR_NO_DEVICE) {
1384 usb_host_nodev(s);
1385 }
1386 return;
1387 }
1388 }
1389 p->status = usb_host_claim_interfaces(s, config);
1390 if (p->status != USB_RET_SUCCESS) {
1391 return;
1392 }
1393 usb_host_ep_update(s);
1394 }
1395
1396 static void usb_host_set_interface(USBHostDevice *s, int iface, int alt,
1397 USBPacket *p)
1398 {
1399 USBDevice *udev = USB_DEVICE(s);
1400 int rc;
1401
1402 trace_usb_host_set_interface(s->bus_num, s->addr, iface, alt);
1403
1404 usb_host_iso_free_all(s);
1405
1406 if (iface >= USB_MAX_INTERFACES) {
1407 p->status = USB_RET_STALL;
1408 return;
1409 }
1410
1411 rc = libusb_set_interface_alt_setting(s->dh, iface, alt);
1412 if (rc != 0) {
1413 usb_host_libusb_error("libusb_set_interface_alt_setting", rc);
1414 p->status = USB_RET_STALL;
1415 if (rc == LIBUSB_ERROR_NO_DEVICE) {
1416 usb_host_nodev(s);
1417 }
1418 return;
1419 }
1420
1421 udev->altsetting[iface] = alt;
1422 usb_host_ep_update(s);
1423 }
1424
1425 static void usb_host_handle_control(USBDevice *udev, USBPacket *p,
1426 int request, int value, int index,
1427 int length, uint8_t *data)
1428 {
1429 USBHostDevice *s = USB_HOST_DEVICE(udev);
1430 USBHostRequest *r;
1431 int rc;
1432
1433 trace_usb_host_req_control(s->bus_num, s->addr, p, request, value, index);
1434
1435 if (s->dh == NULL) {
1436 p->status = USB_RET_NODEV;
1437 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1438 return;
1439 }
1440
1441 switch (request) {
1442 case DeviceOutRequest | USB_REQ_SET_ADDRESS:
1443 usb_host_set_address(s, value);
1444 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1445 return;
1446
1447 case DeviceOutRequest | USB_REQ_SET_CONFIGURATION:
1448 usb_host_set_config(s, value & 0xff, p);
1449 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1450 return;
1451
1452 case InterfaceOutRequest | USB_REQ_SET_INTERFACE:
1453 usb_host_set_interface(s, index, value, p);
1454 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1455 return;
1456
1457 case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
1458 if (value == 0) { /* clear halt */
1459 int pid = (index & USB_DIR_IN) ? USB_TOKEN_IN : USB_TOKEN_OUT;
1460 libusb_clear_halt(s->dh, index);
1461 usb_ep_set_halted(udev, pid, index & 0x0f, 0);
1462 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1463 return;
1464 }
1465 }
1466
1467 r = usb_host_req_alloc(s, p, (request >> 8) & USB_DIR_IN, length + 8);
1468 r->cbuf = data;
1469 r->clen = length;
1470 memcpy(r->buffer, udev->setup_buf, 8);
1471 if (!r->in) {
1472 memcpy(r->buffer + 8, r->cbuf, r->clen);
1473 }
1474
1475 /* Fix up USB-3 ep0 maxpacket size to allow superspeed connected devices
1476 * to work redirected to a not superspeed capable hcd */
1477 if ((udev->speedmask & USB_SPEED_MASK_SUPER) &&
1478 !(udev->port->speedmask & USB_SPEED_MASK_SUPER) &&
1479 request == 0x8006 && value == 0x100 && index == 0) {
1480 r->usb3ep0quirk = true;
1481 }
1482
1483 libusb_fill_control_transfer(r->xfer, s->dh, r->buffer,
1484 usb_host_req_complete_ctrl, r,
1485 CONTROL_TIMEOUT);
1486 rc = libusb_submit_transfer(r->xfer);
1487 if (rc != 0) {
1488 p->status = USB_RET_NODEV;
1489 trace_usb_host_req_complete(s->bus_num, s->addr, p,
1490 p->status, p->actual_length);
1491 if (rc == LIBUSB_ERROR_NO_DEVICE) {
1492 usb_host_nodev(s);
1493 }
1494 return;
1495 }
1496
1497 p->status = USB_RET_ASYNC;
1498 }
1499
1500 static void usb_host_handle_data(USBDevice *udev, USBPacket *p)
1501 {
1502 USBHostDevice *s = USB_HOST_DEVICE(udev);
1503 USBHostRequest *r;
1504 size_t size;
1505 int ep, rc;
1506
1507 if (usb_host_use_combining(p->ep) && p->state == USB_PACKET_SETUP) {
1508 p->status = USB_RET_ADD_TO_QUEUE;
1509 return;
1510 }
1511
1512 trace_usb_host_req_data(s->bus_num, s->addr, p,
1513 p->pid == USB_TOKEN_IN,
1514 p->ep->nr, p->iov.size);
1515
1516 if (s->dh == NULL) {
1517 p->status = USB_RET_NODEV;
1518 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1519 return;
1520 }
1521 if (p->ep->halted) {
1522 p->status = USB_RET_STALL;
1523 trace_usb_host_req_emulated(s->bus_num, s->addr, p, p->status);
1524 return;
1525 }
1526
1527 switch (usb_ep_get_type(udev, p->pid, p->ep->nr)) {
1528 case USB_ENDPOINT_XFER_BULK:
1529 size = usb_packet_size(p);
1530 r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, size);
1531 if (!r->in) {
1532 usb_packet_copy(p, r->buffer, size);
1533 }
1534 ep = p->ep->nr | (r->in ? USB_DIR_IN : 0);
1535 if (p->stream) {
1536 #ifdef HAVE_STREAMS
1537 libusb_fill_bulk_stream_transfer(r->xfer, s->dh, ep, p->stream,
1538 r->buffer, size,
1539 usb_host_req_complete_data, r,
1540 BULK_TIMEOUT);
1541 #else
1542 usb_host_req_free(r);
1543 p->status = USB_RET_STALL;
1544 return;
1545 #endif
1546 } else {
1547 libusb_fill_bulk_transfer(r->xfer, s->dh, ep,
1548 r->buffer, size,
1549 usb_host_req_complete_data, r,
1550 BULK_TIMEOUT);
1551 }
1552 break;
1553 case USB_ENDPOINT_XFER_INT:
1554 r = usb_host_req_alloc(s, p, p->pid == USB_TOKEN_IN, p->iov.size);
1555 if (!r->in) {
1556 usb_packet_copy(p, r->buffer, p->iov.size);
1557 }
1558 ep = p->ep->nr | (r->in ? USB_DIR_IN : 0);
1559 libusb_fill_interrupt_transfer(r->xfer, s->dh, ep,
1560 r->buffer, p->iov.size,
1561 usb_host_req_complete_data, r,
1562 INTR_TIMEOUT);
1563 break;
1564 case USB_ENDPOINT_XFER_ISOC:
1565 if (p->pid == USB_TOKEN_IN) {
1566 usb_host_iso_data_in(s, p);
1567 } else {
1568 usb_host_iso_data_out(s, p);
1569 }
1570 trace_usb_host_req_complete(s->bus_num, s->addr, p,
1571 p->status, p->actual_length);
1572 return;
1573 default:
1574 p->status = USB_RET_STALL;
1575 trace_usb_host_req_complete(s->bus_num, s->addr, p,
1576 p->status, p->actual_length);
1577 return;
1578 }
1579
1580 rc = libusb_submit_transfer(r->xfer);
1581 if (rc != 0) {
1582 p->status = USB_RET_NODEV;
1583 trace_usb_host_req_complete(s->bus_num, s->addr, p,
1584 p->status, p->actual_length);
1585 if (rc == LIBUSB_ERROR_NO_DEVICE) {
1586 usb_host_nodev(s);
1587 }
1588 return;
1589 }
1590
1591 p->status = USB_RET_ASYNC;
1592 }
1593
1594 static void usb_host_flush_ep_queue(USBDevice *dev, USBEndpoint *ep)
1595 {
1596 if (usb_host_use_combining(ep)) {
1597 usb_ep_combine_input_packets(ep);
1598 }
1599 }
1600
1601 static void usb_host_handle_reset(USBDevice *udev)
1602 {
1603 USBHostDevice *s = USB_HOST_DEVICE(udev);
1604 int rc;
1605
1606 if (!s->allow_one_guest_reset && !s->allow_all_guest_resets) {
1607 return;
1608 }
1609 if (!s->allow_all_guest_resets && udev->addr == 0) {
1610 return;
1611 }
1612
1613 trace_usb_host_reset(s->bus_num, s->addr);
1614
1615 rc = libusb_reset_device(s->dh);
1616 if (rc != 0) {
1617 usb_host_nodev(s);
1618 }
1619 }
1620
1621 static int usb_host_alloc_streams(USBDevice *udev, USBEndpoint **eps,
1622 int nr_eps, int streams)
1623 {
1624 #ifdef HAVE_STREAMS
1625 USBHostDevice *s = USB_HOST_DEVICE(udev);
1626 unsigned char endpoints[30];
1627 int i, rc;
1628
1629 for (i = 0; i < nr_eps; i++) {
1630 endpoints[i] = eps[i]->nr;
1631 if (eps[i]->pid == USB_TOKEN_IN) {
1632 endpoints[i] |= 0x80;
1633 }
1634 }
1635 rc = libusb_alloc_streams(s->dh, streams, endpoints, nr_eps);
1636 if (rc < 0) {
1637 usb_host_libusb_error("libusb_alloc_streams", rc);
1638 } else if (rc != streams) {
1639 error_report("libusb_alloc_streams: got less streams "
1640 "then requested %d < %d", rc, streams);
1641 }
1642
1643 return (rc == streams) ? 0 : -1;
1644 #else
1645 error_report("libusb_alloc_streams: error not implemented");
1646 return -1;
1647 #endif
1648 }
1649
1650 static void usb_host_free_streams(USBDevice *udev, USBEndpoint **eps,
1651 int nr_eps)
1652 {
1653 #ifdef HAVE_STREAMS
1654 USBHostDevice *s = USB_HOST_DEVICE(udev);
1655 unsigned char endpoints[30];
1656 int i;
1657
1658 for (i = 0; i < nr_eps; i++) {
1659 endpoints[i] = eps[i]->nr;
1660 if (eps[i]->pid == USB_TOKEN_IN) {
1661 endpoints[i] |= 0x80;
1662 }
1663 }
1664 libusb_free_streams(s->dh, endpoints, nr_eps);
1665 #endif
1666 }
1667
1668 /*
1669 * This is *NOT* about restoring state. We have absolutely no idea
1670 * what state the host device is in at the moment and whenever it is
1671 * still present in the first place. Attemping to contine where we
1672 * left off is impossible.
1673 *
1674 * What we are going to do here is emulate a surprise removal of
1675 * the usb device passed through, then kick host scan so the device
1676 * will get re-attached (and re-initialized by the guest) in case it
1677 * is still present.
1678 *
1679 * As the device removal will change the state of other devices (usb
1680 * host controller, most likely interrupt controller too) we have to
1681 * wait with it until *all* vmstate is loaded. Thus post_load just
1682 * kicks a bottom half which then does the actual work.
1683 */
1684 static void usb_host_post_load_bh(void *opaque)
1685 {
1686 USBHostDevice *dev = opaque;
1687 USBDevice *udev = USB_DEVICE(dev);
1688
1689 if (dev->dh != NULL) {
1690 usb_host_close(dev);
1691 }
1692 if (udev->attached) {
1693 usb_device_detach(udev);
1694 }
1695 dev->bh_postld_pending = false;
1696 usb_host_auto_check(NULL);
1697 }
1698
1699 static int usb_host_post_load(void *opaque, int version_id)
1700 {
1701 USBHostDevice *dev = opaque;
1702
1703 if (!dev->bh_postld) {
1704 dev->bh_postld = qemu_bh_new(usb_host_post_load_bh, dev);
1705 }
1706 qemu_bh_schedule(dev->bh_postld);
1707 dev->bh_postld_pending = true;
1708 return 0;
1709 }
1710
1711 static const VMStateDescription vmstate_usb_host = {
1712 .name = "usb-host",
1713 .version_id = 1,
1714 .minimum_version_id = 1,
1715 .post_load = usb_host_post_load,
1716 .fields = (VMStateField[]) {
1717 VMSTATE_USB_DEVICE(parent_obj, USBHostDevice),
1718 VMSTATE_END_OF_LIST()
1719 }
1720 };
1721
1722 static Property usb_host_dev_properties[] = {
1723 DEFINE_PROP_UINT32("hostbus", USBHostDevice, match.bus_num, 0),
1724 DEFINE_PROP_UINT32("hostaddr", USBHostDevice, match.addr, 0),
1725 DEFINE_PROP_STRING("hostport", USBHostDevice, match.port),
1726 DEFINE_PROP_UINT32("vendorid", USBHostDevice, match.vendor_id, 0),
1727 DEFINE_PROP_UINT32("productid", USBHostDevice, match.product_id, 0),
1728 #if LIBUSB_API_VERSION >= 0x01000107
1729 DEFINE_PROP_STRING("hostdevice", USBHostDevice, hostdevice),
1730 #endif
1731 DEFINE_PROP_UINT32("isobufs", USBHostDevice, iso_urb_count, 4),
1732 DEFINE_PROP_UINT32("isobsize", USBHostDevice, iso_urb_frames, 32),
1733 DEFINE_PROP_BOOL("guest-reset", USBHostDevice,
1734 allow_one_guest_reset, true),
1735 DEFINE_PROP_BOOL("guest-resets-all", USBHostDevice,
1736 allow_all_guest_resets, false),
1737 DEFINE_PROP_UINT32("loglevel", USBHostDevice, loglevel,
1738 LIBUSB_LOG_LEVEL_WARNING),
1739 DEFINE_PROP_BIT("pipeline", USBHostDevice, options,
1740 USB_HOST_OPT_PIPELINE, true),
1741 DEFINE_PROP_BOOL("suppress-remote-wake", USBHostDevice,
1742 suppress_remote_wake, true),
1743 DEFINE_PROP_END_OF_LIST(),
1744 };
1745
1746 static void usb_host_class_initfn(ObjectClass *klass, void *data)
1747 {
1748 DeviceClass *dc = DEVICE_CLASS(klass);
1749 USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
1750
1751 uc->realize = usb_host_realize;
1752 uc->product_desc = "USB Host Device";
1753 uc->cancel_packet = usb_host_cancel_packet;
1754 uc->handle_data = usb_host_handle_data;
1755 uc->handle_control = usb_host_handle_control;
1756 uc->handle_reset = usb_host_handle_reset;
1757 uc->unrealize = usb_host_unrealize;
1758 uc->flush_ep_queue = usb_host_flush_ep_queue;
1759 uc->alloc_streams = usb_host_alloc_streams;
1760 uc->free_streams = usb_host_free_streams;
1761 dc->vmsd = &vmstate_usb_host;
1762 device_class_set_props(dc, usb_host_dev_properties);
1763 set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
1764 }
1765
1766 static TypeInfo usb_host_dev_info = {
1767 .name = TYPE_USB_HOST_DEVICE,
1768 .parent = TYPE_USB_DEVICE,
1769 .instance_size = sizeof(USBHostDevice),
1770 .class_init = usb_host_class_initfn,
1771 .instance_init = usb_host_instance_init,
1772 };
1773
1774 static void usb_host_register_types(void)
1775 {
1776 type_register_static(&usb_host_dev_info);
1777 }
1778
1779 type_init(usb_host_register_types)
1780
1781 /* ------------------------------------------------------------------------ */
1782
1783 static QEMUTimer *usb_auto_timer;
1784 static VMChangeStateEntry *usb_vmstate;
1785
1786 static void usb_host_vm_state(void *unused, bool running, RunState state)
1787 {
1788 if (running) {
1789 usb_host_auto_check(unused);
1790 }
1791 }
1792
1793 static void usb_host_auto_check(void *unused)
1794 {
1795 struct USBHostDevice *s;
1796 struct USBAutoFilter *f;
1797 libusb_device **devs = NULL;
1798 struct libusb_device_descriptor ddesc;
1799 int unconnected = 0;
1800 int i, n;
1801
1802 if (usb_host_init() != 0) {
1803 return;
1804 }
1805
1806 if (runstate_is_running()) {
1807 n = libusb_get_device_list(ctx, &devs);
1808 for (i = 0; i < n; i++) {
1809 if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) {
1810 continue;
1811 }
1812 if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) {
1813 continue;
1814 }
1815 QTAILQ_FOREACH(s, &hostdevs, next) {
1816 f = &s->match;
1817 if (f->bus_num > 0 &&
1818 f->bus_num != libusb_get_bus_number(devs[i])) {
1819 continue;
1820 }
1821 if (f->addr > 0 &&
1822 f->addr != libusb_get_device_address(devs[i])) {
1823 continue;
1824 }
1825 if (f->port != NULL) {
1826 char port[16] = "-";
1827 usb_host_get_port(devs[i], port, sizeof(port));
1828 if (strcmp(f->port, port) != 0) {
1829 continue;
1830 }
1831 }
1832 if (f->vendor_id > 0 &&
1833 f->vendor_id != ddesc.idVendor) {
1834 continue;
1835 }
1836 if (f->product_id > 0 &&
1837 f->product_id != ddesc.idProduct) {
1838 continue;
1839 }
1840
1841 /* We got a match */
1842 s->seen++;
1843 if (s->errcount >= 3) {
1844 continue;
1845 }
1846 if (s->dh != NULL) {
1847 continue;
1848 }
1849 if (usb_host_open(s, devs[i], 0) < 0) {
1850 s->errcount++;
1851 continue;
1852 }
1853 break;
1854 }
1855 }
1856 libusb_free_device_list(devs, 1);
1857
1858 QTAILQ_FOREACH(s, &hostdevs, next) {
1859 if (s->dh == NULL) {
1860 unconnected++;
1861 }
1862 if (s->seen == 0) {
1863 if (s->dh) {
1864 usb_host_close(s);
1865 }
1866 s->errcount = 0;
1867 }
1868 s->seen = 0;
1869 }
1870
1871 #if 0
1872 if (unconnected == 0) {
1873 /* nothing to watch */
1874 if (usb_auto_timer) {
1875 timer_del(usb_auto_timer);
1876 trace_usb_host_auto_scan_disabled();
1877 }
1878 return;
1879 }
1880 #endif
1881 }
1882
1883 if (!usb_vmstate) {
1884 usb_vmstate = qemu_add_vm_change_state_handler(usb_host_vm_state, NULL);
1885 }
1886 if (!usb_auto_timer) {
1887 usb_auto_timer = timer_new_ms(QEMU_CLOCK_REALTIME, usb_host_auto_check, NULL);
1888 if (!usb_auto_timer) {
1889 return;
1890 }
1891 trace_usb_host_auto_scan_enabled();
1892 }
1893 timer_mod(usb_auto_timer, qemu_clock_get_ms(QEMU_CLOCK_REALTIME) + 2000);
1894 }
1895
1896 /**
1897 * Check whether USB host device has a USB mass storage SCSI interface
1898 */
1899 bool usb_host_dev_is_scsi_storage(USBDevice *ud)
1900 {
1901 USBHostDevice *uhd = USB_HOST_DEVICE(ud);
1902 struct libusb_config_descriptor *conf;
1903 const struct libusb_interface_descriptor *intf;
1904 bool is_scsi_storage = false;
1905 int i;
1906
1907 if (!uhd || libusb_get_active_config_descriptor(uhd->dev, &conf) != 0) {
1908 return false;
1909 }
1910
1911 for (i = 0; i < conf->bNumInterfaces; i++) {
1912 intf = &conf->interface[i].altsetting[ud->altsetting[i]];
1913 if (intf->bInterfaceClass == LIBUSB_CLASS_MASS_STORAGE &&
1914 intf->bInterfaceSubClass == 6) { /* 6 means SCSI */
1915 is_scsi_storage = true;
1916 break;
1917 }
1918 }
1919
1920 libusb_free_config_descriptor(conf);
1921
1922 return is_scsi_storage;
1923 }
1924
1925 void hmp_info_usbhost(Monitor *mon, const QDict *qdict)
1926 {
1927 libusb_device **devs = NULL;
1928 struct libusb_device_descriptor ddesc;
1929 char port[16];
1930 int i, n;
1931
1932 if (usb_host_init() != 0) {
1933 return;
1934 }
1935
1936 n = libusb_get_device_list(ctx, &devs);
1937 for (i = 0; i < n; i++) {
1938 if (libusb_get_device_descriptor(devs[i], &ddesc) != 0) {
1939 continue;
1940 }
1941 if (ddesc.bDeviceClass == LIBUSB_CLASS_HUB) {
1942 continue;
1943 }
1944 usb_host_get_port(devs[i], port, sizeof(port));
1945 monitor_printf(mon, " Bus %d, Addr %d, Port %s, Speed %s Mb/s\n",
1946 libusb_get_bus_number(devs[i]),
1947 libusb_get_device_address(devs[i]),
1948 port,
1949 speed_name[libusb_get_device_speed(devs[i])]);
1950 monitor_printf(mon, " Class %02x:", ddesc.bDeviceClass);
1951 monitor_printf(mon, " USB device %04x:%04x",
1952 ddesc.idVendor, ddesc.idProduct);
1953 if (ddesc.iProduct) {
1954 libusb_device_handle *handle;
1955 if (libusb_open(devs[i], &handle) == 0) {
1956 unsigned char name[64] = "";
1957 libusb_get_string_descriptor_ascii(handle,
1958 ddesc.iProduct,
1959 name, sizeof(name));
1960 libusb_close(handle);
1961 monitor_printf(mon, ", %s", name);
1962 }
1963 }
1964 monitor_printf(mon, "\n");
1965 }
1966 libusb_free_device_list(devs, 1);
1967 }
AR7 emulation for QEMU