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     QTAILQ_INIT(&bus->free);
  22     QTAILQ_INIT(&bus->used);
  23     QTAILQ_INSERT_TAIL(&busses, bus, next);
  24 }
  25
  26 USBBus *usb_bus_find(int busnr)
  27 {
  28     USBBus *bus;
  29
  30     if (-1 == busnr)
  31         return QTAILQ_FIRST(&busses);
  32     QTAILQ_FOREACH(bus, &busses, next) {
  33         if (bus->busnr == busnr)
  34             return bus;
  35     }
  36     return NULL;
  37 }
  38
  39 static int usb_qdev_init(DeviceState *qdev, DeviceInfo *base)
  40 {
  41     USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
  42     USBDeviceInfo *info = DO_UPCAST(USBDeviceInfo, qdev, base);
  43     int rc;
  44
  45     pstrcpy(dev->devname, sizeof(dev->devname), qdev->info->name);
  46     dev->info = info;
  47     rc = dev->info->init(dev);
  48     if (rc == 0)
  49         usb_device_attach(dev);
  50     return rc;
  51 }
  52
  53 static int usb_qdev_exit(DeviceState *qdev)
  54 {
  55     USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
  56
  57     usb_device_detach(dev);
  58     if (dev->info->handle_destroy) {
  59         dev->info->handle_destroy(dev);
  60     }
  61     return 0;
  62 }
  63
  64 void usb_qdev_register(USBDeviceInfo *info)
  65 {
  66     info->qdev.bus_info = &usb_bus_info;
  67     info->qdev.init     = usb_qdev_init;
  68     info->qdev.exit     = usb_qdev_exit;
  69     qdev_register(&info->qdev);
  70 }
  71
  72 void usb_qdev_register_many(USBDeviceInfo *info)
  73 {
  74     while (info->qdev.name) {
  75         usb_qdev_register(info);
  76         info++;
  77     }
  78 }
  79
  80 USBDevice *usb_create(USBBus *bus, const char *name)
  81 {
  82     DeviceState *dev;
  83
  84 #if 1
  85     /* temporary stopgap until all usb is properly qdev-ified */
  86     if (!bus) {
  87         bus = usb_bus_find(-1);
  88         if (!bus)
  89             return NULL;
  90         fprintf(stderr, "%s: no bus specified, using \"%s\" for \"%s\"\n",
  91                 __FUNCTION__, bus->qbus.name, name);
  92     }
  93 #endif
  94
  95     dev = qdev_create(&bus->qbus, name);
  96     return DO_UPCAST(USBDevice, qdev, dev);
  97 }
  98
  99 USBDevice *usb_create_simple(USBBus *bus, const char *name)
 100 {
 101     USBDevice *dev = usb_create(bus, name);
 102     qdev_init(&dev->qdev);
 103     return dev;
 104 }
 105
 106 void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index,
 107                        usb_attachfn attach)
 108 {
 109     port->opaque = opaque;
 110     port->index = index;
 111     port->attach = attach;
 112     QTAILQ_INSERT_TAIL(&bus->free, port, next);
 113     bus->nfree++;
 114 }
 115
 116 void usb_unregister_port(USBBus *bus, USBPort *port)
 117 {
 118     if (port->dev)
 119         qdev_free(&port->dev->qdev);
 120     QTAILQ_REMOVE(&bus->free, port, next);
 121     bus->nfree--;
 122 }
 123
 124 static void do_attach(USBDevice *dev)
 125 {
 126     USBBus *bus = usb_bus_from_device(dev);
 127     USBPort *port;
 128
 129     if (dev->attached) {
 130         fprintf(stderr, "Warning: tried to attach usb device %s twice\n",
 131                 dev->devname);
 132         return;
 133     }
 134     dev->attached++;
 135
 136     port = QTAILQ_FIRST(&bus->free);
 137     QTAILQ_REMOVE(&bus->free, port, next);
 138     bus->nfree--;
 139
 140     usb_attach(port, dev);
 141
 142     QTAILQ_INSERT_TAIL(&bus->used, port, next);
 143     bus->nused++;
 144 }
 145
 146 int usb_device_attach(USBDevice *dev)
 147 {
 148     USBBus *bus = usb_bus_from_device(dev);
 149     USBDevice *hub;
 150
 151     if (bus->nfree == 1) {
 152         /* Create a new hub and chain it on.  */
 153         hub = usb_create_simple(bus, "QEMU USB Hub");
 154     }
 155     do_attach(dev);
 156     return 0;
 157 }
 158
 159 int usb_device_detach(USBDevice *dev)
 160 {
 161     USBBus *bus = usb_bus_from_device(dev);
 162     USBPort *port;
 163
 164     if (!dev->attached) {
 165         fprintf(stderr, "Warning: tried to detach unattached usb device %s\n",
 166                 dev->devname);
 167         return -1;
 168     }
 169     dev->attached--;
 170
 171     QTAILQ_FOREACH(port, &bus->used, next) {
 172         if (port->dev == dev)
 173             break;
 174     }
 175     assert(port != NULL);
 176
 177     QTAILQ_REMOVE(&bus->used, port, next);
 178     bus->nused--;
 179
 180     usb_attach(port, NULL);
 181
 182     QTAILQ_INSERT_TAIL(&bus->free, port, next);
 183     bus->nfree++;
 184     return 0;
 185 }
 186
 187 int usb_device_delete_addr(int busnr, int addr)
 188 {
 189     USBBus *bus;
 190     USBPort *port;
 191     USBDevice *dev;
 192
 193     bus = usb_bus_find(busnr);
 194     if (!bus)
 195         return -1;
 196
 197     QTAILQ_FOREACH(port, &bus->used, next) {
 198         if (port->dev->addr == addr)
 199             break;
 200     }
 201     if (!port)
 202         return -1;
 203     dev = port->dev;
 204
 205     qdev_free(&dev->qdev);
 206     return 0;
 207 }
 208
 209 static const char *usb_speed(unsigned int speed)
 210 {
 211     static const char *txt[] = {
 212         [ USB_SPEED_LOW  ] = "1.5",
 213         [ USB_SPEED_FULL ] = "12",
 214         [ USB_SPEED_HIGH ] = "480",
 215     };
 216     if (speed >= ARRAY_SIZE(txt))
 217         return "?";
 218     return txt[speed];
 219 }
 220
 221 static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent)
 222 {
 223     USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
 224     USBBus *bus = usb_bus_from_device(dev);
 225
 226     monitor_printf(mon, "%*saddr %d.%d, speed %s, name %s\n", indent, "",
 227                    bus->busnr, dev->addr,
 228                    usb_speed(dev->speed), dev->devname);
 229 }
 230
 231 void usb_info(Monitor *mon)
 232 {
 233     USBBus *bus;
 234     USBDevice *dev;
 235     USBPort *port;
 236
 237     if (QTAILQ_EMPTY(&busses)) {
 238         monitor_printf(mon, "USB support not enabled\n");
 239         return;
 240     }
 241
 242     QTAILQ_FOREACH(bus, &busses, next) {
 243         QTAILQ_FOREACH(port, &bus->used, next) {
 244             dev = port->dev;
 245             if (!dev)
 246                 continue;
 247             monitor_printf(mon, "  Device %d.%d, Speed %s Mb/s, Product %s\n",
 248                            bus->busnr, dev->addr, usb_speed(dev->speed), dev->devname);
 249         }
 250     }
 251 }
 252