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 void usb_qdev_register(USBDeviceInfo *info)
  54 {
  55     info->qdev.bus_info = &usb_bus_info;
  56     info->qdev.init     = usb_qdev_init;
  57     qdev_register(&info->qdev);
  58 }
  59
  60 void usb_qdev_register_many(USBDeviceInfo *info)
  61 {
  62     while (info->qdev.name) {
  63         usb_qdev_register(info);
  64         info++;
  65     }
  66 }
  67
  68 USBDevice *usb_create(USBBus *bus, const char *name)
  69 {
  70     DeviceState *dev;
  71
  72 #if 1
  73     /* temporary stopgap until all usb is properly qdev-ified */
  74     if (!bus) {
  75         bus = usb_bus_find(-1);
  76         if (!bus)
  77             return NULL;
  78         fprintf(stderr, "%s: no bus specified, using \"%s\" for \"%s\"\n",
  79                 __FUNCTION__, bus->qbus.name, name);
  80     }
  81 #endif
  82
  83     dev = qdev_create(&bus->qbus, name);
  84     return DO_UPCAST(USBDevice, qdev, dev);
  85 }
  86
  87 USBDevice *usb_create_simple(USBBus *bus, const char *name)
  88 {
  89     USBDevice *dev = usb_create(bus, name);
  90     qdev_init(&dev->qdev);
  91     return dev;
  92 }
  93
  94 void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index,
  95                        usb_attachfn attach)
  96 {
  97     port->opaque = opaque;
  98     port->index = index;
  99     port->attach = attach;
 100     QTAILQ_INSERT_TAIL(&bus->free, port, next);
 101     bus->nfree++;
 102 }
 103
 104 static void do_attach(USBDevice *dev)
 105 {
 106     USBBus *bus = usb_bus_from_device(dev);
 107     USBPort *port;
 108
 109     if (dev->attached) {
 110         fprintf(stderr, "Warning: tried to attach usb device %s twice\n",
 111                 dev->devname);
 112         return;
 113     }
 114     dev->attached++;
 115
 116     port = QTAILQ_FIRST(&bus->free);
 117     QTAILQ_REMOVE(&bus->free, port, next);
 118     bus->nfree--;
 119
 120     usb_attach(port, dev);
 121
 122     QTAILQ_INSERT_TAIL(&bus->used, port, next);
 123     bus->nused++;
 124 }
 125
 126 int usb_device_attach(USBDevice *dev)
 127 {
 128     USBBus *bus = usb_bus_from_device(dev);
 129     USBDevice *hub;
 130
 131     if (bus->nfree == 1) {
 132         /* Create a new hub and chain it on.  */
 133         hub = usb_create_simple(bus, "QEMU USB Hub");
 134     }
 135     do_attach(dev);
 136     return 0;
 137 }
 138
 139 int usb_device_delete_addr(int busnr, int addr)
 140 {
 141     USBBus *bus;
 142     USBPort *port;
 143     USBDevice *dev;
 144
 145     bus = usb_bus_find(busnr);
 146     if (!bus)
 147         return -1;
 148
 149     QTAILQ_FOREACH(port, &bus->used, next) {
 150         if (port->dev->addr == addr)
 151             break;
 152     }
 153     if (!port)
 154         return -1;
 155
 156     dev = port->dev;
 157     QTAILQ_REMOVE(&bus->used, port, next);
 158     bus->nused--;
 159
 160     usb_attach(port, NULL);
 161     dev->info->handle_destroy(dev);
 162
 163     QTAILQ_INSERT_TAIL(&bus->free, port, next);
 164     bus->nfree++;
 165     return 0;
 166 }
 167
 168 static const char *usb_speed(unsigned int speed)
 169 {
 170     static const char *txt[] = {
 171         [ USB_SPEED_LOW  ] = "1.5",
 172         [ USB_SPEED_FULL ] = "12",
 173         [ USB_SPEED_HIGH ] = "480",
 174     };
 175     if (speed >= ARRAY_SIZE(txt))
 176         return "?";
 177     return txt[speed];
 178 }
 179
 180 static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent)
 181 {
 182     USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
 183     USBBus *bus = usb_bus_from_device(dev);
 184
 185     monitor_printf(mon, "%*saddr %d.%d, speed %s, name %s\n", indent, "",
 186                    bus->busnr, dev->addr,
 187                    usb_speed(dev->speed), dev->devname);
 188 }
 189
 190 void usb_info(Monitor *mon)
 191 {
 192     USBBus *bus;
 193     USBDevice *dev;
 194     USBPort *port;
 195
 196     if (QTAILQ_EMPTY(&busses)) {
 197         monitor_printf(mon, "USB support not enabled\n");
 198         return;
 199     }
 200
 201     QTAILQ_FOREACH(bus, &busses, next) {
 202         QTAILQ_FOREACH(port, &bus->used, next) {
 203             dev = port->dev;
 204             if (!dev)
 205                 continue;
 206             monitor_printf(mon, "  Device %d.%d, Speed %s Mb/s, Product %s\n",
 207                            bus->busnr, dev->addr, usb_speed(dev->speed), dev->devname);
 208         }
 209     }
 210 }
 211