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