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