root / hw / usb-bus.c @ 0d877c66
History | View | Annotate | Download (11.5 kB)
1 | 806b6024 | Gerd Hoffmann | #include "hw.h" |
---|---|---|---|
2 | 806b6024 | Gerd Hoffmann | #include "usb.h" |
3 | 806b6024 | Gerd Hoffmann | #include "qdev.h" |
4 | a5d2f727 | Gerd Hoffmann | #include "sysemu.h" |
5 | a5d2f727 | Gerd Hoffmann | #include "monitor.h" |
6 | a5d2f727 | Gerd Hoffmann | |
7 | a5d2f727 | Gerd Hoffmann | static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent); |
8 | c7a2196a | Gerd Hoffmann | |
9 | c7a2196a | Gerd Hoffmann | static char *usb_get_dev_path(DeviceState *dev); |
10 | 70d31cb2 | Gerd Hoffmann | static char *usb_get_fw_dev_path(DeviceState *qdev); |
11 | 806b6024 | Gerd Hoffmann | |
12 | 806b6024 | Gerd Hoffmann | static struct BusInfo usb_bus_info = { |
13 | a5d2f727 | Gerd Hoffmann | .name = "USB",
|
14 | a5d2f727 | Gerd Hoffmann | .size = sizeof(USBBus),
|
15 | a5d2f727 | Gerd Hoffmann | .print_dev = usb_bus_dev_print, |
16 | c7a2196a | Gerd Hoffmann | .get_dev_path = usb_get_dev_path, |
17 | 70d31cb2 | Gerd Hoffmann | .get_fw_dev_path = usb_get_fw_dev_path, |
18 | 5f69076b | Gerd Hoffmann | .props = (Property[]) { |
19 | 5f69076b | Gerd Hoffmann | DEFINE_PROP_STRING("port", USBDevice, port_path),
|
20 | 5f69076b | Gerd Hoffmann | DEFINE_PROP_END_OF_LIST() |
21 | 5f69076b | Gerd Hoffmann | }, |
22 | 806b6024 | Gerd Hoffmann | }; |
23 | 806b6024 | Gerd Hoffmann | static int next_usb_bus = 0; |
24 | 72cf2d4f | Blue Swirl | static QTAILQ_HEAD(, USBBus) busses = QTAILQ_HEAD_INITIALIZER(busses);
|
25 | 806b6024 | Gerd Hoffmann | |
26 | c1ecb40a | Gerd Hoffmann | const VMStateDescription vmstate_usb_device = {
|
27 | c1ecb40a | Gerd Hoffmann | .name = "USBDevice",
|
28 | c1ecb40a | Gerd Hoffmann | .version_id = 1,
|
29 | c1ecb40a | Gerd Hoffmann | .minimum_version_id = 1,
|
30 | c1ecb40a | Gerd Hoffmann | .fields = (VMStateField []) { |
31 | c1ecb40a | Gerd Hoffmann | VMSTATE_UINT8(addr, USBDevice), |
32 | c1ecb40a | Gerd Hoffmann | VMSTATE_INT32(state, USBDevice), |
33 | c1ecb40a | Gerd Hoffmann | VMSTATE_INT32(remote_wakeup, USBDevice), |
34 | c1ecb40a | Gerd Hoffmann | VMSTATE_INT32(setup_state, USBDevice), |
35 | c1ecb40a | Gerd Hoffmann | VMSTATE_INT32(setup_len, USBDevice), |
36 | c1ecb40a | Gerd Hoffmann | VMSTATE_INT32(setup_index, USBDevice), |
37 | c1ecb40a | Gerd Hoffmann | VMSTATE_UINT8_ARRAY(setup_buf, USBDevice, 8),
|
38 | c1ecb40a | Gerd Hoffmann | VMSTATE_END_OF_LIST(), |
39 | c1ecb40a | Gerd Hoffmann | } |
40 | c1ecb40a | Gerd Hoffmann | }; |
41 | c1ecb40a | Gerd Hoffmann | |
42 | 07771f6f | Gerd Hoffmann | void usb_bus_new(USBBus *bus, USBBusOps *ops, DeviceState *host)
|
43 | 806b6024 | Gerd Hoffmann | { |
44 | b2317837 | Gerd Hoffmann | qbus_create_inplace(&bus->qbus, &usb_bus_info, host, NULL);
|
45 | 07771f6f | Gerd Hoffmann | bus->ops = ops; |
46 | 806b6024 | Gerd Hoffmann | bus->busnr = next_usb_bus++; |
47 | ef816d83 | Gerd Hoffmann | bus->qbus.allow_hotplug = 1; /* Yes, we can */ |
48 | 72cf2d4f | Blue Swirl | QTAILQ_INIT(&bus->free); |
49 | 72cf2d4f | Blue Swirl | QTAILQ_INIT(&bus->used); |
50 | 72cf2d4f | Blue Swirl | QTAILQ_INSERT_TAIL(&busses, bus, next); |
51 | 806b6024 | Gerd Hoffmann | } |
52 | 806b6024 | Gerd Hoffmann | |
53 | 806b6024 | Gerd Hoffmann | USBBus *usb_bus_find(int busnr)
|
54 | 806b6024 | Gerd Hoffmann | { |
55 | 806b6024 | Gerd Hoffmann | USBBus *bus; |
56 | 806b6024 | Gerd Hoffmann | |
57 | 806b6024 | Gerd Hoffmann | if (-1 == busnr) |
58 | 72cf2d4f | Blue Swirl | return QTAILQ_FIRST(&busses);
|
59 | 72cf2d4f | Blue Swirl | QTAILQ_FOREACH(bus, &busses, next) { |
60 | 806b6024 | Gerd Hoffmann | if (bus->busnr == busnr)
|
61 | 806b6024 | Gerd Hoffmann | return bus;
|
62 | 806b6024 | Gerd Hoffmann | } |
63 | 806b6024 | Gerd Hoffmann | return NULL; |
64 | 806b6024 | Gerd Hoffmann | } |
65 | 806b6024 | Gerd Hoffmann | |
66 | 806b6024 | Gerd Hoffmann | static int usb_qdev_init(DeviceState *qdev, DeviceInfo *base) |
67 | 806b6024 | Gerd Hoffmann | { |
68 | 806b6024 | Gerd Hoffmann | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); |
69 | 806b6024 | Gerd Hoffmann | USBDeviceInfo *info = DO_UPCAST(USBDeviceInfo, qdev, base); |
70 | 806b6024 | Gerd Hoffmann | int rc;
|
71 | 806b6024 | Gerd Hoffmann | |
72 | 06384698 | Markus Armbruster | pstrcpy(dev->product_desc, sizeof(dev->product_desc), info->product_desc);
|
73 | 806b6024 | Gerd Hoffmann | dev->info = info; |
74 | 61e094c0 | Gerd Hoffmann | dev->auto_attach = 1;
|
75 | 132a3f55 | Gerd Hoffmann | QLIST_INIT(&dev->strings); |
76 | 806b6024 | Gerd Hoffmann | rc = dev->info->init(dev); |
77 | 61e094c0 | Gerd Hoffmann | if (rc == 0 && dev->auto_attach) |
78 | fa19bf83 | Hans de Goede | rc = usb_device_attach(dev); |
79 | 806b6024 | Gerd Hoffmann | return rc;
|
80 | 806b6024 | Gerd Hoffmann | } |
81 | 806b6024 | Gerd Hoffmann | |
82 | a8e662b5 | Gerd Hoffmann | static int usb_qdev_exit(DeviceState *qdev) |
83 | a8e662b5 | Gerd Hoffmann | { |
84 | a8e662b5 | Gerd Hoffmann | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); |
85 | a8e662b5 | Gerd Hoffmann | |
86 | 290a5c60 | Hans de Goede | if (dev->attached) {
|
87 | 290a5c60 | Hans de Goede | usb_device_detach(dev); |
88 | 290a5c60 | Hans de Goede | } |
89 | a8e662b5 | Gerd Hoffmann | if (dev->info->handle_destroy) {
|
90 | a8e662b5 | Gerd Hoffmann | dev->info->handle_destroy(dev); |
91 | a8e662b5 | Gerd Hoffmann | } |
92 | a8e662b5 | Gerd Hoffmann | return 0; |
93 | a8e662b5 | Gerd Hoffmann | } |
94 | a8e662b5 | Gerd Hoffmann | |
95 | 806b6024 | Gerd Hoffmann | void usb_qdev_register(USBDeviceInfo *info)
|
96 | 806b6024 | Gerd Hoffmann | { |
97 | 806b6024 | Gerd Hoffmann | info->qdev.bus_info = &usb_bus_info; |
98 | 806b6024 | Gerd Hoffmann | info->qdev.init = usb_qdev_init; |
99 | ef816d83 | Gerd Hoffmann | info->qdev.unplug = qdev_simple_unplug_cb; |
100 | a8e662b5 | Gerd Hoffmann | info->qdev.exit = usb_qdev_exit; |
101 | 806b6024 | Gerd Hoffmann | qdev_register(&info->qdev); |
102 | 806b6024 | Gerd Hoffmann | } |
103 | 806b6024 | Gerd Hoffmann | |
104 | 806b6024 | Gerd Hoffmann | void usb_qdev_register_many(USBDeviceInfo *info)
|
105 | 806b6024 | Gerd Hoffmann | { |
106 | 806b6024 | Gerd Hoffmann | while (info->qdev.name) {
|
107 | 806b6024 | Gerd Hoffmann | usb_qdev_register(info); |
108 | 806b6024 | Gerd Hoffmann | info++; |
109 | 806b6024 | Gerd Hoffmann | } |
110 | 806b6024 | Gerd Hoffmann | } |
111 | 806b6024 | Gerd Hoffmann | |
112 | a5d2f727 | Gerd Hoffmann | USBDevice *usb_create(USBBus *bus, const char *name) |
113 | 806b6024 | Gerd Hoffmann | { |
114 | 806b6024 | Gerd Hoffmann | DeviceState *dev; |
115 | 806b6024 | Gerd Hoffmann | |
116 | 806b6024 | Gerd Hoffmann | #if 1 |
117 | 806b6024 | Gerd Hoffmann | /* temporary stopgap until all usb is properly qdev-ified */
|
118 | 806b6024 | Gerd Hoffmann | if (!bus) {
|
119 | 806b6024 | Gerd Hoffmann | bus = usb_bus_find(-1);
|
120 | 806b6024 | Gerd Hoffmann | if (!bus)
|
121 | 806b6024 | Gerd Hoffmann | return NULL; |
122 | fa19bf83 | Hans de Goede | error_report("%s: no bus specified, using \"%s\" for \"%s\"\n",
|
123 | 806b6024 | Gerd Hoffmann | __FUNCTION__, bus->qbus.name, name); |
124 | 806b6024 | Gerd Hoffmann | } |
125 | 806b6024 | Gerd Hoffmann | #endif
|
126 | 806b6024 | Gerd Hoffmann | |
127 | 806b6024 | Gerd Hoffmann | dev = qdev_create(&bus->qbus, name); |
128 | 806b6024 | Gerd Hoffmann | return DO_UPCAST(USBDevice, qdev, dev);
|
129 | 806b6024 | Gerd Hoffmann | } |
130 | a5d2f727 | Gerd Hoffmann | |
131 | a5d2f727 | Gerd Hoffmann | USBDevice *usb_create_simple(USBBus *bus, const char *name) |
132 | a5d2f727 | Gerd Hoffmann | { |
133 | a5d2f727 | Gerd Hoffmann | USBDevice *dev = usb_create(bus, name); |
134 | d44168ff | Paul Brook | if (!dev) {
|
135 | d44168ff | Paul Brook | hw_error("Failed to create USB device '%s'\n", name);
|
136 | d44168ff | Paul Brook | } |
137 | e23a1b33 | Markus Armbruster | qdev_init_nofail(&dev->qdev); |
138 | a5d2f727 | Gerd Hoffmann | return dev;
|
139 | a5d2f727 | Gerd Hoffmann | } |
140 | a5d2f727 | Gerd Hoffmann | |
141 | 090ac642 | Hans de Goede | static void usb_fill_port(USBPort *port, void *opaque, int index, |
142 | 090ac642 | Hans de Goede | USBPortOps *ops, int speedmask)
|
143 | a5d2f727 | Gerd Hoffmann | { |
144 | a5d2f727 | Gerd Hoffmann | port->opaque = opaque; |
145 | a5d2f727 | Gerd Hoffmann | port->index = index; |
146 | 0d86d2be | Gerd Hoffmann | port->ops = ops; |
147 | 843d4e0c | Gerd Hoffmann | port->speedmask = speedmask; |
148 | 3631e6c8 | Hans de Goede | usb_port_location(port, NULL, index + 1); |
149 | 090ac642 | Hans de Goede | } |
150 | 090ac642 | Hans de Goede | |
151 | 090ac642 | Hans de Goede | void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index, |
152 | 090ac642 | Hans de Goede | USBPortOps *ops, int speedmask)
|
153 | 090ac642 | Hans de Goede | { |
154 | 090ac642 | Hans de Goede | usb_fill_port(port, opaque, index, ops, speedmask); |
155 | 72cf2d4f | Blue Swirl | QTAILQ_INSERT_TAIL(&bus->free, port, next); |
156 | a5d2f727 | Gerd Hoffmann | bus->nfree++; |
157 | a5d2f727 | Gerd Hoffmann | } |
158 | a5d2f727 | Gerd Hoffmann | |
159 | ae60fea9 | Hans de Goede | int usb_register_companion(const char *masterbus, USBPort *ports[], |
160 | ae60fea9 | Hans de Goede | uint32_t portcount, uint32_t firstport, |
161 | ae60fea9 | Hans de Goede | void *opaque, USBPortOps *ops, int speedmask) |
162 | ae60fea9 | Hans de Goede | { |
163 | ae60fea9 | Hans de Goede | USBBus *bus; |
164 | ae60fea9 | Hans de Goede | int i;
|
165 | ae60fea9 | Hans de Goede | |
166 | ae60fea9 | Hans de Goede | QTAILQ_FOREACH(bus, &busses, next) { |
167 | ae60fea9 | Hans de Goede | if (strcmp(bus->qbus.name, masterbus) == 0) { |
168 | ae60fea9 | Hans de Goede | break;
|
169 | ae60fea9 | Hans de Goede | } |
170 | ae60fea9 | Hans de Goede | } |
171 | ae60fea9 | Hans de Goede | |
172 | ae60fea9 | Hans de Goede | if (!bus || !bus->ops->register_companion) {
|
173 | ae60fea9 | Hans de Goede | qerror_report(QERR_INVALID_PARAMETER_VALUE, "masterbus",
|
174 | ae60fea9 | Hans de Goede | "an USB masterbus");
|
175 | ae60fea9 | Hans de Goede | if (bus) {
|
176 | ae60fea9 | Hans de Goede | error_printf_unless_qmp( |
177 | ae60fea9 | Hans de Goede | "USB bus '%s' does not allow companion controllers\n",
|
178 | ae60fea9 | Hans de Goede | masterbus); |
179 | ae60fea9 | Hans de Goede | } |
180 | ae60fea9 | Hans de Goede | return -1; |
181 | ae60fea9 | Hans de Goede | } |
182 | ae60fea9 | Hans de Goede | |
183 | ae60fea9 | Hans de Goede | for (i = 0; i < portcount; i++) { |
184 | ae60fea9 | Hans de Goede | usb_fill_port(ports[i], opaque, i, ops, speedmask); |
185 | ae60fea9 | Hans de Goede | } |
186 | ae60fea9 | Hans de Goede | |
187 | ae60fea9 | Hans de Goede | return bus->ops->register_companion(bus, ports, portcount, firstport);
|
188 | ae60fea9 | Hans de Goede | } |
189 | ae60fea9 | Hans de Goede | |
190 | c7a2196a | Gerd Hoffmann | void usb_port_location(USBPort *downstream, USBPort *upstream, int portnr) |
191 | c7a2196a | Gerd Hoffmann | { |
192 | c7a2196a | Gerd Hoffmann | if (upstream) {
|
193 | c7a2196a | Gerd Hoffmann | snprintf(downstream->path, sizeof(downstream->path), "%s.%d", |
194 | c7a2196a | Gerd Hoffmann | upstream->path, portnr); |
195 | c7a2196a | Gerd Hoffmann | } else {
|
196 | c7a2196a | Gerd Hoffmann | snprintf(downstream->path, sizeof(downstream->path), "%d", portnr); |
197 | c7a2196a | Gerd Hoffmann | } |
198 | c7a2196a | Gerd Hoffmann | } |
199 | c7a2196a | Gerd Hoffmann | |
200 | a8e662b5 | Gerd Hoffmann | void usb_unregister_port(USBBus *bus, USBPort *port)
|
201 | a8e662b5 | Gerd Hoffmann | { |
202 | a8e662b5 | Gerd Hoffmann | if (port->dev)
|
203 | a8e662b5 | Gerd Hoffmann | qdev_free(&port->dev->qdev); |
204 | a8e662b5 | Gerd Hoffmann | QTAILQ_REMOVE(&bus->free, port, next); |
205 | a8e662b5 | Gerd Hoffmann | bus->nfree--; |
206 | a8e662b5 | Gerd Hoffmann | } |
207 | a8e662b5 | Gerd Hoffmann | |
208 | fa19bf83 | Hans de Goede | static int do_attach(USBDevice *dev) |
209 | a5d2f727 | Gerd Hoffmann | { |
210 | a5d2f727 | Gerd Hoffmann | USBBus *bus = usb_bus_from_device(dev); |
211 | a5d2f727 | Gerd Hoffmann | USBPort *port; |
212 | a5d2f727 | Gerd Hoffmann | |
213 | a5d2f727 | Gerd Hoffmann | if (dev->attached) {
|
214 | fa19bf83 | Hans de Goede | error_report("Error: tried to attach usb device %s twice\n",
|
215 | 0fe6d12e | Markus Armbruster | dev->product_desc); |
216 | fa19bf83 | Hans de Goede | return -1; |
217 | a5d2f727 | Gerd Hoffmann | } |
218 | ee210d63 | Hans de Goede | if (bus->nfree == 0) { |
219 | fa19bf83 | Hans de Goede | error_report("Error: tried to attach usb device %s to a bus with no free ports\n",
|
220 | ee210d63 | Hans de Goede | dev->product_desc); |
221 | fa19bf83 | Hans de Goede | return -1; |
222 | ee210d63 | Hans de Goede | } |
223 | 5f69076b | Gerd Hoffmann | if (dev->port_path) {
|
224 | 5f69076b | Gerd Hoffmann | QTAILQ_FOREACH(port, &bus->free, next) { |
225 | 5f69076b | Gerd Hoffmann | if (strcmp(port->path, dev->port_path) == 0) { |
226 | 5f69076b | Gerd Hoffmann | break;
|
227 | 5f69076b | Gerd Hoffmann | } |
228 | 5f69076b | Gerd Hoffmann | } |
229 | 5f69076b | Gerd Hoffmann | if (port == NULL) { |
230 | fa19bf83 | Hans de Goede | error_report("Error: usb port %s (bus %s) not found\n",
|
231 | 5f69076b | Gerd Hoffmann | dev->port_path, bus->qbus.name); |
232 | fa19bf83 | Hans de Goede | return -1; |
233 | 5f69076b | Gerd Hoffmann | } |
234 | 5f69076b | Gerd Hoffmann | } else {
|
235 | 5f69076b | Gerd Hoffmann | port = QTAILQ_FIRST(&bus->free); |
236 | 5f69076b | Gerd Hoffmann | } |
237 | bf5547f5 | Hans de Goede | if (!(port->speedmask & dev->speedmask)) {
|
238 | bf5547f5 | Hans de Goede | error_report("Warning: speed mismatch trying to attach usb device %s to bus %s\n",
|
239 | bf5547f5 | Hans de Goede | dev->product_desc, bus->qbus.name); |
240 | bf5547f5 | Hans de Goede | return -1; |
241 | bf5547f5 | Hans de Goede | } |
242 | a5d2f727 | Gerd Hoffmann | |
243 | 5f69076b | Gerd Hoffmann | dev->attached++; |
244 | 72cf2d4f | Blue Swirl | QTAILQ_REMOVE(&bus->free, port, next); |
245 | a5d2f727 | Gerd Hoffmann | bus->nfree--; |
246 | a5d2f727 | Gerd Hoffmann | |
247 | a5d2f727 | Gerd Hoffmann | usb_attach(port, dev); |
248 | a5d2f727 | Gerd Hoffmann | |
249 | 72cf2d4f | Blue Swirl | QTAILQ_INSERT_TAIL(&bus->used, port, next); |
250 | a5d2f727 | Gerd Hoffmann | bus->nused++; |
251 | fa19bf83 | Hans de Goede | |
252 | fa19bf83 | Hans de Goede | return 0; |
253 | a5d2f727 | Gerd Hoffmann | } |
254 | a5d2f727 | Gerd Hoffmann | |
255 | a5d2f727 | Gerd Hoffmann | int usb_device_attach(USBDevice *dev)
|
256 | a5d2f727 | Gerd Hoffmann | { |
257 | a5d2f727 | Gerd Hoffmann | USBBus *bus = usb_bus_from_device(dev); |
258 | a5d2f727 | Gerd Hoffmann | |
259 | 5f69076b | Gerd Hoffmann | if (bus->nfree == 1 && dev->port_path == NULL) { |
260 | 5f69076b | Gerd Hoffmann | /* Create a new hub and chain it on
|
261 | 5f69076b | Gerd Hoffmann | (unless a physical port location is specified). */
|
262 | d4c4e6fd | Blue Swirl | usb_create_simple(bus, "usb-hub");
|
263 | a5d2f727 | Gerd Hoffmann | } |
264 | fa19bf83 | Hans de Goede | return do_attach(dev);
|
265 | a5d2f727 | Gerd Hoffmann | } |
266 | a5d2f727 | Gerd Hoffmann | |
267 | a8e662b5 | Gerd Hoffmann | int usb_device_detach(USBDevice *dev)
|
268 | a8e662b5 | Gerd Hoffmann | { |
269 | a8e662b5 | Gerd Hoffmann | USBBus *bus = usb_bus_from_device(dev); |
270 | a8e662b5 | Gerd Hoffmann | USBPort *port; |
271 | a8e662b5 | Gerd Hoffmann | |
272 | a8e662b5 | Gerd Hoffmann | if (!dev->attached) {
|
273 | fa19bf83 | Hans de Goede | error_report("Error: tried to detach unattached usb device %s\n",
|
274 | 0fe6d12e | Markus Armbruster | dev->product_desc); |
275 | a8e662b5 | Gerd Hoffmann | return -1; |
276 | a8e662b5 | Gerd Hoffmann | } |
277 | a8e662b5 | Gerd Hoffmann | dev->attached--; |
278 | a8e662b5 | Gerd Hoffmann | |
279 | a8e662b5 | Gerd Hoffmann | QTAILQ_FOREACH(port, &bus->used, next) { |
280 | a8e662b5 | Gerd Hoffmann | if (port->dev == dev)
|
281 | a8e662b5 | Gerd Hoffmann | break;
|
282 | a8e662b5 | Gerd Hoffmann | } |
283 | a8e662b5 | Gerd Hoffmann | assert(port != NULL);
|
284 | a8e662b5 | Gerd Hoffmann | |
285 | a8e662b5 | Gerd Hoffmann | QTAILQ_REMOVE(&bus->used, port, next); |
286 | a8e662b5 | Gerd Hoffmann | bus->nused--; |
287 | a8e662b5 | Gerd Hoffmann | |
288 | a8e662b5 | Gerd Hoffmann | usb_attach(port, NULL);
|
289 | a8e662b5 | Gerd Hoffmann | |
290 | a8e662b5 | Gerd Hoffmann | QTAILQ_INSERT_TAIL(&bus->free, port, next); |
291 | a8e662b5 | Gerd Hoffmann | bus->nfree++; |
292 | a8e662b5 | Gerd Hoffmann | return 0; |
293 | a8e662b5 | Gerd Hoffmann | } |
294 | a8e662b5 | Gerd Hoffmann | |
295 | a5d2f727 | Gerd Hoffmann | int usb_device_delete_addr(int busnr, int addr) |
296 | a5d2f727 | Gerd Hoffmann | { |
297 | a5d2f727 | Gerd Hoffmann | USBBus *bus; |
298 | a5d2f727 | Gerd Hoffmann | USBPort *port; |
299 | a5d2f727 | Gerd Hoffmann | USBDevice *dev; |
300 | a5d2f727 | Gerd Hoffmann | |
301 | a5d2f727 | Gerd Hoffmann | bus = usb_bus_find(busnr); |
302 | a5d2f727 | Gerd Hoffmann | if (!bus)
|
303 | a5d2f727 | Gerd Hoffmann | return -1; |
304 | a5d2f727 | Gerd Hoffmann | |
305 | 72cf2d4f | Blue Swirl | QTAILQ_FOREACH(port, &bus->used, next) { |
306 | a5d2f727 | Gerd Hoffmann | if (port->dev->addr == addr)
|
307 | a5d2f727 | Gerd Hoffmann | break;
|
308 | a5d2f727 | Gerd Hoffmann | } |
309 | a5d2f727 | Gerd Hoffmann | if (!port)
|
310 | a5d2f727 | Gerd Hoffmann | return -1; |
311 | a5d2f727 | Gerd Hoffmann | dev = port->dev; |
312 | a5d2f727 | Gerd Hoffmann | |
313 | a8e662b5 | Gerd Hoffmann | qdev_free(&dev->qdev); |
314 | a5d2f727 | Gerd Hoffmann | return 0; |
315 | a5d2f727 | Gerd Hoffmann | } |
316 | a5d2f727 | Gerd Hoffmann | |
317 | a5d2f727 | Gerd Hoffmann | static const char *usb_speed(unsigned int speed) |
318 | a5d2f727 | Gerd Hoffmann | { |
319 | a5d2f727 | Gerd Hoffmann | static const char *txt[] = { |
320 | a5d2f727 | Gerd Hoffmann | [ USB_SPEED_LOW ] = "1.5",
|
321 | a5d2f727 | Gerd Hoffmann | [ USB_SPEED_FULL ] = "12",
|
322 | a5d2f727 | Gerd Hoffmann | [ USB_SPEED_HIGH ] = "480",
|
323 | 290d26d2 | Hans de Goede | [ USB_SPEED_SUPER ] = "5000",
|
324 | a5d2f727 | Gerd Hoffmann | }; |
325 | a5d2f727 | Gerd Hoffmann | if (speed >= ARRAY_SIZE(txt))
|
326 | a5d2f727 | Gerd Hoffmann | return "?"; |
327 | a5d2f727 | Gerd Hoffmann | return txt[speed];
|
328 | a5d2f727 | Gerd Hoffmann | } |
329 | a5d2f727 | Gerd Hoffmann | |
330 | a5d2f727 | Gerd Hoffmann | static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent) |
331 | a5d2f727 | Gerd Hoffmann | { |
332 | a5d2f727 | Gerd Hoffmann | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); |
333 | a5d2f727 | Gerd Hoffmann | USBBus *bus = usb_bus_from_device(dev); |
334 | a5d2f727 | Gerd Hoffmann | |
335 | c7a2196a | Gerd Hoffmann | monitor_printf(mon, "%*saddr %d.%d, port %s, speed %s, name %s%s\n",
|
336 | 66a6593a | Gerd Hoffmann | indent, "", bus->busnr, dev->addr,
|
337 | c7a2196a | Gerd Hoffmann | dev->port ? dev->port->path : "-",
|
338 | 0fe6d12e | Markus Armbruster | usb_speed(dev->speed), dev->product_desc, |
339 | 66a6593a | Gerd Hoffmann | dev->attached ? ", attached" : ""); |
340 | a5d2f727 | Gerd Hoffmann | } |
341 | a5d2f727 | Gerd Hoffmann | |
342 | c7a2196a | Gerd Hoffmann | static char *usb_get_dev_path(DeviceState *qdev) |
343 | c7a2196a | Gerd Hoffmann | { |
344 | c7a2196a | Gerd Hoffmann | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); |
345 | 7267c094 | Anthony Liguori | return g_strdup(dev->port->path);
|
346 | c7a2196a | Gerd Hoffmann | } |
347 | c7a2196a | Gerd Hoffmann | |
348 | 70d31cb2 | Gerd Hoffmann | static char *usb_get_fw_dev_path(DeviceState *qdev) |
349 | 70d31cb2 | Gerd Hoffmann | { |
350 | 70d31cb2 | Gerd Hoffmann | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); |
351 | 70d31cb2 | Gerd Hoffmann | char *fw_path, *in;
|
352 | ea87e95f | Blue Swirl | ssize_t pos = 0, fw_len;
|
353 | 70d31cb2 | Gerd Hoffmann | long nr;
|
354 | 70d31cb2 | Gerd Hoffmann | |
355 | ea87e95f | Blue Swirl | fw_len = 32 + strlen(dev->port->path) * 6; |
356 | 7267c094 | Anthony Liguori | fw_path = g_malloc(fw_len); |
357 | 70d31cb2 | Gerd Hoffmann | in = dev->port->path; |
358 | ea87e95f | Blue Swirl | while (fw_len - pos > 0) { |
359 | 70d31cb2 | Gerd Hoffmann | nr = strtol(in, &in, 10);
|
360 | 70d31cb2 | Gerd Hoffmann | if (in[0] == '.') { |
361 | 70d31cb2 | Gerd Hoffmann | /* some hub between root port and device */
|
362 | ea87e95f | Blue Swirl | pos += snprintf(fw_path + pos, fw_len - pos, "hub@%ld/", nr);
|
363 | 70d31cb2 | Gerd Hoffmann | in++; |
364 | 70d31cb2 | Gerd Hoffmann | } else {
|
365 | 70d31cb2 | Gerd Hoffmann | /* the device itself */
|
366 | ea87e95f | Blue Swirl | pos += snprintf(fw_path + pos, fw_len - pos, "%s@%ld",
|
367 | ea87e95f | Blue Swirl | qdev_fw_name(qdev), nr); |
368 | 70d31cb2 | Gerd Hoffmann | break;
|
369 | 70d31cb2 | Gerd Hoffmann | } |
370 | 70d31cb2 | Gerd Hoffmann | } |
371 | 70d31cb2 | Gerd Hoffmann | return fw_path;
|
372 | 70d31cb2 | Gerd Hoffmann | } |
373 | 70d31cb2 | Gerd Hoffmann | |
374 | a5d2f727 | Gerd Hoffmann | void usb_info(Monitor *mon)
|
375 | a5d2f727 | Gerd Hoffmann | { |
376 | a5d2f727 | Gerd Hoffmann | USBBus *bus; |
377 | a5d2f727 | Gerd Hoffmann | USBDevice *dev; |
378 | a5d2f727 | Gerd Hoffmann | USBPort *port; |
379 | a5d2f727 | Gerd Hoffmann | |
380 | 72cf2d4f | Blue Swirl | if (QTAILQ_EMPTY(&busses)) {
|
381 | a5d2f727 | Gerd Hoffmann | monitor_printf(mon, "USB support not enabled\n");
|
382 | a5d2f727 | Gerd Hoffmann | return;
|
383 | a5d2f727 | Gerd Hoffmann | } |
384 | a5d2f727 | Gerd Hoffmann | |
385 | 72cf2d4f | Blue Swirl | QTAILQ_FOREACH(bus, &busses, next) { |
386 | 72cf2d4f | Blue Swirl | QTAILQ_FOREACH(port, &bus->used, next) { |
387 | a5d2f727 | Gerd Hoffmann | dev = port->dev; |
388 | a5d2f727 | Gerd Hoffmann | if (!dev)
|
389 | a5d2f727 | Gerd Hoffmann | continue;
|
390 | c7a2196a | Gerd Hoffmann | monitor_printf(mon, " Device %d.%d, Port %s, Speed %s Mb/s, Product %s\n",
|
391 | c7a2196a | Gerd Hoffmann | bus->busnr, dev->addr, port->path, usb_speed(dev->speed), |
392 | 0fe6d12e | Markus Armbruster | dev->product_desc); |
393 | a5d2f727 | Gerd Hoffmann | } |
394 | a5d2f727 | Gerd Hoffmann | } |
395 | a5d2f727 | Gerd Hoffmann | } |
396 | a5d2f727 | Gerd Hoffmann | |
397 | 0958b4cc | Gerd Hoffmann | /* handle legacy -usbdevice cmd line option */
|
398 | 0958b4cc | Gerd Hoffmann | USBDevice *usbdevice_create(const char *cmdline) |
399 | 0958b4cc | Gerd Hoffmann | { |
400 | 0958b4cc | Gerd Hoffmann | USBBus *bus = usb_bus_find(-1 /* any */); |
401 | 0958b4cc | Gerd Hoffmann | DeviceInfo *info; |
402 | 0958b4cc | Gerd Hoffmann | USBDeviceInfo *usb; |
403 | 702f3e0f | Jan Kiszka | char driver[32]; |
404 | 702f3e0f | Jan Kiszka | const char *params; |
405 | 0958b4cc | Gerd Hoffmann | int len;
|
406 | 0958b4cc | Gerd Hoffmann | |
407 | 0958b4cc | Gerd Hoffmann | params = strchr(cmdline,':');
|
408 | 0958b4cc | Gerd Hoffmann | if (params) {
|
409 | 0958b4cc | Gerd Hoffmann | params++; |
410 | 0958b4cc | Gerd Hoffmann | len = params - cmdline; |
411 | 0958b4cc | Gerd Hoffmann | if (len > sizeof(driver)) |
412 | 0958b4cc | Gerd Hoffmann | len = sizeof(driver);
|
413 | 0958b4cc | Gerd Hoffmann | pstrcpy(driver, len, cmdline); |
414 | 0958b4cc | Gerd Hoffmann | } else {
|
415 | 702f3e0f | Jan Kiszka | params = "";
|
416 | 0958b4cc | Gerd Hoffmann | pstrcpy(driver, sizeof(driver), cmdline);
|
417 | 0958b4cc | Gerd Hoffmann | } |
418 | 0958b4cc | Gerd Hoffmann | |
419 | 0958b4cc | Gerd Hoffmann | for (info = device_info_list; info != NULL; info = info->next) { |
420 | 0958b4cc | Gerd Hoffmann | if (info->bus_info != &usb_bus_info)
|
421 | 0958b4cc | Gerd Hoffmann | continue;
|
422 | 0958b4cc | Gerd Hoffmann | usb = DO_UPCAST(USBDeviceInfo, qdev, info); |
423 | 0958b4cc | Gerd Hoffmann | if (usb->usbdevice_name == NULL) |
424 | 0958b4cc | Gerd Hoffmann | continue;
|
425 | 0958b4cc | Gerd Hoffmann | if (strcmp(usb->usbdevice_name, driver) != 0) |
426 | 0958b4cc | Gerd Hoffmann | continue;
|
427 | 0958b4cc | Gerd Hoffmann | break;
|
428 | 0958b4cc | Gerd Hoffmann | } |
429 | 0958b4cc | Gerd Hoffmann | if (info == NULL) { |
430 | 0958b4cc | Gerd Hoffmann | #if 0
|
431 | 0958b4cc | Gerd Hoffmann | /* no error because some drivers are not converted (yet) */
|
432 | 1ecda02b | Markus Armbruster | error_report("usbdevice %s not found", driver);
|
433 | 0958b4cc | Gerd Hoffmann | #endif
|
434 | 0958b4cc | Gerd Hoffmann | return NULL; |
435 | 0958b4cc | Gerd Hoffmann | } |
436 | 0958b4cc | Gerd Hoffmann | |
437 | 0958b4cc | Gerd Hoffmann | if (!usb->usbdevice_init) {
|
438 | 98f22dc1 | TeLeMan | if (*params) {
|
439 | 1ecda02b | Markus Armbruster | error_report("usbdevice %s accepts no params", driver);
|
440 | 0958b4cc | Gerd Hoffmann | return NULL; |
441 | 0958b4cc | Gerd Hoffmann | } |
442 | 0958b4cc | Gerd Hoffmann | return usb_create_simple(bus, usb->qdev.name);
|
443 | 0958b4cc | Gerd Hoffmann | } |
444 | 0958b4cc | Gerd Hoffmann | return usb->usbdevice_init(params);
|
445 | 0958b4cc | Gerd Hoffmann | } |