]>
Commit | Line | Data |
---|---|---|
806b6024 GH |
1 | #include "hw.h" |
2 | #include "usb.h" | |
3 | #include "qdev.h" | |
a5d2f727 GH |
4 | #include "sysemu.h" |
5 | #include "monitor.h" | |
6 | ||
7 | static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent); | |
cdedd006 | 8 | static char *usbbus_get_fw_dev_path(DeviceState *dev); |
806b6024 GH |
9 | |
10 | static struct BusInfo usb_bus_info = { | |
a5d2f727 GH |
11 | .name = "USB", |
12 | .size = sizeof(USBBus), | |
13 | .print_dev = usb_bus_dev_print, | |
cdedd006 | 14 | .get_fw_dev_path = usbbus_get_fw_dev_path, |
806b6024 GH |
15 | }; |
16 | static int next_usb_bus = 0; | |
72cf2d4f | 17 | static QTAILQ_HEAD(, USBBus) busses = QTAILQ_HEAD_INITIALIZER(busses); |
806b6024 | 18 | |
b2317837 | 19 | void usb_bus_new(USBBus *bus, DeviceState *host) |
806b6024 | 20 | { |
b2317837 | 21 | qbus_create_inplace(&bus->qbus, &usb_bus_info, host, NULL); |
806b6024 | 22 | bus->busnr = next_usb_bus++; |
ef816d83 | 23 | bus->qbus.allow_hotplug = 1; /* Yes, we can */ |
72cf2d4f BS |
24 | QTAILQ_INIT(&bus->free); |
25 | QTAILQ_INIT(&bus->used); | |
26 | QTAILQ_INSERT_TAIL(&busses, bus, next); | |
806b6024 GH |
27 | } |
28 | ||
29 | USBBus *usb_bus_find(int busnr) | |
30 | { | |
31 | USBBus *bus; | |
32 | ||
33 | if (-1 == busnr) | |
72cf2d4f BS |
34 | return QTAILQ_FIRST(&busses); |
35 | QTAILQ_FOREACH(bus, &busses, next) { | |
806b6024 GH |
36 | if (bus->busnr == busnr) |
37 | return bus; | |
38 | } | |
39 | return NULL; | |
40 | } | |
41 | ||
42 | static int usb_qdev_init(DeviceState *qdev, DeviceInfo *base) | |
43 | { | |
44 | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); | |
45 | USBDeviceInfo *info = DO_UPCAST(USBDeviceInfo, qdev, base); | |
46 | int rc; | |
47 | ||
06384698 | 48 | pstrcpy(dev->product_desc, sizeof(dev->product_desc), info->product_desc); |
806b6024 | 49 | dev->info = info; |
61e094c0 | 50 | dev->auto_attach = 1; |
806b6024 | 51 | rc = dev->info->init(dev); |
61e094c0 | 52 | if (rc == 0 && dev->auto_attach) |
a5d2f727 | 53 | usb_device_attach(dev); |
806b6024 GH |
54 | return rc; |
55 | } | |
56 | ||
a8e662b5 GH |
57 | static int usb_qdev_exit(DeviceState *qdev) |
58 | { | |
59 | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); | |
60 | ||
61 | usb_device_detach(dev); | |
62 | if (dev->info->handle_destroy) { | |
63 | dev->info->handle_destroy(dev); | |
64 | } | |
65 | return 0; | |
66 | } | |
67 | ||
806b6024 GH |
68 | void usb_qdev_register(USBDeviceInfo *info) |
69 | { | |
70 | info->qdev.bus_info = &usb_bus_info; | |
71 | info->qdev.init = usb_qdev_init; | |
ef816d83 | 72 | info->qdev.unplug = qdev_simple_unplug_cb; |
a8e662b5 | 73 | info->qdev.exit = usb_qdev_exit; |
806b6024 GH |
74 | qdev_register(&info->qdev); |
75 | } | |
76 | ||
77 | void usb_qdev_register_many(USBDeviceInfo *info) | |
78 | { | |
79 | while (info->qdev.name) { | |
80 | usb_qdev_register(info); | |
81 | info++; | |
82 | } | |
83 | } | |
84 | ||
a5d2f727 | 85 | USBDevice *usb_create(USBBus *bus, const char *name) |
806b6024 GH |
86 | { |
87 | DeviceState *dev; | |
88 | ||
89 | #if 1 | |
90 | /* temporary stopgap until all usb is properly qdev-ified */ | |
91 | if (!bus) { | |
92 | bus = usb_bus_find(-1); | |
93 | if (!bus) | |
94 | return NULL; | |
95 | fprintf(stderr, "%s: no bus specified, using \"%s\" for \"%s\"\n", | |
96 | __FUNCTION__, bus->qbus.name, name); | |
97 | } | |
98 | #endif | |
99 | ||
100 | dev = qdev_create(&bus->qbus, name); | |
806b6024 GH |
101 | return DO_UPCAST(USBDevice, qdev, dev); |
102 | } | |
a5d2f727 GH |
103 | |
104 | USBDevice *usb_create_simple(USBBus *bus, const char *name) | |
105 | { | |
106 | USBDevice *dev = usb_create(bus, name); | |
d44168ff PB |
107 | if (!dev) { |
108 | hw_error("Failed to create USB device '%s'\n", name); | |
109 | } | |
e23a1b33 | 110 | qdev_init_nofail(&dev->qdev); |
a5d2f727 GH |
111 | return dev; |
112 | } | |
113 | ||
114 | void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index, | |
ab28ccc0 | 115 | USBDevice *pdev, usb_attachfn attach) |
a5d2f727 GH |
116 | { |
117 | port->opaque = opaque; | |
118 | port->index = index; | |
119 | port->attach = attach; | |
ab28ccc0 | 120 | port->pdev = pdev; |
72cf2d4f | 121 | QTAILQ_INSERT_TAIL(&bus->free, port, next); |
a5d2f727 GH |
122 | bus->nfree++; |
123 | } | |
124 | ||
a8e662b5 GH |
125 | void usb_unregister_port(USBBus *bus, USBPort *port) |
126 | { | |
127 | if (port->dev) | |
128 | qdev_free(&port->dev->qdev); | |
129 | QTAILQ_REMOVE(&bus->free, port, next); | |
130 | bus->nfree--; | |
131 | } | |
132 | ||
a5d2f727 GH |
133 | static void do_attach(USBDevice *dev) |
134 | { | |
135 | USBBus *bus = usb_bus_from_device(dev); | |
136 | USBPort *port; | |
137 | ||
138 | if (dev->attached) { | |
139 | fprintf(stderr, "Warning: tried to attach usb device %s twice\n", | |
0fe6d12e | 140 | dev->product_desc); |
a5d2f727 GH |
141 | return; |
142 | } | |
143 | dev->attached++; | |
144 | ||
72cf2d4f BS |
145 | port = QTAILQ_FIRST(&bus->free); |
146 | QTAILQ_REMOVE(&bus->free, port, next); | |
a5d2f727 GH |
147 | bus->nfree--; |
148 | ||
149 | usb_attach(port, dev); | |
150 | ||
72cf2d4f | 151 | QTAILQ_INSERT_TAIL(&bus->used, port, next); |
a5d2f727 GH |
152 | bus->nused++; |
153 | } | |
154 | ||
155 | int usb_device_attach(USBDevice *dev) | |
156 | { | |
157 | USBBus *bus = usb_bus_from_device(dev); | |
a5d2f727 GH |
158 | |
159 | if (bus->nfree == 1) { | |
160 | /* Create a new hub and chain it on. */ | |
d4c4e6fd | 161 | usb_create_simple(bus, "usb-hub"); |
a5d2f727 GH |
162 | } |
163 | do_attach(dev); | |
164 | return 0; | |
165 | } | |
166 | ||
a8e662b5 GH |
167 | int usb_device_detach(USBDevice *dev) |
168 | { | |
169 | USBBus *bus = usb_bus_from_device(dev); | |
170 | USBPort *port; | |
171 | ||
172 | if (!dev->attached) { | |
173 | fprintf(stderr, "Warning: tried to detach unattached usb device %s\n", | |
0fe6d12e | 174 | dev->product_desc); |
a8e662b5 GH |
175 | return -1; |
176 | } | |
177 | dev->attached--; | |
178 | ||
179 | QTAILQ_FOREACH(port, &bus->used, next) { | |
180 | if (port->dev == dev) | |
181 | break; | |
182 | } | |
183 | assert(port != NULL); | |
184 | ||
185 | QTAILQ_REMOVE(&bus->used, port, next); | |
186 | bus->nused--; | |
187 | ||
188 | usb_attach(port, NULL); | |
189 | ||
190 | QTAILQ_INSERT_TAIL(&bus->free, port, next); | |
191 | bus->nfree++; | |
192 | return 0; | |
193 | } | |
194 | ||
a5d2f727 GH |
195 | int usb_device_delete_addr(int busnr, int addr) |
196 | { | |
197 | USBBus *bus; | |
198 | USBPort *port; | |
199 | USBDevice *dev; | |
200 | ||
201 | bus = usb_bus_find(busnr); | |
202 | if (!bus) | |
203 | return -1; | |
204 | ||
72cf2d4f | 205 | QTAILQ_FOREACH(port, &bus->used, next) { |
a5d2f727 GH |
206 | if (port->dev->addr == addr) |
207 | break; | |
208 | } | |
209 | if (!port) | |
210 | return -1; | |
a5d2f727 | 211 | dev = port->dev; |
a5d2f727 | 212 | |
a8e662b5 | 213 | qdev_free(&dev->qdev); |
a5d2f727 GH |
214 | return 0; |
215 | } | |
216 | ||
217 | static const char *usb_speed(unsigned int speed) | |
218 | { | |
219 | static const char *txt[] = { | |
220 | [ USB_SPEED_LOW ] = "1.5", | |
221 | [ USB_SPEED_FULL ] = "12", | |
222 | [ USB_SPEED_HIGH ] = "480", | |
223 | }; | |
224 | if (speed >= ARRAY_SIZE(txt)) | |
225 | return "?"; | |
226 | return txt[speed]; | |
227 | } | |
228 | ||
229 | static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent) | |
230 | { | |
231 | USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev); | |
232 | USBBus *bus = usb_bus_from_device(dev); | |
233 | ||
66a6593a GH |
234 | monitor_printf(mon, "%*saddr %d.%d, speed %s, name %s%s\n", |
235 | indent, "", bus->busnr, dev->addr, | |
0fe6d12e | 236 | usb_speed(dev->speed), dev->product_desc, |
66a6593a | 237 | dev->attached ? ", attached" : ""); |
a5d2f727 GH |
238 | } |
239 | ||
240 | void usb_info(Monitor *mon) | |
241 | { | |
242 | USBBus *bus; | |
243 | USBDevice *dev; | |
244 | USBPort *port; | |
245 | ||
72cf2d4f | 246 | if (QTAILQ_EMPTY(&busses)) { |
a5d2f727 GH |
247 | monitor_printf(mon, "USB support not enabled\n"); |
248 | return; | |
249 | } | |
250 | ||
72cf2d4f BS |
251 | QTAILQ_FOREACH(bus, &busses, next) { |
252 | QTAILQ_FOREACH(port, &bus->used, next) { | |
a5d2f727 GH |
253 | dev = port->dev; |
254 | if (!dev) | |
255 | continue; | |
256 | monitor_printf(mon, " Device %d.%d, Speed %s Mb/s, Product %s\n", | |
0fe6d12e MA |
257 | bus->busnr, dev->addr, usb_speed(dev->speed), |
258 | dev->product_desc); | |
a5d2f727 GH |
259 | } |
260 | } | |
261 | } | |
262 | ||
0958b4cc GH |
263 | /* handle legacy -usbdevice cmd line option */ |
264 | USBDevice *usbdevice_create(const char *cmdline) | |
265 | { | |
266 | USBBus *bus = usb_bus_find(-1 /* any */); | |
267 | DeviceInfo *info; | |
268 | USBDeviceInfo *usb; | |
702f3e0f JK |
269 | char driver[32]; |
270 | const char *params; | |
0958b4cc GH |
271 | int len; |
272 | ||
273 | params = strchr(cmdline,':'); | |
274 | if (params) { | |
275 | params++; | |
276 | len = params - cmdline; | |
277 | if (len > sizeof(driver)) | |
278 | len = sizeof(driver); | |
279 | pstrcpy(driver, len, cmdline); | |
280 | } else { | |
702f3e0f | 281 | params = ""; |
0958b4cc GH |
282 | pstrcpy(driver, sizeof(driver), cmdline); |
283 | } | |
284 | ||
285 | for (info = device_info_list; info != NULL; info = info->next) { | |
286 | if (info->bus_info != &usb_bus_info) | |
287 | continue; | |
288 | usb = DO_UPCAST(USBDeviceInfo, qdev, info); | |
289 | if (usb->usbdevice_name == NULL) | |
290 | continue; | |
291 | if (strcmp(usb->usbdevice_name, driver) != 0) | |
292 | continue; | |
293 | break; | |
294 | } | |
295 | if (info == NULL) { | |
296 | #if 0 | |
297 | /* no error because some drivers are not converted (yet) */ | |
1ecda02b | 298 | error_report("usbdevice %s not found", driver); |
0958b4cc GH |
299 | #endif |
300 | return NULL; | |
301 | } | |
302 | ||
303 | if (!usb->usbdevice_init) { | |
98f22dc1 | 304 | if (*params) { |
1ecda02b | 305 | error_report("usbdevice %s accepts no params", driver); |
0958b4cc GH |
306 | return NULL; |
307 | } | |
308 | return usb_create_simple(bus, usb->qdev.name); | |
309 | } | |
310 | return usb->usbdevice_init(params); | |
311 | } | |
cdedd006 GN |
312 | |
313 | static int usbbus_get_fw_dev_path_helper(USBDevice *d, USBBus *bus, char *p, | |
314 | int len) | |
315 | { | |
316 | int l = 0; | |
317 | USBPort *port; | |
318 | ||
319 | QTAILQ_FOREACH(port, &bus->used, next) { | |
320 | if (port->dev == d) { | |
321 | if (port->pdev) { | |
322 | l = usbbus_get_fw_dev_path_helper(port->pdev, bus, p, len); | |
323 | } | |
324 | l += snprintf(p + l, len - l, "%s@%x/", qdev_fw_name(&d->qdev), | |
325 | port->index); | |
326 | break; | |
327 | } | |
328 | } | |
329 | ||
330 | return l; | |
331 | } | |
332 | ||
333 | static char *usbbus_get_fw_dev_path(DeviceState *dev) | |
334 | { | |
335 | USBDevice *d = (USBDevice*)dev; | |
336 | USBBus *bus = usb_bus_from_device(d); | |
337 | char path[100]; | |
338 | int l; | |
339 | ||
340 | assert(d->attached != 0); | |
341 | ||
342 | l = usbbus_get_fw_dev_path_helper(d, bus, path, sizeof(path)); | |
343 | ||
344 | if (l == 0) { | |
345 | abort(); | |
346 | } | |
347 | ||
348 | path[l-1] = '\0'; | |
349 | ||
350 | return strdup(path); | |
351 | } |