7 static void usb_bus_dev_print(Monitor
*mon
, DeviceState
*qdev
, int indent
);
9 static char *usb_get_dev_path(DeviceState
*dev
);
10 static char *usb_get_fw_dev_path(DeviceState
*qdev
);
12 static struct BusInfo usb_bus_info
= {
14 .size
= sizeof(USBBus
),
15 .print_dev
= usb_bus_dev_print
,
16 .get_dev_path
= usb_get_dev_path
,
17 .get_fw_dev_path
= usb_get_fw_dev_path
,
18 .props
= (Property
[]) {
19 DEFINE_PROP_STRING("port", USBDevice
, port_path
),
20 DEFINE_PROP_END_OF_LIST()
23 static int next_usb_bus
= 0;
24 static QTAILQ_HEAD(, USBBus
) busses
= QTAILQ_HEAD_INITIALIZER(busses
);
26 const VMStateDescription vmstate_usb_device
= {
29 .minimum_version_id
= 1,
30 .fields
= (VMStateField
[]) {
31 VMSTATE_UINT8(addr
, USBDevice
),
32 VMSTATE_INT32(state
, USBDevice
),
33 VMSTATE_INT32(remote_wakeup
, USBDevice
),
34 VMSTATE_INT32(setup_state
, USBDevice
),
35 VMSTATE_INT32(setup_len
, USBDevice
),
36 VMSTATE_INT32(setup_index
, USBDevice
),
37 VMSTATE_UINT8_ARRAY(setup_buf
, USBDevice
, 8),
38 VMSTATE_END_OF_LIST(),
42 void usb_bus_new(USBBus
*bus
, USBBusOps
*ops
, DeviceState
*host
)
44 qbus_create_inplace(&bus
->qbus
, &usb_bus_info
, host
, NULL
);
46 bus
->busnr
= next_usb_bus
++;
47 bus
->qbus
.allow_hotplug
= 1; /* Yes, we can */
48 QTAILQ_INIT(&bus
->free
);
49 QTAILQ_INIT(&bus
->used
);
50 QTAILQ_INSERT_TAIL(&busses
, bus
, next
);
53 USBBus
*usb_bus_find(int busnr
)
58 return QTAILQ_FIRST(&busses
);
59 QTAILQ_FOREACH(bus
, &busses
, next
) {
60 if (bus
->busnr
== busnr
)
66 static int usb_qdev_init(DeviceState
*qdev
, DeviceInfo
*base
)
68 USBDevice
*dev
= DO_UPCAST(USBDevice
, qdev
, qdev
);
69 USBDeviceInfo
*info
= DO_UPCAST(USBDeviceInfo
, qdev
, base
);
72 pstrcpy(dev
->product_desc
, sizeof(dev
->product_desc
), info
->product_desc
);
75 QLIST_INIT(&dev
->strings
);
76 rc
= dev
->info
->init(dev
);
77 if (rc
== 0 && dev
->auto_attach
)
78 rc
= usb_device_attach(dev
);
82 static int usb_qdev_exit(DeviceState
*qdev
)
84 USBDevice
*dev
= DO_UPCAST(USBDevice
, qdev
, qdev
);
87 usb_device_detach(dev
);
89 if (dev
->info
->handle_destroy
) {
90 dev
->info
->handle_destroy(dev
);
95 void usb_qdev_register(USBDeviceInfo
*info
)
97 info
->qdev
.bus_info
= &usb_bus_info
;
98 info
->qdev
.init
= usb_qdev_init
;
99 info
->qdev
.unplug
= qdev_simple_unplug_cb
;
100 info
->qdev
.exit
= usb_qdev_exit
;
101 qdev_register(&info
->qdev
);
104 void usb_qdev_register_many(USBDeviceInfo
*info
)
106 while (info
->qdev
.name
) {
107 usb_qdev_register(info
);
112 USBDevice
*usb_create(USBBus
*bus
, const char *name
)
117 /* temporary stopgap until all usb is properly qdev-ified */
119 bus
= usb_bus_find(-1);
122 error_report("%s: no bus specified, using \"%s\" for \"%s\"\n",
123 __FUNCTION__
, bus
->qbus
.name
, name
);
127 dev
= qdev_create(&bus
->qbus
, name
);
128 return DO_UPCAST(USBDevice
, qdev
, dev
);
131 USBDevice
*usb_create_simple(USBBus
*bus
, const char *name
)
133 USBDevice
*dev
= usb_create(bus
, name
);
135 hw_error("Failed to create USB device '%s'\n", name
);
137 qdev_init_nofail(&dev
->qdev
);
141 static void usb_fill_port(USBPort
*port
, void *opaque
, int index
,
142 USBPortOps
*ops
, int speedmask
)
144 port
->opaque
= opaque
;
146 port
->opaque
= opaque
;
149 port
->speedmask
= speedmask
;
150 usb_port_location(port
, NULL
, index
+ 1);
153 void usb_register_port(USBBus
*bus
, USBPort
*port
, void *opaque
, int index
,
154 USBPortOps
*ops
, int speedmask
)
156 usb_fill_port(port
, opaque
, index
, ops
, speedmask
);
157 QTAILQ_INSERT_TAIL(&bus
->free
, port
, next
);
161 int usb_register_companion(const char *masterbus
, USBPort
*ports
[],
162 uint32_t portcount
, uint32_t firstport
,
163 void *opaque
, USBPortOps
*ops
, int speedmask
)
168 QTAILQ_FOREACH(bus
, &busses
, next
) {
169 if (strcmp(bus
->qbus
.name
, masterbus
) == 0) {
174 if (!bus
|| !bus
->ops
->register_companion
) {
175 qerror_report(QERR_INVALID_PARAMETER_VALUE
, "masterbus",
178 error_printf_unless_qmp(
179 "USB bus '%s' does not allow companion controllers\n",
185 for (i
= 0; i
< portcount
; i
++) {
186 usb_fill_port(ports
[i
], opaque
, i
, ops
, speedmask
);
189 return bus
->ops
->register_companion(bus
, ports
, portcount
, firstport
);
192 void usb_port_location(USBPort
*downstream
, USBPort
*upstream
, int portnr
)
195 snprintf(downstream
->path
, sizeof(downstream
->path
), "%s.%d",
196 upstream
->path
, portnr
);
198 snprintf(downstream
->path
, sizeof(downstream
->path
), "%d", portnr
);
202 void usb_unregister_port(USBBus
*bus
, USBPort
*port
)
205 qdev_free(&port
->dev
->qdev
);
206 QTAILQ_REMOVE(&bus
->free
, port
, next
);
210 static int do_attach(USBDevice
*dev
)
212 USBBus
*bus
= usb_bus_from_device(dev
);
216 error_report("Error: tried to attach usb device %s twice\n",
220 if (bus
->nfree
== 0) {
221 error_report("Error: tried to attach usb device %s to a bus with no free ports\n",
225 if (dev
->port_path
) {
226 QTAILQ_FOREACH(port
, &bus
->free
, next
) {
227 if (strcmp(port
->path
, dev
->port_path
) == 0) {
232 error_report("Error: usb port %s (bus %s) not found\n",
233 dev
->port_path
, bus
->qbus
.name
);
237 port
= QTAILQ_FIRST(&bus
->free
);
239 if (!(port
->speedmask
& dev
->speedmask
)) {
240 error_report("Warning: speed mismatch trying to attach usb device %s to bus %s\n",
241 dev
->product_desc
, bus
->qbus
.name
);
246 QTAILQ_REMOVE(&bus
->free
, port
, next
);
249 usb_attach(port
, dev
);
251 QTAILQ_INSERT_TAIL(&bus
->used
, port
, next
);
257 int usb_device_attach(USBDevice
*dev
)
259 USBBus
*bus
= usb_bus_from_device(dev
);
261 if (bus
->nfree
== 1 && dev
->port_path
== NULL
) {
262 /* Create a new hub and chain it on
263 (unless a physical port location is specified). */
264 usb_create_simple(bus
, "usb-hub");
266 return do_attach(dev
);
269 int usb_device_detach(USBDevice
*dev
)
271 USBBus
*bus
= usb_bus_from_device(dev
);
274 if (!dev
->attached
) {
275 error_report("Error: tried to detach unattached usb device %s\n",
281 QTAILQ_FOREACH(port
, &bus
->used
, next
) {
282 if (port
->dev
== dev
)
285 assert(port
!= NULL
);
287 QTAILQ_REMOVE(&bus
->used
, port
, next
);
290 usb_attach(port
, NULL
);
292 QTAILQ_INSERT_TAIL(&bus
->free
, port
, next
);
297 int usb_device_delete_addr(int busnr
, int addr
)
303 bus
= usb_bus_find(busnr
);
307 QTAILQ_FOREACH(port
, &bus
->used
, next
) {
308 if (port
->dev
->addr
== addr
)
315 qdev_free(&dev
->qdev
);
319 static const char *usb_speed(unsigned int speed
)
321 static const char *txt
[] = {
322 [ USB_SPEED_LOW
] = "1.5",
323 [ USB_SPEED_FULL
] = "12",
324 [ USB_SPEED_HIGH
] = "480",
325 [ USB_SPEED_SUPER
] = "5000",
327 if (speed
>= ARRAY_SIZE(txt
))
332 static void usb_bus_dev_print(Monitor
*mon
, DeviceState
*qdev
, int indent
)
334 USBDevice
*dev
= DO_UPCAST(USBDevice
, qdev
, qdev
);
335 USBBus
*bus
= usb_bus_from_device(dev
);
337 monitor_printf(mon
, "%*saddr %d.%d, port %s, speed %s, name %s%s\n",
338 indent
, "", bus
->busnr
, dev
->addr
,
339 dev
->port
? dev
->port
->path
: "-",
340 usb_speed(dev
->speed
), dev
->product_desc
,
341 dev
->attached
? ", attached" : "");
344 static char *usb_get_dev_path(DeviceState
*qdev
)
346 USBDevice
*dev
= DO_UPCAST(USBDevice
, qdev
, qdev
);
347 return qemu_strdup(dev
->port
->path
);
350 static char *usb_get_fw_dev_path(DeviceState
*qdev
)
352 USBDevice
*dev
= DO_UPCAST(USBDevice
, qdev
, qdev
);
354 ssize_t pos
= 0, fw_len
;
357 fw_len
= 32 + strlen(dev
->port
->path
) * 6;
358 fw_path
= qemu_malloc(fw_len
);
359 in
= dev
->port
->path
;
360 while (fw_len
- pos
> 0) {
361 nr
= strtol(in
, &in
, 10);
363 /* some hub between root port and device */
364 pos
+= snprintf(fw_path
+ pos
, fw_len
- pos
, "hub@%ld/", nr
);
367 /* the device itself */
368 pos
+= snprintf(fw_path
+ pos
, fw_len
- pos
, "%s@%ld",
369 qdev_fw_name(qdev
), nr
);
376 void usb_info(Monitor
*mon
)
382 if (QTAILQ_EMPTY(&busses
)) {
383 monitor_printf(mon
, "USB support not enabled\n");
387 QTAILQ_FOREACH(bus
, &busses
, next
) {
388 QTAILQ_FOREACH(port
, &bus
->used
, next
) {
392 monitor_printf(mon
, " Device %d.%d, Port %s, Speed %s Mb/s, Product %s\n",
393 bus
->busnr
, dev
->addr
, port
->path
, usb_speed(dev
->speed
),
399 /* handle legacy -usbdevice cmd line option */
400 USBDevice
*usbdevice_create(const char *cmdline
)
402 USBBus
*bus
= usb_bus_find(-1 /* any */);
409 params
= strchr(cmdline
,':');
412 len
= params
- cmdline
;
413 if (len
> sizeof(driver
))
414 len
= sizeof(driver
);
415 pstrcpy(driver
, len
, cmdline
);
418 pstrcpy(driver
, sizeof(driver
), cmdline
);
421 for (info
= device_info_list
; info
!= NULL
; info
= info
->next
) {
422 if (info
->bus_info
!= &usb_bus_info
)
424 usb
= DO_UPCAST(USBDeviceInfo
, qdev
, info
);
425 if (usb
->usbdevice_name
== NULL
)
427 if (strcmp(usb
->usbdevice_name
, driver
) != 0)
433 /* no error because some drivers are not converted (yet) */
434 error_report("usbdevice %s not found", driver
);
439 if (!usb
->usbdevice_init
) {
441 error_report("usbdevice %s accepts no params", driver
);
444 return usb_create_simple(bus
, usb
->qdev
.name
);
446 return usb
->usbdevice_init(params
);