hw/usb-bus.c

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