]> git.proxmox.com Git - mirror_qemu.git/blame - usb-linux.c
gdbstub: Return appropriate watch message to gdb (Jan Kiszka)
[mirror_qemu.git] / usb-linux.c
CommitLineData
bb36d470
FB
1/*
2 * Linux host USB redirector
3 *
4 * Copyright (c) 2005 Fabrice Bellard
5fafdf24 5 *
64838171
AL
6 * Copyright (c) 2008 Max Krasnyansky
7 * Support for host device auto connect & disconnect
5d0c5750 8 * Major rewrite to support fully async operation
4b096fc9 9 *
0f431527
AL
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 *
bb36d470
FB
14 * Permission is hereby granted, free of charge, to any person obtaining a copy
15 * of this software and associated documentation files (the "Software"), to deal
16 * in the Software without restriction, including without limitation the rights
17 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
18 * copies of the Software, and to permit persons to whom the Software is
19 * furnished to do so, subject to the following conditions:
20 *
21 * The above copyright notice and this permission notice shall be included in
22 * all copies or substantial portions of the Software.
23 *
24 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
25 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
26 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
27 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
28 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
29 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
30 * THE SOFTWARE.
31 */
446ab128 32
87ecb68b 33#include "qemu-common.h"
1f3870ab 34#include "qemu-timer.h"
87ecb68b 35#include "console.h"
bb36d470
FB
36
37#if defined(__linux__)
38#include <dirent.h>
39#include <sys/ioctl.h>
b9dc033c 40#include <signal.h>
bb36d470 41
446ab128
AL
42#include <linux/usbdevice_fs.h>
43#include <linux/version.h>
44#include "hw/usb.h"
bb36d470 45
d9cf1578
BS
46/* We redefine it to avoid version problems */
47struct usb_ctrltransfer {
48 uint8_t bRequestType;
49 uint8_t bRequest;
50 uint16_t wValue;
51 uint16_t wIndex;
52 uint16_t wLength;
53 uint32_t timeout;
54 void *data;
55};
56
57struct usb_ctrlrequest {
58 uint8_t bRequestType;
59 uint8_t bRequest;
60 uint16_t wValue;
61 uint16_t wIndex;
62 uint16_t wLength;
63};
64
a594cfbf 65typedef int USBScanFunc(void *opaque, int bus_num, int addr, int class_id,
5fafdf24 66 int vendor_id, int product_id,
a594cfbf 67 const char *product_name, int speed);
5fafdf24 68static int usb_host_find_device(int *pbus_num, int *paddr,
1f6e24e7 69 char *product_name, int product_name_size,
a594cfbf 70 const char *devname);
a594cfbf 71//#define DEBUG
64838171
AL
72
73#ifdef DEBUG
74#define dprintf printf
75#else
76#define dprintf(...)
77#endif
bb36d470 78
5be8e1f2
BS
79#define USBDBG_DEVOPENED "husb: opened %s/devices\n"
80
0f431527 81#define USBPROCBUS_PATH "/proc/bus/usb"
1f6e24e7 82#define PRODUCT_NAME_SZ 32
b9dc033c 83#define MAX_ENDPOINTS 16
0f431527
AL
84#define USBDEVBUS_PATH "/dev/bus/usb"
85#define USBSYSBUS_PATH "/sys/bus/usb"
86
87static char *usb_host_device_path;
88
89#define USB_FS_NONE 0
90#define USB_FS_PROC 1
91#define USB_FS_DEV 2
92#define USB_FS_SYS 3
93
94static int usb_fs_type;
bb36d470 95
b9dc033c
AZ
96/* endpoint association data */
97struct endp_data {
98 uint8_t type;
64838171 99 uint8_t halted;
b9dc033c
AZ
100};
101
446ab128
AL
102enum {
103 CTRL_STATE_IDLE = 0,
104 CTRL_STATE_SETUP,
105 CTRL_STATE_DATA,
106 CTRL_STATE_ACK
107};
108
109/*
110 * Control transfer state.
111 * Note that 'buffer' _must_ follow 'req' field because
112 * we need contigious buffer when we submit control URB.
113 */
114struct ctrl_struct {
115 uint16_t len;
116 uint16_t offset;
117 uint8_t state;
118 struct usb_ctrlrequest req;
119 uint8_t buffer[1024];
120};
121
bb36d470
FB
122typedef struct USBHostDevice {
123 USBDevice dev;
64838171
AL
124 int fd;
125
126 uint8_t descr[1024];
127 int descr_len;
128 int configuration;
446ab128 129 int ninterfaces;
24772c1e 130 int closing;
64838171 131
446ab128 132 struct ctrl_struct ctrl;
b9dc033c 133 struct endp_data endp_table[MAX_ENDPOINTS];
4b096fc9 134
4b096fc9
AL
135 /* Host side address */
136 int bus_num;
137 int addr;
138
139 struct USBHostDevice *next;
bb36d470
FB
140} USBHostDevice;
141
64838171
AL
142static int is_isoc(USBHostDevice *s, int ep)
143{
144 return s->endp_table[ep - 1].type == USBDEVFS_URB_TYPE_ISO;
145}
146
147static int is_halted(USBHostDevice *s, int ep)
148{
149 return s->endp_table[ep - 1].halted;
150}
151
152static void clear_halt(USBHostDevice *s, int ep)
153{
154 s->endp_table[ep - 1].halted = 0;
155}
156
157static void set_halt(USBHostDevice *s, int ep)
158{
159 s->endp_table[ep - 1].halted = 1;
160}
161
4b096fc9
AL
162static USBHostDevice *hostdev_list;
163
164static void hostdev_link(USBHostDevice *dev)
165{
166 dev->next = hostdev_list;
167 hostdev_list = dev;
168}
169
170static void hostdev_unlink(USBHostDevice *dev)
171{
172 USBHostDevice *pdev = hostdev_list;
173 USBHostDevice **prev = &hostdev_list;
174
175 while (pdev) {
176 if (pdev == dev) {
177 *prev = dev->next;
178 return;
179 }
180
181 prev = &pdev->next;
182 pdev = pdev->next;
183 }
184}
185
186static USBHostDevice *hostdev_find(int bus_num, int addr)
187{
188 USBHostDevice *s = hostdev_list;
189 while (s) {
190 if (s->bus_num == bus_num && s->addr == addr)
191 return s;
192 s = s->next;
193 }
194 return NULL;
195}
196
64838171
AL
197/*
198 * Async URB state.
199 * We always allocate one isoc descriptor even for bulk transfers
200 * to simplify allocation and casts.
201 */
202typedef struct AsyncURB
203{
204 struct usbdevfs_urb urb;
205 struct usbdevfs_iso_packet_desc isocpd;
b9dc033c 206
64838171
AL
207 USBPacket *packet;
208 USBHostDevice *hdev;
209} AsyncURB;
b9dc033c 210
64838171 211static AsyncURB *async_alloc(void)
b9dc033c 212{
64838171 213 return (AsyncURB *) qemu_mallocz(sizeof(AsyncURB));
b9dc033c
AZ
214}
215
64838171 216static void async_free(AsyncURB *aurb)
b9dc033c 217{
64838171
AL
218 qemu_free(aurb);
219}
b9dc033c 220
446ab128
AL
221static void async_complete_ctrl(USBHostDevice *s, USBPacket *p)
222{
223 switch(s->ctrl.state) {
224 case CTRL_STATE_SETUP:
225 if (p->len < s->ctrl.len)
226 s->ctrl.len = p->len;
227 s->ctrl.state = CTRL_STATE_DATA;
228 p->len = 8;
229 break;
230
231 case CTRL_STATE_ACK:
232 s->ctrl.state = CTRL_STATE_IDLE;
233 p->len = 0;
234 break;
235
236 default:
237 break;
238 }
239}
240
64838171
AL
241static void async_complete(void *opaque)
242{
243 USBHostDevice *s = opaque;
244 AsyncURB *aurb;
245
246 while (1) {
247 USBPacket *p;
b9dc033c 248
64838171
AL
249 int r = ioctl(s->fd, USBDEVFS_REAPURBNDELAY, &aurb);
250 if (r < 0) {
251 if (errno == EAGAIN)
252 return;
253
24772c1e 254 if (errno == ENODEV && !s->closing) {
64838171
AL
255 printf("husb: device %d.%d disconnected\n", s->bus_num, s->addr);
256 usb_device_del_addr(0, s->dev.addr);
257 return;
258 }
259
260 dprintf("husb: async. reap urb failed errno %d\n", errno);
261 return;
b9dc033c 262 }
64838171
AL
263
264 p = aurb->packet;
265
266 dprintf("husb: async completed. aurb %p status %d alen %d\n",
267 aurb, aurb->urb.status, aurb->urb.actual_length);
268
269 if (p) {
270 switch (aurb->urb.status) {
271 case 0:
272 p->len = aurb->urb.actual_length;
446ab128
AL
273 if (aurb->urb.type == USBDEVFS_URB_TYPE_CONTROL)
274 async_complete_ctrl(s, p);
64838171
AL
275 break;
276
277 case -EPIPE:
278 set_halt(s, p->devep);
279 /* fall through */
280 default:
281 p->len = USB_RET_NAK;
282 break;
283 }
284
285 usb_packet_complete(p);
286 }
287
288 async_free(aurb);
b9dc033c 289 }
b9dc033c
AZ
290}
291
64838171 292static void async_cancel(USBPacket *unused, void *opaque)
b9dc033c 293{
64838171
AL
294 AsyncURB *aurb = opaque;
295 USBHostDevice *s = aurb->hdev;
b9dc033c 296
64838171
AL
297 dprintf("husb: async cancel. aurb %p\n", aurb);
298
299 /* Mark it as dead (see async_complete above) */
300 aurb->packet = NULL;
b9dc033c 301
64838171
AL
302 int r = ioctl(s->fd, USBDEVFS_DISCARDURB, aurb);
303 if (r < 0) {
304 dprintf("husb: async. discard urb failed errno %d\n", errno);
b9dc033c 305 }
b9dc033c
AZ
306}
307
446ab128 308static int usb_host_claim_interfaces(USBHostDevice *dev, int configuration)
b9dc033c
AZ
309{
310 int dev_descr_len, config_descr_len;
311 int interface, nb_interfaces, nb_configurations;
312 int ret, i;
313
314 if (configuration == 0) /* address state - ignore */
315 return 1;
316
446ab128
AL
317 dprintf("husb: claiming interfaces. config %d\n", configuration);
318
b9dc033c
AZ
319 i = 0;
320 dev_descr_len = dev->descr[0];
321 if (dev_descr_len > dev->descr_len)
322 goto fail;
323 nb_configurations = dev->descr[17];
324
325 i += dev_descr_len;
326 while (i < dev->descr_len) {
64838171 327 dprintf("husb: i is %d, descr_len is %d, dl %d, dt %d\n", i, dev->descr_len,
b9dc033c 328 dev->descr[i], dev->descr[i+1]);
64838171 329
b9dc033c
AZ
330 if (dev->descr[i+1] != USB_DT_CONFIG) {
331 i += dev->descr[i];
332 continue;
333 }
334 config_descr_len = dev->descr[i];
335
64838171 336 printf("husb: config #%d need %d\n", dev->descr[i + 5], configuration);
1f3870ab 337
446ab128
AL
338 if (configuration < 0 || configuration == dev->descr[i + 5]) {
339 configuration = dev->descr[i + 5];
b9dc033c 340 break;
446ab128 341 }
b9dc033c
AZ
342
343 i += config_descr_len;
344 }
345
346 if (i >= dev->descr_len) {
0d380648 347 fprintf(stderr, "husb: update iface failed. no matching configuration\n");
b9dc033c
AZ
348 goto fail;
349 }
350 nb_interfaces = dev->descr[i + 4];
351
352#ifdef USBDEVFS_DISCONNECT
353 /* earlier Linux 2.4 do not support that */
354 {
355 struct usbdevfs_ioctl ctrl;
356 for (interface = 0; interface < nb_interfaces; interface++) {
357 ctrl.ioctl_code = USBDEVFS_DISCONNECT;
358 ctrl.ifno = interface;
359 ret = ioctl(dev->fd, USBDEVFS_IOCTL, &ctrl);
360 if (ret < 0 && errno != ENODATA) {
361 perror("USBDEVFS_DISCONNECT");
362 goto fail;
363 }
364 }
365 }
366#endif
367
368 /* XXX: only grab if all interfaces are free */
369 for (interface = 0; interface < nb_interfaces; interface++) {
370 ret = ioctl(dev->fd, USBDEVFS_CLAIMINTERFACE, &interface);
371 if (ret < 0) {
372 if (errno == EBUSY) {
64838171 373 printf("husb: update iface. device already grabbed\n");
b9dc033c 374 } else {
64838171 375 perror("husb: failed to claim interface");
b9dc033c
AZ
376 }
377 fail:
378 return 0;
379 }
380 }
381
64838171 382 printf("husb: %d interfaces claimed for configuration %d\n",
b9dc033c 383 nb_interfaces, configuration);
b9dc033c 384
446ab128
AL
385 dev->ninterfaces = nb_interfaces;
386 dev->configuration = configuration;
387 return 1;
388}
389
390static int usb_host_release_interfaces(USBHostDevice *s)
391{
392 int ret, i;
393
394 dprintf("husb: releasing interfaces\n");
395
396 for (i = 0; i < s->ninterfaces; i++) {
397 ret = ioctl(s->fd, USBDEVFS_RELEASEINTERFACE, &i);
398 if (ret < 0) {
399 perror("husb: failed to release interface");
400 return 0;
401 }
402 }
403
b9dc033c
AZ
404 return 1;
405}
406
059809e4 407static void usb_host_handle_reset(USBDevice *dev)
bb36d470 408{
446ab128 409 USBHostDevice *s = (USBHostDevice *) dev;
64838171
AL
410
411 dprintf("husb: reset device %u.%u\n", s->bus_num, s->addr);
412
bb36d470 413 ioctl(s->fd, USBDEVFS_RESET);
446ab128
AL
414
415 usb_host_claim_interfaces(s, s->configuration);
5fafdf24 416}
bb36d470 417
059809e4
FB
418static void usb_host_handle_destroy(USBDevice *dev)
419{
420 USBHostDevice *s = (USBHostDevice *)dev;
421
24772c1e
AL
422 s->closing = 1;
423
64838171 424 qemu_set_fd_handler(s->fd, NULL, NULL, NULL);
1f3870ab 425
4b096fc9
AL
426 hostdev_unlink(s);
427
64838171
AL
428 async_complete(s);
429
059809e4
FB
430 if (s->fd >= 0)
431 close(s->fd);
1f3870ab 432
059809e4
FB
433 qemu_free(s);
434}
435
b9dc033c
AZ
436static int usb_linux_update_endp_table(USBHostDevice *s);
437
446ab128 438static int usb_host_handle_data(USBHostDevice *s, USBPacket *p)
bb36d470 439{
64838171 440 struct usbdevfs_urb *urb;
446ab128 441 AsyncURB *aurb;
bb36d470
FB
442 int ret;
443
64838171
AL
444 aurb = async_alloc();
445 if (!aurb) {
446 dprintf("husb: async malloc failed\n");
447 return USB_RET_NAK;
b9dc033c 448 }
64838171
AL
449 aurb->hdev = s;
450 aurb->packet = p;
451
452 urb = &aurb->urb;
b9dc033c 453
4d611c9a 454 if (p->pid == USB_TOKEN_IN)
64838171
AL
455 urb->endpoint = p->devep | 0x80;
456 else
457 urb->endpoint = p->devep;
458
459 if (is_halted(s, p->devep)) {
460 ret = ioctl(s->fd, USBDEVFS_CLEAR_HALT, &urb->endpoint);
461 if (ret < 0) {
462 dprintf("husb: failed to clear halt. ep 0x%x errno %d\n",
463 urb->endpoint, errno);
bb36d470 464 return USB_RET_NAK;
bb36d470 465 }
64838171 466 clear_halt(s, p->devep);
4d043a09
AZ
467 }
468
64838171
AL
469 urb->buffer = p->data;
470 urb->buffer_length = p->len;
b9dc033c 471
64838171
AL
472 if (is_isoc(s, p->devep)) {
473 /* Setup ISOC transfer */
474 urb->type = USBDEVFS_URB_TYPE_ISO;
475 urb->flags = USBDEVFS_URB_ISO_ASAP;
476 urb->number_of_packets = 1;
477 urb->iso_frame_desc[0].length = p->len;
478 } else {
479 /* Setup bulk transfer */
480 urb->type = USBDEVFS_URB_TYPE_BULK;
b9dc033c
AZ
481 }
482
64838171 483 urb->usercontext = s;
b9dc033c 484
64838171 485 ret = ioctl(s->fd, USBDEVFS_SUBMITURB, urb);
b9dc033c 486
64838171 487 dprintf("husb: data submit. ep 0x%x len %u aurb %p\n", urb->endpoint, p->len, aurb);
b9dc033c 488
64838171
AL
489 if (ret < 0) {
490 dprintf("husb: submit failed. errno %d\n", errno);
491 async_free(aurb);
b9dc033c 492
b9dc033c
AZ
493 switch(errno) {
494 case ETIMEDOUT:
495 return USB_RET_NAK;
496 case EPIPE:
497 default:
498 return USB_RET_STALL;
499 }
500 }
64838171
AL
501
502 usb_defer_packet(p, async_cancel, aurb);
b9dc033c 503 return USB_RET_ASYNC;
b9dc033c
AZ
504}
505
446ab128
AL
506static int ctrl_error(void)
507{
508 if (errno == ETIMEDOUT)
509 return USB_RET_NAK;
510 else
511 return USB_RET_STALL;
512}
513
514static int usb_host_set_address(USBHostDevice *s, int addr)
515{
516 dprintf("husb: ctrl set addr %u\n", addr);
517 s->dev.addr = addr;
518 return 0;
519}
520
521static int usb_host_set_config(USBHostDevice *s, int config)
522{
523 usb_host_release_interfaces(s);
524
525 int ret = ioctl(s->fd, USBDEVFS_SETCONFIGURATION, &config);
526
527 dprintf("husb: ctrl set config %d ret %d errno %d\n", config, ret, errno);
528
529 if (ret < 0)
530 return ctrl_error();
531
532 usb_host_claim_interfaces(s, config);
533 return 0;
534}
535
536static int usb_host_set_interface(USBHostDevice *s, int iface, int alt)
537{
538 struct usbdevfs_setinterface si;
539 int ret;
540
541 si.interface = iface;
542 si.altsetting = alt;
543 ret = ioctl(s->fd, USBDEVFS_SETINTERFACE, &si);
544
545 dprintf("husb: ctrl set iface %d altset %d ret %d errno %d\n",
546 iface, alt, ret, errno);
547
548 if (ret < 0)
549 return ctrl_error();
550
551 usb_linux_update_endp_table(s);
552 return 0;
553}
554
555static int usb_host_handle_control(USBHostDevice *s, USBPacket *p)
556{
557 struct usbdevfs_urb *urb;
558 AsyncURB *aurb;
559 int ret, value, index;
560
561 /*
562 * Process certain standard device requests.
563 * These are infrequent and are processed synchronously.
564 */
565 value = le16_to_cpu(s->ctrl.req.wValue);
566 index = le16_to_cpu(s->ctrl.req.wIndex);
567
568 dprintf("husb: ctrl type 0x%x req 0x%x val 0x%x index %u len %u\n",
569 s->ctrl.req.bRequestType, s->ctrl.req.bRequest, value, index,
570 s->ctrl.len);
571
572 if (s->ctrl.req.bRequestType == 0) {
573 switch (s->ctrl.req.bRequest) {
574 case USB_REQ_SET_ADDRESS:
575 return usb_host_set_address(s, value);
576
577 case USB_REQ_SET_CONFIGURATION:
578 return usb_host_set_config(s, value & 0xff);
579 }
580 }
581
582 if (s->ctrl.req.bRequestType == 1 &&
583 s->ctrl.req.bRequest == USB_REQ_SET_INTERFACE)
584 return usb_host_set_interface(s, index, value);
585
586 /* The rest are asynchronous */
587
588 aurb = async_alloc();
589 if (!aurb) {
590 dprintf("husb: async malloc failed\n");
591 return USB_RET_NAK;
592 }
593 aurb->hdev = s;
594 aurb->packet = p;
595
596 /*
597 * Setup ctrl transfer.
598 *
599 * s->ctrl is layed out such that data buffer immediately follows
600 * 'req' struct which is exactly what usbdevfs expects.
601 */
602 urb = &aurb->urb;
603
604 urb->type = USBDEVFS_URB_TYPE_CONTROL;
605 urb->endpoint = p->devep;
606
607 urb->buffer = &s->ctrl.req;
608 urb->buffer_length = 8 + s->ctrl.len;
609
610 urb->usercontext = s;
611
612 ret = ioctl(s->fd, USBDEVFS_SUBMITURB, urb);
613
614 dprintf("husb: submit ctrl. len %u aurb %p\n", urb->buffer_length, aurb);
615
616 if (ret < 0) {
617 dprintf("husb: submit failed. errno %d\n", errno);
618 async_free(aurb);
619
620 switch(errno) {
621 case ETIMEDOUT:
622 return USB_RET_NAK;
623 case EPIPE:
624 default:
625 return USB_RET_STALL;
626 }
627 }
628
629 usb_defer_packet(p, async_cancel, aurb);
630 return USB_RET_ASYNC;
631}
632
633static int do_token_setup(USBDevice *dev, USBPacket *p)
634{
635 USBHostDevice *s = (USBHostDevice *) dev;
636 int ret = 0;
637
638 if (p->len != 8)
639 return USB_RET_STALL;
640
641 memcpy(&s->ctrl.req, p->data, 8);
642 s->ctrl.len = le16_to_cpu(s->ctrl.req.wLength);
643 s->ctrl.offset = 0;
644 s->ctrl.state = CTRL_STATE_SETUP;
645
646 if (s->ctrl.req.bRequestType & USB_DIR_IN) {
647 ret = usb_host_handle_control(s, p);
648 if (ret < 0)
649 return ret;
650
651 if (ret < s->ctrl.len)
652 s->ctrl.len = ret;
653 s->ctrl.state = CTRL_STATE_DATA;
654 } else {
655 if (s->ctrl.len == 0)
656 s->ctrl.state = CTRL_STATE_ACK;
657 else
658 s->ctrl.state = CTRL_STATE_DATA;
659 }
660
661 return ret;
662}
663
664static int do_token_in(USBDevice *dev, USBPacket *p)
665{
666 USBHostDevice *s = (USBHostDevice *) dev;
667 int ret = 0;
668
669 if (p->devep != 0)
670 return usb_host_handle_data(s, p);
671
672 switch(s->ctrl.state) {
673 case CTRL_STATE_ACK:
674 if (!(s->ctrl.req.bRequestType & USB_DIR_IN)) {
675 ret = usb_host_handle_control(s, p);
676 if (ret == USB_RET_ASYNC)
677 return USB_RET_ASYNC;
678
679 s->ctrl.state = CTRL_STATE_IDLE;
680 return ret > 0 ? 0 : ret;
681 }
682
683 return 0;
684
685 case CTRL_STATE_DATA:
686 if (s->ctrl.req.bRequestType & USB_DIR_IN) {
687 int len = s->ctrl.len - s->ctrl.offset;
688 if (len > p->len)
689 len = p->len;
690 memcpy(p->data, s->ctrl.buffer + s->ctrl.offset, len);
691 s->ctrl.offset += len;
692 if (s->ctrl.offset >= s->ctrl.len)
693 s->ctrl.state = CTRL_STATE_ACK;
694 return len;
695 }
696
697 s->ctrl.state = CTRL_STATE_IDLE;
698 return USB_RET_STALL;
699
700 default:
701 return USB_RET_STALL;
702 }
703}
704
705static int do_token_out(USBDevice *dev, USBPacket *p)
706{
707 USBHostDevice *s = (USBHostDevice *) dev;
708
709 if (p->devep != 0)
710 return usb_host_handle_data(s, p);
711
712 switch(s->ctrl.state) {
713 case CTRL_STATE_ACK:
714 if (s->ctrl.req.bRequestType & USB_DIR_IN) {
715 s->ctrl.state = CTRL_STATE_IDLE;
716 /* transfer OK */
717 } else {
718 /* ignore additional output */
719 }
720 return 0;
721
722 case CTRL_STATE_DATA:
723 if (!(s->ctrl.req.bRequestType & USB_DIR_IN)) {
724 int len = s->ctrl.len - s->ctrl.offset;
725 if (len > p->len)
726 len = p->len;
727 memcpy(s->ctrl.buffer + s->ctrl.offset, p->data, len);
728 s->ctrl.offset += len;
729 if (s->ctrl.offset >= s->ctrl.len)
730 s->ctrl.state = CTRL_STATE_ACK;
731 return len;
732 }
733
734 s->ctrl.state = CTRL_STATE_IDLE;
735 return USB_RET_STALL;
736
737 default:
738 return USB_RET_STALL;
739 }
740}
741
742/*
743 * Packet handler.
744 * Called by the HC (host controller).
745 *
746 * Returns length of the transaction or one of the USB_RET_XXX codes.
747 */
d9cf1578 748static int usb_host_handle_packet(USBDevice *s, USBPacket *p)
446ab128
AL
749{
750 switch(p->pid) {
751 case USB_MSG_ATTACH:
752 s->state = USB_STATE_ATTACHED;
753 return 0;
754
755 case USB_MSG_DETACH:
756 s->state = USB_STATE_NOTATTACHED;
757 return 0;
758
759 case USB_MSG_RESET:
760 s->remote_wakeup = 0;
761 s->addr = 0;
762 s->state = USB_STATE_DEFAULT;
763 s->handle_reset(s);
764 return 0;
765 }
766
767 /* Rest of the PIDs must match our address */
768 if (s->state < USB_STATE_DEFAULT || p->devaddr != s->addr)
769 return USB_RET_NODEV;
770
771 switch (p->pid) {
772 case USB_TOKEN_SETUP:
773 return do_token_setup(s, p);
774
775 case USB_TOKEN_IN:
776 return do_token_in(s, p);
777
778 case USB_TOKEN_OUT:
779 return do_token_out(s, p);
780
781 default:
782 return USB_RET_STALL;
783 }
784}
785
b9dc033c
AZ
786/* returns 1 on problem encountered or 0 for success */
787static int usb_linux_update_endp_table(USBHostDevice *s)
788{
789 uint8_t *descriptors;
790 uint8_t devep, type, configuration, alt_interface;
e41b3910 791 struct usb_ctrltransfer ct;
b9dc033c
AZ
792 int interface, ret, length, i;
793
794 ct.bRequestType = USB_DIR_IN;
795 ct.bRequest = USB_REQ_GET_CONFIGURATION;
796 ct.wValue = 0;
797 ct.wIndex = 0;
798 ct.wLength = 1;
799 ct.data = &configuration;
800 ct.timeout = 50;
801
802 ret = ioctl(s->fd, USBDEVFS_CONTROL, &ct);
803 if (ret < 0) {
804 perror("usb_linux_update_endp_table");
805 return 1;
806 }
807
808 /* in address state */
809 if (configuration == 0)
810 return 1;
811
812 /* get the desired configuration, interface, and endpoint descriptors
813 * from device description */
814 descriptors = &s->descr[18];
815 length = s->descr_len - 18;
816 i = 0;
817
818 if (descriptors[i + 1] != USB_DT_CONFIG ||
819 descriptors[i + 5] != configuration) {
64838171 820 dprintf("invalid descriptor data - configuration\n");
b9dc033c
AZ
821 return 1;
822 }
823 i += descriptors[i];
824
825 while (i < length) {
826 if (descriptors[i + 1] != USB_DT_INTERFACE ||
827 (descriptors[i + 1] == USB_DT_INTERFACE &&
828 descriptors[i + 4] == 0)) {
829 i += descriptors[i];
830 continue;
831 }
832
833 interface = descriptors[i + 2];
834
835 ct.bRequestType = USB_DIR_IN | USB_RECIP_INTERFACE;
836 ct.bRequest = USB_REQ_GET_INTERFACE;
837 ct.wValue = 0;
838 ct.wIndex = interface;
839 ct.wLength = 1;
840 ct.data = &alt_interface;
841 ct.timeout = 50;
842
843 ret = ioctl(s->fd, USBDEVFS_CONTROL, &ct);
844 if (ret < 0) {
845 perror("usb_linux_update_endp_table");
846 return 1;
847 }
848
849 /* the current interface descriptor is the active interface
850 * and has endpoints */
851 if (descriptors[i + 3] != alt_interface) {
852 i += descriptors[i];
853 continue;
854 }
855
856 /* advance to the endpoints */
857 while (i < length && descriptors[i +1] != USB_DT_ENDPOINT)
858 i += descriptors[i];
859
860 if (i >= length)
861 break;
862
863 while (i < length) {
864 if (descriptors[i + 1] != USB_DT_ENDPOINT)
865 break;
866
867 devep = descriptors[i + 2];
868 switch (descriptors[i + 3] & 0x3) {
869 case 0x00:
870 type = USBDEVFS_URB_TYPE_CONTROL;
871 break;
872 case 0x01:
873 type = USBDEVFS_URB_TYPE_ISO;
874 break;
875 case 0x02:
876 type = USBDEVFS_URB_TYPE_BULK;
877 break;
878 case 0x03:
879 type = USBDEVFS_URB_TYPE_INTERRUPT;
880 break;
881 default:
64838171 882 dprintf("usb_host: malformed endpoint type\n");
b9dc033c
AZ
883 type = USBDEVFS_URB_TYPE_BULK;
884 }
885 s->endp_table[(devep & 0xf) - 1].type = type;
64838171 886 s->endp_table[(devep & 0xf) - 1].halted = 0;
b9dc033c
AZ
887
888 i += descriptors[i];
889 }
890 }
891 return 0;
892}
893
4b096fc9 894static USBDevice *usb_host_device_open_addr(int bus_num, int addr, const char *prod_name)
bb36d470 895{
b9dc033c
AZ
896 int fd = -1, ret;
897 USBHostDevice *dev = NULL;
bb36d470 898 struct usbdevfs_connectinfo ci;
a594cfbf 899 char buf[1024];
1f3870ab 900
b9dc033c
AZ
901 dev = qemu_mallocz(sizeof(USBHostDevice));
902 if (!dev)
903 goto fail;
904
4b096fc9
AL
905 dev->bus_num = bus_num;
906 dev->addr = addr;
907
64838171 908 printf("husb: open device %d.%d\n", bus_num, addr);
3b46e624 909
0f431527
AL
910 if (!usb_host_device_path) {
911 perror("husb: USB Host Device Path not set");
912 goto fail;
913 }
914 snprintf(buf, sizeof(buf), "%s/%03d/%03d", usb_host_device_path,
a594cfbf 915 bus_num, addr);
b9dc033c 916 fd = open(buf, O_RDWR | O_NONBLOCK);
bb36d470 917 if (fd < 0) {
a594cfbf 918 perror(buf);
1f3870ab 919 goto fail;
bb36d470 920 }
0f431527 921 dprintf("husb: opened %s\n", buf);
bb36d470 922
b9dc033c
AZ
923 /* read the device description */
924 dev->descr_len = read(fd, dev->descr, sizeof(dev->descr));
925 if (dev->descr_len <= 0) {
64838171 926 perror("husb: reading device data failed");
bb36d470
FB
927 goto fail;
928 }
3b46e624 929
b9dc033c 930#ifdef DEBUG
868bfe2b 931 {
b9dc033c
AZ
932 int x;
933 printf("=== begin dumping device descriptor data ===\n");
934 for (x = 0; x < dev->descr_len; x++)
935 printf("%02x ", dev->descr[x]);
936 printf("\n=== end dumping device descriptor data ===\n");
bb36d470 937 }
a594cfbf
FB
938#endif
939
b9dc033c 940 dev->fd = fd;
b9dc033c 941
446ab128
AL
942 /*
943 * Initial configuration is -1 which makes us claim first
944 * available config. We used to start with 1, which does not
945 * always work. I've seen devices where first config starts
946 * with 2.
947 */
948 if (!usb_host_claim_interfaces(dev, -1))
b9dc033c 949 goto fail;
bb36d470
FB
950
951 ret = ioctl(fd, USBDEVFS_CONNECTINFO, &ci);
952 if (ret < 0) {
046833ea 953 perror("usb_host_device_open: USBDEVFS_CONNECTINFO");
bb36d470
FB
954 goto fail;
955 }
956
64838171 957 printf("husb: grabbed usb device %d.%d\n", bus_num, addr);
bb36d470 958
b9dc033c
AZ
959 ret = usb_linux_update_endp_table(dev);
960 if (ret)
bb36d470 961 goto fail;
b9dc033c 962
bb36d470
FB
963 if (ci.slow)
964 dev->dev.speed = USB_SPEED_LOW;
965 else
966 dev->dev.speed = USB_SPEED_HIGH;
bb36d470 967
446ab128
AL
968 dev->dev.handle_packet = usb_host_handle_packet;
969 dev->dev.handle_reset = usb_host_handle_reset;
059809e4 970 dev->dev.handle_destroy = usb_host_handle_destroy;
1f6e24e7 971
4b096fc9 972 if (!prod_name || prod_name[0] == '\0')
1f6e24e7 973 snprintf(dev->dev.devname, sizeof(dev->dev.devname),
4b096fc9 974 "host:%d.%d", bus_num, addr);
1f6e24e7
FB
975 else
976 pstrcpy(dev->dev.devname, sizeof(dev->dev.devname),
4b096fc9 977 prod_name);
1f6e24e7 978
64838171
AL
979 /* USB devio uses 'write' flag to check for async completions */
980 qemu_set_fd_handler(dev->fd, NULL, async_complete, dev);
1f3870ab 981
4b096fc9
AL
982 hostdev_link(dev);
983
64838171 984 return (USBDevice *) dev;
4b096fc9 985
b9dc033c 986fail:
24772c1e 987 if (dev)
b9dc033c 988 qemu_free(dev);
24772c1e 989
b9dc033c
AZ
990 close(fd);
991 return NULL;
a594cfbf 992}
bb36d470 993
5d0c5750
AL
994static int usb_host_auto_add(const char *spec);
995static int usb_host_auto_del(const char *spec);
996
4b096fc9
AL
997USBDevice *usb_host_device_open(const char *devname)
998{
999 int bus_num, addr;
1000 char product_name[PRODUCT_NAME_SZ];
1001
5d0c5750
AL
1002 if (strstr(devname, "auto:")) {
1003 usb_host_auto_add(devname);
4b096fc9 1004 return NULL;
5d0c5750 1005 }
4b096fc9 1006
5d0c5750
AL
1007 if (usb_host_find_device(&bus_num, &addr, product_name, sizeof(product_name),
1008 devname) < 0)
4b096fc9 1009 return NULL;
5d0c5750
AL
1010
1011 if (hostdev_find(bus_num, addr)) {
1012 term_printf("husb: host usb device %d.%d is already open\n", bus_num, addr);
1013 return NULL;
1014 }
4b096fc9
AL
1015
1016 return usb_host_device_open_addr(bus_num, addr, product_name);
1017}
5d0c5750
AL
1018
1019int usb_host_device_close(const char *devname)
1020{
1021 char product_name[PRODUCT_NAME_SZ];
1022 int bus_num, addr;
1023 USBHostDevice *s;
1024
1025 if (strstr(devname, "auto:"))
1026 return usb_host_auto_del(devname);
1027
1028 if (usb_host_find_device(&bus_num, &addr, product_name, sizeof(product_name),
1029 devname) < 0)
1030 return -1;
1031
1032 s = hostdev_find(bus_num, addr);
1033 if (s) {
1034 usb_device_del_addr(0, s->dev.addr);
1035 return 0;
1036 }
1037
1038 return -1;
1039}
4b096fc9 1040
a594cfbf 1041static int get_tag_value(char *buf, int buf_size,
5fafdf24 1042 const char *str, const char *tag,
a594cfbf
FB
1043 const char *stopchars)
1044{
1045 const char *p;
1046 char *q;
1047 p = strstr(str, tag);
1048 if (!p)
1049 return -1;
1050 p += strlen(tag);
1051 while (isspace(*p))
1052 p++;
1053 q = buf;
1054 while (*p != '\0' && !strchr(stopchars, *p)) {
1055 if ((q - buf) < (buf_size - 1))
1056 *q++ = *p;
1057 p++;
1058 }
1059 *q = '\0';
1060 return q - buf;
bb36d470
FB
1061}
1062
0f431527
AL
1063/*
1064 * Use /proc/bus/usb/devices or /dev/bus/usb/devices file to determine
1065 * host's USB devices. This is legacy support since many distributions
1066 * are moving to /sys/bus/usb
1067 */
1068static int usb_host_scan_dev(void *opaque, USBScanFunc *func)
bb36d470 1069{
0f431527 1070 FILE *f = 0;
a594cfbf 1071 char line[1024];
bb36d470 1072 char buf[1024];
a594cfbf 1073 int bus_num, addr, speed, device_count, class_id, product_id, vendor_id;
a594cfbf 1074 char product_name[512];
0f431527 1075 int ret = 0;
3b46e624 1076
0f431527
AL
1077 if (!usb_host_device_path) {
1078 perror("husb: USB Host Device Path not set");
1079 goto the_end;
1080 }
1081 snprintf(line, sizeof(line), "%s/devices", usb_host_device_path);
1082 f = fopen(line, "r");
a594cfbf 1083 if (!f) {
0f431527
AL
1084 perror("husb: cannot open devices file");
1085 goto the_end;
a594cfbf 1086 }
0f431527 1087
a594cfbf
FB
1088 device_count = 0;
1089 bus_num = addr = speed = class_id = product_id = vendor_id = 0;
bb36d470 1090 for(;;) {
a594cfbf 1091 if (fgets(line, sizeof(line), f) == NULL)
bb36d470 1092 break;
a594cfbf
FB
1093 if (strlen(line) > 0)
1094 line[strlen(line) - 1] = '\0';
1095 if (line[0] == 'T' && line[1] == ':') {
38ca0f6d
PB
1096 if (device_count && (vendor_id || product_id)) {
1097 /* New device. Add the previously discovered device. */
5fafdf24 1098 ret = func(opaque, bus_num, addr, class_id, vendor_id,
a594cfbf
FB
1099 product_id, product_name, speed);
1100 if (ret)
1101 goto the_end;
1102 }
1103 if (get_tag_value(buf, sizeof(buf), line, "Bus=", " ") < 0)
1104 goto fail;
1105 bus_num = atoi(buf);
1106 if (get_tag_value(buf, sizeof(buf), line, "Dev#=", " ") < 0)
1107 goto fail;
1108 addr = atoi(buf);
1109 if (get_tag_value(buf, sizeof(buf), line, "Spd=", " ") < 0)
1110 goto fail;
1111 if (!strcmp(buf, "480"))
1112 speed = USB_SPEED_HIGH;
1113 else if (!strcmp(buf, "1.5"))
1114 speed = USB_SPEED_LOW;
1115 else
1116 speed = USB_SPEED_FULL;
1117 product_name[0] = '\0';
1118 class_id = 0xff;
1119 device_count++;
1120 product_id = 0;
1121 vendor_id = 0;
1122 } else if (line[0] == 'P' && line[1] == ':') {
1123 if (get_tag_value(buf, sizeof(buf), line, "Vendor=", " ") < 0)
1124 goto fail;
1125 vendor_id = strtoul(buf, NULL, 16);
1126 if (get_tag_value(buf, sizeof(buf), line, "ProdID=", " ") < 0)
1127 goto fail;
1128 product_id = strtoul(buf, NULL, 16);
1129 } else if (line[0] == 'S' && line[1] == ':') {
1130 if (get_tag_value(buf, sizeof(buf), line, "Product=", "") < 0)
1131 goto fail;
1132 pstrcpy(product_name, sizeof(product_name), buf);
1133 } else if (line[0] == 'D' && line[1] == ':') {
1134 if (get_tag_value(buf, sizeof(buf), line, "Cls=", " (") < 0)
1135 goto fail;
1136 class_id = strtoul(buf, NULL, 16);
bb36d470 1137 }
a594cfbf
FB
1138 fail: ;
1139 }
38ca0f6d
PB
1140 if (device_count && (vendor_id || product_id)) {
1141 /* Add the last device. */
5fafdf24 1142 ret = func(opaque, bus_num, addr, class_id, vendor_id,
a594cfbf 1143 product_id, product_name, speed);
bb36d470 1144 }
a594cfbf 1145 the_end:
0f431527
AL
1146 if (f)
1147 fclose(f);
1148 return ret;
1149}
1150
1151/*
1152 * Read sys file-system device file
1153 *
1154 * @line address of buffer to put file contents in
1155 * @line_size size of line
1156 * @device_file path to device file (printf format string)
1157 * @device_name device being opened (inserted into device_file)
1158 *
1159 * @return 0 failed, 1 succeeded ('line' contains data)
1160 */
1161static int usb_host_read_file(char *line, size_t line_size, const char *device_file, const char *device_name)
1162{
1163 FILE *f;
1164 int ret = 0;
1165 char filename[PATH_MAX];
1166
1167 snprintf(filename, PATH_MAX, device_file, device_name);
1168 f = fopen(filename, "r");
1169 if (f) {
1170 fgets(line, line_size, f);
1171 fclose(f);
1172 ret = 1;
1173 } else {
1174 term_printf("husb: could not open %s\n", filename);
1175 }
1176
1177 return ret;
1178}
1179
1180/*
1181 * Use /sys/bus/usb/devices/ directory to determine host's USB
1182 * devices.
1183 *
1184 * This code is based on Robert Schiele's original patches posted to
1185 * the Novell bug-tracker https://bugzilla.novell.com/show_bug.cgi?id=241950
1186 */
1187static int usb_host_scan_sys(void *opaque, USBScanFunc *func)
1188{
1189 DIR *dir = 0;
1190 char line[1024];
1191 int bus_num, addr, speed, class_id, product_id, vendor_id;
1192 int ret = 0;
1193 char product_name[512];
1194 struct dirent *de;
1195
1196 dir = opendir(USBSYSBUS_PATH "/devices");
1197 if (!dir) {
1198 perror("husb: cannot open devices directory");
1199 goto the_end;
1200 }
1201
1202 while ((de = readdir(dir))) {
1203 if (de->d_name[0] != '.' && !strchr(de->d_name, ':')) {
1204 char *tmpstr = de->d_name;
1205 if (!strncmp(de->d_name, "usb", 3))
1206 tmpstr += 3;
1207 bus_num = atoi(tmpstr);
1208
1209 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/devnum", de->d_name))
1210 goto the_end;
1211 if (sscanf(line, "%d", &addr) != 1)
1212 goto the_end;
1213
1214 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/bDeviceClass", de->d_name))
1215 goto the_end;
1216 if (sscanf(line, "%x", &class_id) != 1)
1217 goto the_end;
1218
1219 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/idVendor", de->d_name))
1220 goto the_end;
1221 if (sscanf(line, "%x", &vendor_id) != 1)
1222 goto the_end;
1223
1224 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/idProduct", de->d_name))
1225 goto the_end;
1226 if (sscanf(line, "%x", &product_id) != 1)
1227 goto the_end;
1228
1229 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/product", de->d_name)) {
1230 *product_name = 0;
1231 } else {
1232 if (strlen(line) > 0)
1233 line[strlen(line) - 1] = '\0';
1234 pstrcpy(product_name, sizeof(product_name), line);
1235 }
1236
1237 if (!usb_host_read_file(line, sizeof(line), USBSYSBUS_PATH "/devices/%s/speed", de->d_name))
1238 goto the_end;
1239 if (!strcmp(line, "480\n"))
1240 speed = USB_SPEED_HIGH;
1241 else if (!strcmp(line, "1.5\n"))
1242 speed = USB_SPEED_LOW;
1243 else
1244 speed = USB_SPEED_FULL;
1245
1246 ret = func(opaque, bus_num, addr, class_id, vendor_id,
1247 product_id, product_name, speed);
1248 if (ret)
1249 goto the_end;
1250 }
1251 }
1252 the_end:
1253 if (dir)
1254 closedir(dir);
1255 return ret;
1256}
1257
1258/*
1259 * Determine how to access the host's USB devices and call the
1260 * specific support function.
1261 */
1262static int usb_host_scan(void *opaque, USBScanFunc *func)
1263{
1264 FILE *f = 0;
1265 DIR *dir = 0;
1266 int ret = 0;
0f431527
AL
1267 const char *fs_type[] = {"unknown", "proc", "dev", "sys"};
1268 char devpath[PATH_MAX];
1269
1270 /* only check the host once */
1271 if (!usb_fs_type) {
1272 f = fopen(USBPROCBUS_PATH "/devices", "r");
1273 if (f) {
1274 /* devices found in /proc/bus/usb/ */
1275 strcpy(devpath, USBPROCBUS_PATH);
1276 usb_fs_type = USB_FS_PROC;
1277 fclose(f);
5be8e1f2 1278 dprintf(USBDBG_DEVOPENED, USBPROCBUS_PATH);
f16a0db3 1279 goto found_devices;
0f431527
AL
1280 }
1281 /* try additional methods if an access method hasn't been found yet */
1282 f = fopen(USBDEVBUS_PATH "/devices", "r");
f16a0db3 1283 if (f) {
0f431527
AL
1284 /* devices found in /dev/bus/usb/ */
1285 strcpy(devpath, USBDEVBUS_PATH);
1286 usb_fs_type = USB_FS_DEV;
1287 fclose(f);
5be8e1f2 1288 dprintf(USBDBG_DEVOPENED, USBDEVBUS_PATH);
f16a0db3 1289 goto found_devices;
0f431527
AL
1290 }
1291 dir = opendir(USBSYSBUS_PATH "/devices");
f16a0db3 1292 if (dir) {
0f431527
AL
1293 /* devices found in /dev/bus/usb/ (yes - not a mistake!) */
1294 strcpy(devpath, USBDEVBUS_PATH);
1295 usb_fs_type = USB_FS_SYS;
1296 closedir(dir);
5be8e1f2 1297 dprintf(USBDBG_DEVOPENED, USBSYSBUS_PATH);
f16a0db3 1298 goto found_devices;
22babebb 1299 }
f16a0db3 1300 found_devices:
22babebb 1301 if (!usb_fs_type) {
0f431527 1302 term_printf("husb: unable to access USB devices\n");
f16a0db3 1303 return -ENOENT;
0f431527
AL
1304 }
1305
1306 /* the module setting (used later for opening devices) */
1307 usb_host_device_path = qemu_mallocz(strlen(devpath)+1);
1308 if (usb_host_device_path) {
1309 strcpy(usb_host_device_path, devpath);
1310 term_printf("husb: using %s file-system with %s\n", fs_type[usb_fs_type], usb_host_device_path);
1311 } else {
1312 /* out of memory? */
1313 perror("husb: unable to allocate memory for device path");
f16a0db3 1314 return -ENOMEM;
0f431527
AL
1315 }
1316 }
1317
1318 switch (usb_fs_type) {
1319 case USB_FS_PROC:
1320 case USB_FS_DEV:
1321 ret = usb_host_scan_dev(opaque, func);
1322 break;
1323 case USB_FS_SYS:
1324 ret = usb_host_scan_sys(opaque, func);
1325 break;
f16a0db3
AL
1326 default:
1327 ret = -EINVAL;
1328 break;
0f431527 1329 }
a594cfbf 1330 return ret;
bb36d470
FB
1331}
1332
4b096fc9
AL
1333struct USBAutoFilter {
1334 struct USBAutoFilter *next;
1335 int bus_num;
1336 int addr;
1337 int vendor_id;
1338 int product_id;
1339};
1340
1341static QEMUTimer *usb_auto_timer;
1342static struct USBAutoFilter *usb_auto_filter;
1343
1344static int usb_host_auto_scan(void *opaque, int bus_num, int addr,
1345 int class_id, int vendor_id, int product_id,
1346 const char *product_name, int speed)
1347{
1348 struct USBAutoFilter *f;
1349 struct USBDevice *dev;
1350
1351 /* Ignore hubs */
1352 if (class_id == 9)
1353 return 0;
1354
1355 for (f = usb_auto_filter; f; f = f->next) {
4b096fc9
AL
1356 if (f->bus_num >= 0 && f->bus_num != bus_num)
1357 continue;
1358
1359 if (f->addr >= 0 && f->addr != addr)
1360 continue;
1361
1362 if (f->vendor_id >= 0 && f->vendor_id != vendor_id)
1363 continue;
1364
1365 if (f->product_id >= 0 && f->product_id != product_id)
1366 continue;
1367
1368 /* We got a match */
1369
1370 /* Allredy attached ? */
1371 if (hostdev_find(bus_num, addr))
1372 return 0;
1373
64838171 1374 dprintf("husb: auto open: bus_num %d addr %d\n", bus_num, addr);
4b096fc9
AL
1375
1376 dev = usb_host_device_open_addr(bus_num, addr, product_name);
1377 if (dev)
1378 usb_device_add_dev(dev);
1379 }
1380
1381 return 0;
1382}
1383
1384static void usb_host_auto_timer(void *unused)
1385{
1386 usb_host_scan(NULL, usb_host_auto_scan);
1387 qemu_mod_timer(usb_auto_timer, qemu_get_clock(rt_clock) + 2000);
1388}
1389
1390/*
5d0c5750
AL
1391 * Autoconnect filter
1392 * Format:
1393 * auto:bus:dev[:vid:pid]
1394 * auto:bus.dev[:vid:pid]
1395 *
1396 * bus - bus number (dec, * means any)
1397 * dev - device number (dec, * means any)
1398 * vid - vendor id (hex, * means any)
1399 * pid - product id (hex, * means any)
1400 *
1401 * See 'lsusb' output.
4b096fc9 1402 */
5d0c5750 1403static int parse_filter(const char *spec, struct USBAutoFilter *f)
4b096fc9 1404{
5d0c5750
AL
1405 enum { BUS, DEV, VID, PID, DONE };
1406 const char *p = spec;
1407 int i;
1408
1409 f->bus_num = -1;
1410 f->addr = -1;
1411 f->vendor_id = -1;
1412 f->product_id = -1;
1413
1414 for (i = BUS; i < DONE; i++) {
1415 p = strpbrk(p, ":.");
1416 if (!p) break;
1417 p++;
1418
1419 if (*p == '*')
1420 continue;
1421
1422 switch(i) {
1423 case BUS: f->bus_num = strtol(p, NULL, 10); break;
1424 case DEV: f->addr = strtol(p, NULL, 10); break;
1425 case VID: f->vendor_id = strtol(p, NULL, 16); break;
1426 case PID: f->product_id = strtol(p, NULL, 16); break;
1427 }
1428 }
1429
1430 if (i < DEV) {
1431 fprintf(stderr, "husb: invalid auto filter spec %s\n", spec);
1432 return -1;
1433 }
1434
1435 return 0;
1436}
1437
1438static int match_filter(const struct USBAutoFilter *f1,
1439 const struct USBAutoFilter *f2)
1440{
1441 return f1->bus_num == f2->bus_num &&
1442 f1->addr == f2->addr &&
1443 f1->vendor_id == f2->vendor_id &&
1444 f1->product_id == f2->product_id;
1445}
1446
1447static int usb_host_auto_add(const char *spec)
1448{
1449 struct USBAutoFilter filter, *f;
1450
1451 if (parse_filter(spec, &filter) < 0)
1452 return -1;
1453
1454 f = qemu_mallocz(sizeof(*f));
4b096fc9 1455 if (!f) {
0d380648 1456 fprintf(stderr, "husb: failed to allocate auto filter\n");
5d0c5750 1457 return -1;
4b096fc9
AL
1458 }
1459
5d0c5750 1460 *f = filter;
4b096fc9
AL
1461
1462 if (!usb_auto_filter) {
1463 /*
1464 * First entry. Init and start the monitor.
1465 * Right now we're using timer to check for new devices.
1466 * If this turns out to be too expensive we can move that into a
1467 * separate thread.
1468 */
1469 usb_auto_timer = qemu_new_timer(rt_clock, usb_host_auto_timer, NULL);
1470 if (!usb_auto_timer) {
0d380648 1471 fprintf(stderr, "husb: failed to allocate auto scan timer\n");
4b096fc9 1472 qemu_free(f);
5d0c5750 1473 return -1;
4b096fc9
AL
1474 }
1475
1476 /* Check for new devices every two seconds */
1477 qemu_mod_timer(usb_auto_timer, qemu_get_clock(rt_clock) + 2000);
1478 }
1479
5d0c5750
AL
1480 dprintf("husb: added auto filter: bus_num %d addr %d vid %d pid %d\n",
1481 f->bus_num, f->addr, f->vendor_id, f->product_id);
4b096fc9
AL
1482
1483 f->next = usb_auto_filter;
1484 usb_auto_filter = f;
5d0c5750
AL
1485
1486 return 0;
1487}
1488
1489static int usb_host_auto_del(const char *spec)
1490{
1491 struct USBAutoFilter *pf = usb_auto_filter;
1492 struct USBAutoFilter **prev = &usb_auto_filter;
1493 struct USBAutoFilter filter;
1494
1495 if (parse_filter(spec, &filter) < 0)
1496 return -1;
1497
1498 while (pf) {
1499 if (match_filter(pf, &filter)) {
1500 dprintf("husb: removed auto filter: bus_num %d addr %d vid %d pid %d\n",
1501 pf->bus_num, pf->addr, pf->vendor_id, pf->product_id);
1502
1503 *prev = pf->next;
1504
1505 if (!usb_auto_filter) {
1506 /* No more filters. Stop scanning. */
1507 qemu_del_timer(usb_auto_timer);
1508 qemu_free_timer(usb_auto_timer);
1509 }
1510
1511 return 0;
1512 }
1513
1514 prev = &pf->next;
1515 pf = pf->next;
1516 }
1517
1518 return -1;
4b096fc9
AL
1519}
1520
a594cfbf
FB
1521typedef struct FindDeviceState {
1522 int vendor_id;
1523 int product_id;
1524 int bus_num;
1525 int addr;
1f6e24e7 1526 char product_name[PRODUCT_NAME_SZ];
a594cfbf
FB
1527} FindDeviceState;
1528
5fafdf24 1529static int usb_host_find_device_scan(void *opaque, int bus_num, int addr,
a594cfbf 1530 int class_id,
5fafdf24 1531 int vendor_id, int product_id,
a594cfbf 1532 const char *product_name, int speed)
bb36d470 1533{
a594cfbf 1534 FindDeviceState *s = opaque;
1f6e24e7
FB
1535 if ((vendor_id == s->vendor_id &&
1536 product_id == s->product_id) ||
1537 (bus_num == s->bus_num &&
1538 addr == s->addr)) {
1539 pstrcpy(s->product_name, PRODUCT_NAME_SZ, product_name);
a594cfbf
FB
1540 s->bus_num = bus_num;
1541 s->addr = addr;
1542 return 1;
1543 } else {
1544 return 0;
1545 }
1546}
bb36d470 1547
5fafdf24
TS
1548/* the syntax is :
1549 'bus.addr' (decimal numbers) or
a594cfbf 1550 'vendor_id:product_id' (hexa numbers) */
5fafdf24 1551static int usb_host_find_device(int *pbus_num, int *paddr,
1f6e24e7 1552 char *product_name, int product_name_size,
a594cfbf
FB
1553 const char *devname)
1554{
1555 const char *p;
1556 int ret;
1557 FindDeviceState fs;
1558
1559 p = strchr(devname, '.');
1560 if (p) {
1561 *pbus_num = strtoul(devname, NULL, 0);
1562 *paddr = strtoul(p + 1, NULL, 0);
1f6e24e7
FB
1563 fs.bus_num = *pbus_num;
1564 fs.addr = *paddr;
1565 ret = usb_host_scan(&fs, usb_host_find_device_scan);
1566 if (ret)
1567 pstrcpy(product_name, product_name_size, fs.product_name);
a594cfbf
FB
1568 return 0;
1569 }
5d0c5750 1570
a594cfbf
FB
1571 p = strchr(devname, ':');
1572 if (p) {
1573 fs.vendor_id = strtoul(devname, NULL, 16);
1574 fs.product_id = strtoul(p + 1, NULL, 16);
1575 ret = usb_host_scan(&fs, usb_host_find_device_scan);
1576 if (ret) {
1577 *pbus_num = fs.bus_num;
1578 *paddr = fs.addr;
1f6e24e7 1579 pstrcpy(product_name, product_name_size, fs.product_name);
a594cfbf 1580 return 0;
bb36d470
FB
1581 }
1582 }
a594cfbf 1583 return -1;
bb36d470
FB
1584}
1585
a594cfbf
FB
1586/**********************/
1587/* USB host device info */
1588
1589struct usb_class_info {
1590 int class;
1591 const char *class_name;
1592};
1593
1594static const struct usb_class_info usb_class_info[] = {
1595 { USB_CLASS_AUDIO, "Audio"},
1596 { USB_CLASS_COMM, "Communication"},
1597 { USB_CLASS_HID, "HID"},
1598 { USB_CLASS_HUB, "Hub" },
1599 { USB_CLASS_PHYSICAL, "Physical" },
1600 { USB_CLASS_PRINTER, "Printer" },
1601 { USB_CLASS_MASS_STORAGE, "Storage" },
1602 { USB_CLASS_CDC_DATA, "Data" },
1603 { USB_CLASS_APP_SPEC, "Application Specific" },
1604 { USB_CLASS_VENDOR_SPEC, "Vendor Specific" },
1605 { USB_CLASS_STILL_IMAGE, "Still Image" },
b9dc033c 1606 { USB_CLASS_CSCID, "Smart Card" },
a594cfbf
FB
1607 { USB_CLASS_CONTENT_SEC, "Content Security" },
1608 { -1, NULL }
1609};
1610
1611static const char *usb_class_str(uint8_t class)
bb36d470 1612{
a594cfbf
FB
1613 const struct usb_class_info *p;
1614 for(p = usb_class_info; p->class != -1; p++) {
1615 if (p->class == class)
1616 break;
bb36d470 1617 }
a594cfbf
FB
1618 return p->class_name;
1619}
1620
9596ebb7
PB
1621static void usb_info_device(int bus_num, int addr, int class_id,
1622 int vendor_id, int product_id,
1623 const char *product_name,
1624 int speed)
a594cfbf
FB
1625{
1626 const char *class_str, *speed_str;
1627
1628 switch(speed) {
5fafdf24
TS
1629 case USB_SPEED_LOW:
1630 speed_str = "1.5";
a594cfbf 1631 break;
5fafdf24
TS
1632 case USB_SPEED_FULL:
1633 speed_str = "12";
a594cfbf 1634 break;
5fafdf24
TS
1635 case USB_SPEED_HIGH:
1636 speed_str = "480";
a594cfbf
FB
1637 break;
1638 default:
5fafdf24 1639 speed_str = "?";
a594cfbf
FB
1640 break;
1641 }
1642
5fafdf24 1643 term_printf(" Device %d.%d, speed %s Mb/s\n",
a594cfbf
FB
1644 bus_num, addr, speed_str);
1645 class_str = usb_class_str(class_id);
5fafdf24 1646 if (class_str)
a594cfbf
FB
1647 term_printf(" %s:", class_str);
1648 else
1649 term_printf(" Class %02x:", class_id);
1650 term_printf(" USB device %04x:%04x", vendor_id, product_id);
1651 if (product_name[0] != '\0')
1652 term_printf(", %s", product_name);
1653 term_printf("\n");
1654}
1655
5fafdf24 1656static int usb_host_info_device(void *opaque, int bus_num, int addr,
a594cfbf 1657 int class_id,
5fafdf24 1658 int vendor_id, int product_id,
a594cfbf
FB
1659 const char *product_name,
1660 int speed)
1661{
1662 usb_info_device(bus_num, addr, class_id, vendor_id, product_id,
1663 product_name, speed);
1664 return 0;
1665}
1666
ac4ffb5a 1667static void dec2str(int val, char *str, size_t size)
5d0c5750
AL
1668{
1669 if (val == -1)
ac4ffb5a 1670 snprintf(str, size, "*");
5d0c5750 1671 else
ac4ffb5a 1672 snprintf(str, size, "%d", val);
5d0c5750
AL
1673}
1674
ac4ffb5a 1675static void hex2str(int val, char *str, size_t size)
5d0c5750
AL
1676{
1677 if (val == -1)
ac4ffb5a 1678 snprintf(str, size, "*");
5d0c5750 1679 else
ac4ffb5a 1680 snprintf(str, size, "%x", val);
5d0c5750
AL
1681}
1682
a594cfbf
FB
1683void usb_host_info(void)
1684{
5d0c5750
AL
1685 struct USBAutoFilter *f;
1686
a594cfbf 1687 usb_host_scan(NULL, usb_host_info_device);
5d0c5750
AL
1688
1689 if (usb_auto_filter)
1690 term_printf(" Auto filters:\n");
1691 for (f = usb_auto_filter; f; f = f->next) {
1692 char bus[10], addr[10], vid[10], pid[10];
ac4ffb5a
AL
1693 dec2str(f->bus_num, bus, sizeof(bus));
1694 dec2str(f->addr, addr, sizeof(addr));
1695 hex2str(f->vendor_id, vid, sizeof(vid));
1696 hex2str(f->product_id, pid, sizeof(pid));
5d0c5750
AL
1697 term_printf(" Device %s.%s ID %s:%s\n", bus, addr, vid, pid);
1698 }
bb36d470
FB
1699}
1700
1701#else
1702
446ab128
AL
1703#include "hw/usb.h"
1704
a594cfbf
FB
1705void usb_host_info(void)
1706{
1707 term_printf("USB host devices not supported\n");
1708}
1709
bb36d470 1710/* XXX: modify configure to compile the right host driver */
a594cfbf 1711USBDevice *usb_host_device_open(const char *devname)
bb36d470
FB
1712{
1713 return NULL;
1714}
1715
5d0c5750
AL
1716int usb_host_device_close(const char *devname)
1717{
1718 return 0;
1719}
1720
bb36d470 1721#endif