1f1ae32a1SGerd Hoffmann #include "hw/hw.h" 2f1ae32a1SGerd Hoffmann #include "hw/usb.h" 3f1ae32a1SGerd Hoffmann #include "hw/qdev.h" 4f1ae32a1SGerd Hoffmann #include "sysemu.h" 5f1ae32a1SGerd Hoffmann #include "monitor.h" 6f1ae32a1SGerd Hoffmann #include "trace.h" 7f1ae32a1SGerd Hoffmann 8f1ae32a1SGerd Hoffmann static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent); 9f1ae32a1SGerd Hoffmann 10f1ae32a1SGerd Hoffmann static char *usb_get_dev_path(DeviceState *dev); 11f1ae32a1SGerd Hoffmann static char *usb_get_fw_dev_path(DeviceState *qdev); 12f1ae32a1SGerd Hoffmann static int usb_qdev_exit(DeviceState *qdev); 13f1ae32a1SGerd Hoffmann 143cb75a7cSPaolo Bonzini static Property usb_props[] = { 153cb75a7cSPaolo Bonzini DEFINE_PROP_STRING("port", USBDevice, port_path), 163cb75a7cSPaolo Bonzini DEFINE_PROP_BIT("full-path", USBDevice, flags, 173cb75a7cSPaolo Bonzini USB_DEV_FLAG_FULL_PATH, true), 183cb75a7cSPaolo Bonzini DEFINE_PROP_END_OF_LIST() 193cb75a7cSPaolo Bonzini }; 203cb75a7cSPaolo Bonzini 21*0d936928SAnthony Liguori static void usb_bus_class_init(ObjectClass *klass, void *data) 22*0d936928SAnthony Liguori { 23*0d936928SAnthony Liguori BusClass *k = BUS_CLASS(klass); 24*0d936928SAnthony Liguori 25*0d936928SAnthony Liguori k->print_dev = usb_bus_dev_print; 26*0d936928SAnthony Liguori k->get_dev_path = usb_get_dev_path; 27*0d936928SAnthony Liguori k->get_fw_dev_path = usb_get_fw_dev_path; 28*0d936928SAnthony Liguori } 29*0d936928SAnthony Liguori 30*0d936928SAnthony Liguori static const TypeInfo usb_bus_info = { 31*0d936928SAnthony Liguori .name = TYPE_USB_BUS, 32*0d936928SAnthony Liguori .parent = TYPE_BUS, 33*0d936928SAnthony Liguori .instance_size = sizeof(USBBus), 34*0d936928SAnthony Liguori .class_init = usb_bus_class_init, 35f1ae32a1SGerd Hoffmann }; 363cb75a7cSPaolo Bonzini 37f1ae32a1SGerd Hoffmann static int next_usb_bus = 0; 38f1ae32a1SGerd Hoffmann static QTAILQ_HEAD(, USBBus) busses = QTAILQ_HEAD_INITIALIZER(busses); 39f1ae32a1SGerd Hoffmann 40f1ae32a1SGerd Hoffmann const VMStateDescription vmstate_usb_device = { 41f1ae32a1SGerd Hoffmann .name = "USBDevice", 42f1ae32a1SGerd Hoffmann .version_id = 1, 43f1ae32a1SGerd Hoffmann .minimum_version_id = 1, 44f1ae32a1SGerd Hoffmann .fields = (VMStateField []) { 45f1ae32a1SGerd Hoffmann VMSTATE_UINT8(addr, USBDevice), 46f1ae32a1SGerd Hoffmann VMSTATE_INT32(state, USBDevice), 47f1ae32a1SGerd Hoffmann VMSTATE_INT32(remote_wakeup, USBDevice), 48f1ae32a1SGerd Hoffmann VMSTATE_INT32(setup_state, USBDevice), 49f1ae32a1SGerd Hoffmann VMSTATE_INT32(setup_len, USBDevice), 50f1ae32a1SGerd Hoffmann VMSTATE_INT32(setup_index, USBDevice), 51f1ae32a1SGerd Hoffmann VMSTATE_UINT8_ARRAY(setup_buf, USBDevice, 8), 52f1ae32a1SGerd Hoffmann VMSTATE_END_OF_LIST(), 53f1ae32a1SGerd Hoffmann } 54f1ae32a1SGerd Hoffmann }; 55f1ae32a1SGerd Hoffmann 56f1ae32a1SGerd Hoffmann void usb_bus_new(USBBus *bus, USBBusOps *ops, DeviceState *host) 57f1ae32a1SGerd Hoffmann { 58*0d936928SAnthony Liguori qbus_create_inplace(&bus->qbus, TYPE_USB_BUS, host, NULL); 59f1ae32a1SGerd Hoffmann bus->ops = ops; 60f1ae32a1SGerd Hoffmann bus->busnr = next_usb_bus++; 61f1ae32a1SGerd Hoffmann bus->qbus.allow_hotplug = 1; /* Yes, we can */ 62f1ae32a1SGerd Hoffmann QTAILQ_INIT(&bus->free); 63f1ae32a1SGerd Hoffmann QTAILQ_INIT(&bus->used); 64f1ae32a1SGerd Hoffmann QTAILQ_INSERT_TAIL(&busses, bus, next); 65f1ae32a1SGerd Hoffmann } 66f1ae32a1SGerd Hoffmann 67f1ae32a1SGerd Hoffmann USBBus *usb_bus_find(int busnr) 68f1ae32a1SGerd Hoffmann { 69f1ae32a1SGerd Hoffmann USBBus *bus; 70f1ae32a1SGerd Hoffmann 71f1ae32a1SGerd Hoffmann if (-1 == busnr) 72f1ae32a1SGerd Hoffmann return QTAILQ_FIRST(&busses); 73f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(bus, &busses, next) { 74f1ae32a1SGerd Hoffmann if (bus->busnr == busnr) 75f1ae32a1SGerd Hoffmann return bus; 76f1ae32a1SGerd Hoffmann } 77f1ae32a1SGerd Hoffmann return NULL; 78f1ae32a1SGerd Hoffmann } 79f1ae32a1SGerd Hoffmann 80f1ae32a1SGerd Hoffmann static int usb_device_init(USBDevice *dev) 81f1ae32a1SGerd Hoffmann { 82f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 83f1ae32a1SGerd Hoffmann if (klass->init) { 84f1ae32a1SGerd Hoffmann return klass->init(dev); 85f1ae32a1SGerd Hoffmann } 86f1ae32a1SGerd Hoffmann return 0; 87f1ae32a1SGerd Hoffmann } 88f1ae32a1SGerd Hoffmann 89f1ae32a1SGerd Hoffmann USBDevice *usb_device_find_device(USBDevice *dev, uint8_t addr) 90f1ae32a1SGerd Hoffmann { 91f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 92f1ae32a1SGerd Hoffmann if (klass->find_device) { 93f1ae32a1SGerd Hoffmann return klass->find_device(dev, addr); 94f1ae32a1SGerd Hoffmann } 95f1ae32a1SGerd Hoffmann return NULL; 96f1ae32a1SGerd Hoffmann } 97f1ae32a1SGerd Hoffmann 98f1ae32a1SGerd Hoffmann static void usb_device_handle_destroy(USBDevice *dev) 99f1ae32a1SGerd Hoffmann { 100f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 101f1ae32a1SGerd Hoffmann if (klass->handle_destroy) { 102f1ae32a1SGerd Hoffmann klass->handle_destroy(dev); 103f1ae32a1SGerd Hoffmann } 104f1ae32a1SGerd Hoffmann } 105f1ae32a1SGerd Hoffmann 106f1ae32a1SGerd Hoffmann void usb_device_cancel_packet(USBDevice *dev, USBPacket *p) 107f1ae32a1SGerd Hoffmann { 108f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 109f1ae32a1SGerd Hoffmann if (klass->cancel_packet) { 110f1ae32a1SGerd Hoffmann klass->cancel_packet(dev, p); 111f1ae32a1SGerd Hoffmann } 112f1ae32a1SGerd Hoffmann } 113f1ae32a1SGerd Hoffmann 114f1ae32a1SGerd Hoffmann void usb_device_handle_attach(USBDevice *dev) 115f1ae32a1SGerd Hoffmann { 116f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 117f1ae32a1SGerd Hoffmann if (klass->handle_attach) { 118f1ae32a1SGerd Hoffmann klass->handle_attach(dev); 119f1ae32a1SGerd Hoffmann } 120f1ae32a1SGerd Hoffmann } 121f1ae32a1SGerd Hoffmann 122f1ae32a1SGerd Hoffmann void usb_device_handle_reset(USBDevice *dev) 123f1ae32a1SGerd Hoffmann { 124f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 125f1ae32a1SGerd Hoffmann if (klass->handle_reset) { 126f1ae32a1SGerd Hoffmann klass->handle_reset(dev); 127f1ae32a1SGerd Hoffmann } 128f1ae32a1SGerd Hoffmann } 129f1ae32a1SGerd Hoffmann 130f1ae32a1SGerd Hoffmann int usb_device_handle_control(USBDevice *dev, USBPacket *p, int request, 131f1ae32a1SGerd Hoffmann int value, int index, int length, uint8_t *data) 132f1ae32a1SGerd Hoffmann { 133f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 134f1ae32a1SGerd Hoffmann if (klass->handle_control) { 135f1ae32a1SGerd Hoffmann return klass->handle_control(dev, p, request, value, index, length, 136f1ae32a1SGerd Hoffmann data); 137f1ae32a1SGerd Hoffmann } 138f1ae32a1SGerd Hoffmann return -ENOSYS; 139f1ae32a1SGerd Hoffmann } 140f1ae32a1SGerd Hoffmann 141f1ae32a1SGerd Hoffmann int usb_device_handle_data(USBDevice *dev, USBPacket *p) 142f1ae32a1SGerd Hoffmann { 143f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 144f1ae32a1SGerd Hoffmann if (klass->handle_data) { 145f1ae32a1SGerd Hoffmann return klass->handle_data(dev, p); 146f1ae32a1SGerd Hoffmann } 147f1ae32a1SGerd Hoffmann return -ENOSYS; 148f1ae32a1SGerd Hoffmann } 149f1ae32a1SGerd Hoffmann 150f1ae32a1SGerd Hoffmann const char *usb_device_get_product_desc(USBDevice *dev) 151f1ae32a1SGerd Hoffmann { 152f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 153f1ae32a1SGerd Hoffmann return klass->product_desc; 154f1ae32a1SGerd Hoffmann } 155f1ae32a1SGerd Hoffmann 156f1ae32a1SGerd Hoffmann const USBDesc *usb_device_get_usb_desc(USBDevice *dev) 157f1ae32a1SGerd Hoffmann { 158f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 159f1ae32a1SGerd Hoffmann return klass->usb_desc; 160f1ae32a1SGerd Hoffmann } 161f1ae32a1SGerd Hoffmann 162f1ae32a1SGerd Hoffmann void usb_device_set_interface(USBDevice *dev, int interface, 163f1ae32a1SGerd Hoffmann int alt_old, int alt_new) 164f1ae32a1SGerd Hoffmann { 165f1ae32a1SGerd Hoffmann USBDeviceClass *klass = USB_DEVICE_GET_CLASS(dev); 166f1ae32a1SGerd Hoffmann if (klass->set_interface) { 167f1ae32a1SGerd Hoffmann klass->set_interface(dev, interface, alt_old, alt_new); 168f1ae32a1SGerd Hoffmann } 169f1ae32a1SGerd Hoffmann } 170f1ae32a1SGerd Hoffmann 171f1ae32a1SGerd Hoffmann static int usb_qdev_init(DeviceState *qdev) 172f1ae32a1SGerd Hoffmann { 173f1ae32a1SGerd Hoffmann USBDevice *dev = USB_DEVICE(qdev); 174f1ae32a1SGerd Hoffmann int rc; 175f1ae32a1SGerd Hoffmann 176f1ae32a1SGerd Hoffmann pstrcpy(dev->product_desc, sizeof(dev->product_desc), 177f1ae32a1SGerd Hoffmann usb_device_get_product_desc(dev)); 178f1ae32a1SGerd Hoffmann dev->auto_attach = 1; 179f1ae32a1SGerd Hoffmann QLIST_INIT(&dev->strings); 180f1ae32a1SGerd Hoffmann usb_ep_init(dev); 181f1ae32a1SGerd Hoffmann rc = usb_claim_port(dev); 182f1ae32a1SGerd Hoffmann if (rc != 0) { 183f1ae32a1SGerd Hoffmann return rc; 184f1ae32a1SGerd Hoffmann } 185f1ae32a1SGerd Hoffmann rc = usb_device_init(dev); 186f1ae32a1SGerd Hoffmann if (rc != 0) { 187f1ae32a1SGerd Hoffmann usb_release_port(dev); 188f1ae32a1SGerd Hoffmann return rc; 189f1ae32a1SGerd Hoffmann } 190f1ae32a1SGerd Hoffmann if (dev->auto_attach) { 191f1ae32a1SGerd Hoffmann rc = usb_device_attach(dev); 192f1ae32a1SGerd Hoffmann if (rc != 0) { 193f1ae32a1SGerd Hoffmann usb_qdev_exit(qdev); 194f1ae32a1SGerd Hoffmann return rc; 195f1ae32a1SGerd Hoffmann } 196f1ae32a1SGerd Hoffmann } 197f1ae32a1SGerd Hoffmann return 0; 198f1ae32a1SGerd Hoffmann } 199f1ae32a1SGerd Hoffmann 200f1ae32a1SGerd Hoffmann static int usb_qdev_exit(DeviceState *qdev) 201f1ae32a1SGerd Hoffmann { 202f1ae32a1SGerd Hoffmann USBDevice *dev = USB_DEVICE(qdev); 203f1ae32a1SGerd Hoffmann 204f1ae32a1SGerd Hoffmann if (dev->attached) { 205f1ae32a1SGerd Hoffmann usb_device_detach(dev); 206f1ae32a1SGerd Hoffmann } 207f1ae32a1SGerd Hoffmann usb_device_handle_destroy(dev); 208f1ae32a1SGerd Hoffmann if (dev->port) { 209f1ae32a1SGerd Hoffmann usb_release_port(dev); 210f1ae32a1SGerd Hoffmann } 211f1ae32a1SGerd Hoffmann return 0; 212f1ae32a1SGerd Hoffmann } 213f1ae32a1SGerd Hoffmann 214f1ae32a1SGerd Hoffmann typedef struct LegacyUSBFactory 215f1ae32a1SGerd Hoffmann { 216f1ae32a1SGerd Hoffmann const char *name; 217f1ae32a1SGerd Hoffmann const char *usbdevice_name; 218f1ae32a1SGerd Hoffmann USBDevice *(*usbdevice_init)(USBBus *bus, const char *params); 219f1ae32a1SGerd Hoffmann } LegacyUSBFactory; 220f1ae32a1SGerd Hoffmann 221f1ae32a1SGerd Hoffmann static GSList *legacy_usb_factory; 222f1ae32a1SGerd Hoffmann 223f1ae32a1SGerd Hoffmann void usb_legacy_register(const char *typename, const char *usbdevice_name, 224f1ae32a1SGerd Hoffmann USBDevice *(*usbdevice_init)(USBBus *bus, 225f1ae32a1SGerd Hoffmann const char *params)) 226f1ae32a1SGerd Hoffmann { 227f1ae32a1SGerd Hoffmann if (usbdevice_name) { 228f1ae32a1SGerd Hoffmann LegacyUSBFactory *f = g_malloc0(sizeof(*f)); 229f1ae32a1SGerd Hoffmann f->name = typename; 230f1ae32a1SGerd Hoffmann f->usbdevice_name = usbdevice_name; 231f1ae32a1SGerd Hoffmann f->usbdevice_init = usbdevice_init; 232f1ae32a1SGerd Hoffmann legacy_usb_factory = g_slist_append(legacy_usb_factory, f); 233f1ae32a1SGerd Hoffmann } 234f1ae32a1SGerd Hoffmann } 235f1ae32a1SGerd Hoffmann 236f1ae32a1SGerd Hoffmann USBDevice *usb_create(USBBus *bus, const char *name) 237f1ae32a1SGerd Hoffmann { 238f1ae32a1SGerd Hoffmann DeviceState *dev; 239f1ae32a1SGerd Hoffmann 240f1ae32a1SGerd Hoffmann dev = qdev_create(&bus->qbus, name); 241f1ae32a1SGerd Hoffmann return USB_DEVICE(dev); 242f1ae32a1SGerd Hoffmann } 243f1ae32a1SGerd Hoffmann 244f1ae32a1SGerd Hoffmann USBDevice *usb_create_simple(USBBus *bus, const char *name) 245f1ae32a1SGerd Hoffmann { 246f1ae32a1SGerd Hoffmann USBDevice *dev = usb_create(bus, name); 247f1ae32a1SGerd Hoffmann int rc; 248f1ae32a1SGerd Hoffmann 249f1ae32a1SGerd Hoffmann if (!dev) { 250f1ae32a1SGerd Hoffmann error_report("Failed to create USB device '%s'", name); 251f1ae32a1SGerd Hoffmann return NULL; 252f1ae32a1SGerd Hoffmann } 253f1ae32a1SGerd Hoffmann rc = qdev_init(&dev->qdev); 254f1ae32a1SGerd Hoffmann if (rc < 0) { 255f1ae32a1SGerd Hoffmann error_report("Failed to initialize USB device '%s'", name); 256f1ae32a1SGerd Hoffmann return NULL; 257f1ae32a1SGerd Hoffmann } 258f1ae32a1SGerd Hoffmann return dev; 259f1ae32a1SGerd Hoffmann } 260f1ae32a1SGerd Hoffmann 261f1ae32a1SGerd Hoffmann static void usb_fill_port(USBPort *port, void *opaque, int index, 262f1ae32a1SGerd Hoffmann USBPortOps *ops, int speedmask) 263f1ae32a1SGerd Hoffmann { 264f1ae32a1SGerd Hoffmann port->opaque = opaque; 265f1ae32a1SGerd Hoffmann port->index = index; 266f1ae32a1SGerd Hoffmann port->ops = ops; 267f1ae32a1SGerd Hoffmann port->speedmask = speedmask; 268f1ae32a1SGerd Hoffmann usb_port_location(port, NULL, index + 1); 269f1ae32a1SGerd Hoffmann } 270f1ae32a1SGerd Hoffmann 271f1ae32a1SGerd Hoffmann void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index, 272f1ae32a1SGerd Hoffmann USBPortOps *ops, int speedmask) 273f1ae32a1SGerd Hoffmann { 274f1ae32a1SGerd Hoffmann usb_fill_port(port, opaque, index, ops, speedmask); 275f1ae32a1SGerd Hoffmann QTAILQ_INSERT_TAIL(&bus->free, port, next); 276f1ae32a1SGerd Hoffmann bus->nfree++; 277f1ae32a1SGerd Hoffmann } 278f1ae32a1SGerd Hoffmann 279f1ae32a1SGerd Hoffmann int usb_register_companion(const char *masterbus, USBPort *ports[], 280f1ae32a1SGerd Hoffmann uint32_t portcount, uint32_t firstport, 281f1ae32a1SGerd Hoffmann void *opaque, USBPortOps *ops, int speedmask) 282f1ae32a1SGerd Hoffmann { 283f1ae32a1SGerd Hoffmann USBBus *bus; 284f1ae32a1SGerd Hoffmann int i; 285f1ae32a1SGerd Hoffmann 286f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(bus, &busses, next) { 287f1ae32a1SGerd Hoffmann if (strcmp(bus->qbus.name, masterbus) == 0) { 288f1ae32a1SGerd Hoffmann break; 289f1ae32a1SGerd Hoffmann } 290f1ae32a1SGerd Hoffmann } 291f1ae32a1SGerd Hoffmann 292f1ae32a1SGerd Hoffmann if (!bus || !bus->ops->register_companion) { 293f1ae32a1SGerd Hoffmann qerror_report(QERR_INVALID_PARAMETER_VALUE, "masterbus", 294f1ae32a1SGerd Hoffmann "an USB masterbus"); 295f1ae32a1SGerd Hoffmann if (bus) { 296f1ae32a1SGerd Hoffmann error_printf_unless_qmp( 297f1ae32a1SGerd Hoffmann "USB bus '%s' does not allow companion controllers\n", 298f1ae32a1SGerd Hoffmann masterbus); 299f1ae32a1SGerd Hoffmann } 300f1ae32a1SGerd Hoffmann return -1; 301f1ae32a1SGerd Hoffmann } 302f1ae32a1SGerd Hoffmann 303f1ae32a1SGerd Hoffmann for (i = 0; i < portcount; i++) { 304f1ae32a1SGerd Hoffmann usb_fill_port(ports[i], opaque, i, ops, speedmask); 305f1ae32a1SGerd Hoffmann } 306f1ae32a1SGerd Hoffmann 307f1ae32a1SGerd Hoffmann return bus->ops->register_companion(bus, ports, portcount, firstport); 308f1ae32a1SGerd Hoffmann } 309f1ae32a1SGerd Hoffmann 310f1ae32a1SGerd Hoffmann void usb_port_location(USBPort *downstream, USBPort *upstream, int portnr) 311f1ae32a1SGerd Hoffmann { 312f1ae32a1SGerd Hoffmann if (upstream) { 313f1ae32a1SGerd Hoffmann snprintf(downstream->path, sizeof(downstream->path), "%s.%d", 314f1ae32a1SGerd Hoffmann upstream->path, portnr); 315f1ae32a1SGerd Hoffmann } else { 316f1ae32a1SGerd Hoffmann snprintf(downstream->path, sizeof(downstream->path), "%d", portnr); 317f1ae32a1SGerd Hoffmann } 318f1ae32a1SGerd Hoffmann } 319f1ae32a1SGerd Hoffmann 320f1ae32a1SGerd Hoffmann void usb_unregister_port(USBBus *bus, USBPort *port) 321f1ae32a1SGerd Hoffmann { 322f1ae32a1SGerd Hoffmann if (port->dev) 323f1ae32a1SGerd Hoffmann qdev_free(&port->dev->qdev); 324f1ae32a1SGerd Hoffmann QTAILQ_REMOVE(&bus->free, port, next); 325f1ae32a1SGerd Hoffmann bus->nfree--; 326f1ae32a1SGerd Hoffmann } 327f1ae32a1SGerd Hoffmann 328f1ae32a1SGerd Hoffmann int usb_claim_port(USBDevice *dev) 329f1ae32a1SGerd Hoffmann { 330f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_from_device(dev); 331f1ae32a1SGerd Hoffmann USBPort *port; 332f1ae32a1SGerd Hoffmann 333f1ae32a1SGerd Hoffmann assert(dev->port == NULL); 334f1ae32a1SGerd Hoffmann 335f1ae32a1SGerd Hoffmann if (dev->port_path) { 336f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(port, &bus->free, next) { 337f1ae32a1SGerd Hoffmann if (strcmp(port->path, dev->port_path) == 0) { 338f1ae32a1SGerd Hoffmann break; 339f1ae32a1SGerd Hoffmann } 340f1ae32a1SGerd Hoffmann } 341f1ae32a1SGerd Hoffmann if (port == NULL) { 342f1ae32a1SGerd Hoffmann error_report("Error: usb port %s (bus %s) not found (in use?)", 343f1ae32a1SGerd Hoffmann dev->port_path, bus->qbus.name); 344f1ae32a1SGerd Hoffmann return -1; 345f1ae32a1SGerd Hoffmann } 346f1ae32a1SGerd Hoffmann } else { 347f1ae32a1SGerd Hoffmann if (bus->nfree == 1 && strcmp(object_get_typename(OBJECT(dev)), "usb-hub") != 0) { 348f1ae32a1SGerd Hoffmann /* Create a new hub and chain it on */ 349f1ae32a1SGerd Hoffmann usb_create_simple(bus, "usb-hub"); 350f1ae32a1SGerd Hoffmann } 351f1ae32a1SGerd Hoffmann if (bus->nfree == 0) { 352f1ae32a1SGerd Hoffmann error_report("Error: tried to attach usb device %s to a bus " 353f1ae32a1SGerd Hoffmann "with no free ports", dev->product_desc); 354f1ae32a1SGerd Hoffmann return -1; 355f1ae32a1SGerd Hoffmann } 356f1ae32a1SGerd Hoffmann port = QTAILQ_FIRST(&bus->free); 357f1ae32a1SGerd Hoffmann } 358f1ae32a1SGerd Hoffmann trace_usb_port_claim(bus->busnr, port->path); 359f1ae32a1SGerd Hoffmann 360f1ae32a1SGerd Hoffmann QTAILQ_REMOVE(&bus->free, port, next); 361f1ae32a1SGerd Hoffmann bus->nfree--; 362f1ae32a1SGerd Hoffmann 363f1ae32a1SGerd Hoffmann dev->port = port; 364f1ae32a1SGerd Hoffmann port->dev = dev; 365f1ae32a1SGerd Hoffmann 366f1ae32a1SGerd Hoffmann QTAILQ_INSERT_TAIL(&bus->used, port, next); 367f1ae32a1SGerd Hoffmann bus->nused++; 368f1ae32a1SGerd Hoffmann return 0; 369f1ae32a1SGerd Hoffmann } 370f1ae32a1SGerd Hoffmann 371f1ae32a1SGerd Hoffmann void usb_release_port(USBDevice *dev) 372f1ae32a1SGerd Hoffmann { 373f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_from_device(dev); 374f1ae32a1SGerd Hoffmann USBPort *port = dev->port; 375f1ae32a1SGerd Hoffmann 376f1ae32a1SGerd Hoffmann assert(port != NULL); 377f1ae32a1SGerd Hoffmann trace_usb_port_release(bus->busnr, port->path); 378f1ae32a1SGerd Hoffmann 379f1ae32a1SGerd Hoffmann QTAILQ_REMOVE(&bus->used, port, next); 380f1ae32a1SGerd Hoffmann bus->nused--; 381f1ae32a1SGerd Hoffmann 382f1ae32a1SGerd Hoffmann dev->port = NULL; 383f1ae32a1SGerd Hoffmann port->dev = NULL; 384f1ae32a1SGerd Hoffmann 385f1ae32a1SGerd Hoffmann QTAILQ_INSERT_TAIL(&bus->free, port, next); 386f1ae32a1SGerd Hoffmann bus->nfree++; 387f1ae32a1SGerd Hoffmann } 388f1ae32a1SGerd Hoffmann 389f1ae32a1SGerd Hoffmann int usb_device_attach(USBDevice *dev) 390f1ae32a1SGerd Hoffmann { 391f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_from_device(dev); 392f1ae32a1SGerd Hoffmann USBPort *port = dev->port; 393f1ae32a1SGerd Hoffmann 394f1ae32a1SGerd Hoffmann assert(port != NULL); 395f1ae32a1SGerd Hoffmann assert(!dev->attached); 396f1ae32a1SGerd Hoffmann trace_usb_port_attach(bus->busnr, port->path); 397f1ae32a1SGerd Hoffmann 398f1ae32a1SGerd Hoffmann if (!(port->speedmask & dev->speedmask)) { 399f1ae32a1SGerd Hoffmann error_report("Warning: speed mismatch trying to attach " 400f1ae32a1SGerd Hoffmann "usb device %s to bus %s", 401f1ae32a1SGerd Hoffmann dev->product_desc, bus->qbus.name); 402f1ae32a1SGerd Hoffmann return -1; 403f1ae32a1SGerd Hoffmann } 404f1ae32a1SGerd Hoffmann 405f1ae32a1SGerd Hoffmann dev->attached++; 406f1ae32a1SGerd Hoffmann usb_attach(port); 407f1ae32a1SGerd Hoffmann 408f1ae32a1SGerd Hoffmann return 0; 409f1ae32a1SGerd Hoffmann } 410f1ae32a1SGerd Hoffmann 411f1ae32a1SGerd Hoffmann int usb_device_detach(USBDevice *dev) 412f1ae32a1SGerd Hoffmann { 413f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_from_device(dev); 414f1ae32a1SGerd Hoffmann USBPort *port = dev->port; 415f1ae32a1SGerd Hoffmann 416f1ae32a1SGerd Hoffmann assert(port != NULL); 417f1ae32a1SGerd Hoffmann assert(dev->attached); 418f1ae32a1SGerd Hoffmann trace_usb_port_detach(bus->busnr, port->path); 419f1ae32a1SGerd Hoffmann 420f1ae32a1SGerd Hoffmann usb_detach(port); 421f1ae32a1SGerd Hoffmann dev->attached--; 422f1ae32a1SGerd Hoffmann return 0; 423f1ae32a1SGerd Hoffmann } 424f1ae32a1SGerd Hoffmann 425f1ae32a1SGerd Hoffmann int usb_device_delete_addr(int busnr, int addr) 426f1ae32a1SGerd Hoffmann { 427f1ae32a1SGerd Hoffmann USBBus *bus; 428f1ae32a1SGerd Hoffmann USBPort *port; 429f1ae32a1SGerd Hoffmann USBDevice *dev; 430f1ae32a1SGerd Hoffmann 431f1ae32a1SGerd Hoffmann bus = usb_bus_find(busnr); 432f1ae32a1SGerd Hoffmann if (!bus) 433f1ae32a1SGerd Hoffmann return -1; 434f1ae32a1SGerd Hoffmann 435f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(port, &bus->used, next) { 436f1ae32a1SGerd Hoffmann if (port->dev->addr == addr) 437f1ae32a1SGerd Hoffmann break; 438f1ae32a1SGerd Hoffmann } 439f1ae32a1SGerd Hoffmann if (!port) 440f1ae32a1SGerd Hoffmann return -1; 441f1ae32a1SGerd Hoffmann dev = port->dev; 442f1ae32a1SGerd Hoffmann 443f1ae32a1SGerd Hoffmann qdev_free(&dev->qdev); 444f1ae32a1SGerd Hoffmann return 0; 445f1ae32a1SGerd Hoffmann } 446f1ae32a1SGerd Hoffmann 447f1ae32a1SGerd Hoffmann static const char *usb_speed(unsigned int speed) 448f1ae32a1SGerd Hoffmann { 449f1ae32a1SGerd Hoffmann static const char *txt[] = { 450f1ae32a1SGerd Hoffmann [ USB_SPEED_LOW ] = "1.5", 451f1ae32a1SGerd Hoffmann [ USB_SPEED_FULL ] = "12", 452f1ae32a1SGerd Hoffmann [ USB_SPEED_HIGH ] = "480", 453f1ae32a1SGerd Hoffmann [ USB_SPEED_SUPER ] = "5000", 454f1ae32a1SGerd Hoffmann }; 455f1ae32a1SGerd Hoffmann if (speed >= ARRAY_SIZE(txt)) 456f1ae32a1SGerd Hoffmann return "?"; 457f1ae32a1SGerd Hoffmann return txt[speed]; 458f1ae32a1SGerd Hoffmann } 459f1ae32a1SGerd Hoffmann 460f1ae32a1SGerd Hoffmann static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent) 461f1ae32a1SGerd Hoffmann { 462f1ae32a1SGerd Hoffmann USBDevice *dev = USB_DEVICE(qdev); 463f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_from_device(dev); 464f1ae32a1SGerd Hoffmann 465f1ae32a1SGerd Hoffmann monitor_printf(mon, "%*saddr %d.%d, port %s, speed %s, name %s%s\n", 466f1ae32a1SGerd Hoffmann indent, "", bus->busnr, dev->addr, 467f1ae32a1SGerd Hoffmann dev->port ? dev->port->path : "-", 468f1ae32a1SGerd Hoffmann usb_speed(dev->speed), dev->product_desc, 469f1ae32a1SGerd Hoffmann dev->attached ? ", attached" : ""); 470f1ae32a1SGerd Hoffmann } 471f1ae32a1SGerd Hoffmann 472f1ae32a1SGerd Hoffmann static char *usb_get_dev_path(DeviceState *qdev) 473f1ae32a1SGerd Hoffmann { 474f1ae32a1SGerd Hoffmann USBDevice *dev = USB_DEVICE(qdev); 475eeb0cf9aSGerd Hoffmann DeviceState *hcd = qdev->parent_bus->parent; 476eeb0cf9aSGerd Hoffmann char *id = NULL; 477eeb0cf9aSGerd Hoffmann 47809e5ab63SAnthony Liguori if (dev->flags & (1 << USB_DEV_FLAG_FULL_PATH)) { 47909e5ab63SAnthony Liguori id = qdev_get_dev_path(hcd); 480eeb0cf9aSGerd Hoffmann } 481eeb0cf9aSGerd Hoffmann if (id) { 482eeb0cf9aSGerd Hoffmann char *ret = g_strdup_printf("%s/%s", id, dev->port->path); 483eeb0cf9aSGerd Hoffmann g_free(id); 484eeb0cf9aSGerd Hoffmann return ret; 485eeb0cf9aSGerd Hoffmann } else { 486f1ae32a1SGerd Hoffmann return g_strdup(dev->port->path); 487f1ae32a1SGerd Hoffmann } 488eeb0cf9aSGerd Hoffmann } 489f1ae32a1SGerd Hoffmann 490f1ae32a1SGerd Hoffmann static char *usb_get_fw_dev_path(DeviceState *qdev) 491f1ae32a1SGerd Hoffmann { 492f1ae32a1SGerd Hoffmann USBDevice *dev = USB_DEVICE(qdev); 493f1ae32a1SGerd Hoffmann char *fw_path, *in; 494f1ae32a1SGerd Hoffmann ssize_t pos = 0, fw_len; 495f1ae32a1SGerd Hoffmann long nr; 496f1ae32a1SGerd Hoffmann 497f1ae32a1SGerd Hoffmann fw_len = 32 + strlen(dev->port->path) * 6; 498f1ae32a1SGerd Hoffmann fw_path = g_malloc(fw_len); 499f1ae32a1SGerd Hoffmann in = dev->port->path; 500f1ae32a1SGerd Hoffmann while (fw_len - pos > 0) { 501f1ae32a1SGerd Hoffmann nr = strtol(in, &in, 10); 502f1ae32a1SGerd Hoffmann if (in[0] == '.') { 503f1ae32a1SGerd Hoffmann /* some hub between root port and device */ 504f1ae32a1SGerd Hoffmann pos += snprintf(fw_path + pos, fw_len - pos, "hub@%ld/", nr); 505f1ae32a1SGerd Hoffmann in++; 506f1ae32a1SGerd Hoffmann } else { 507f1ae32a1SGerd Hoffmann /* the device itself */ 508f1ae32a1SGerd Hoffmann pos += snprintf(fw_path + pos, fw_len - pos, "%s@%ld", 509f1ae32a1SGerd Hoffmann qdev_fw_name(qdev), nr); 510f1ae32a1SGerd Hoffmann break; 511f1ae32a1SGerd Hoffmann } 512f1ae32a1SGerd Hoffmann } 513f1ae32a1SGerd Hoffmann return fw_path; 514f1ae32a1SGerd Hoffmann } 515f1ae32a1SGerd Hoffmann 516f1ae32a1SGerd Hoffmann void usb_info(Monitor *mon) 517f1ae32a1SGerd Hoffmann { 518f1ae32a1SGerd Hoffmann USBBus *bus; 519f1ae32a1SGerd Hoffmann USBDevice *dev; 520f1ae32a1SGerd Hoffmann USBPort *port; 521f1ae32a1SGerd Hoffmann 522f1ae32a1SGerd Hoffmann if (QTAILQ_EMPTY(&busses)) { 523f1ae32a1SGerd Hoffmann monitor_printf(mon, "USB support not enabled\n"); 524f1ae32a1SGerd Hoffmann return; 525f1ae32a1SGerd Hoffmann } 526f1ae32a1SGerd Hoffmann 527f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(bus, &busses, next) { 528f1ae32a1SGerd Hoffmann QTAILQ_FOREACH(port, &bus->used, next) { 529f1ae32a1SGerd Hoffmann dev = port->dev; 530f1ae32a1SGerd Hoffmann if (!dev) 531f1ae32a1SGerd Hoffmann continue; 532f1ae32a1SGerd Hoffmann monitor_printf(mon, " Device %d.%d, Port %s, Speed %s Mb/s, Product %s\n", 533f1ae32a1SGerd Hoffmann bus->busnr, dev->addr, port->path, usb_speed(dev->speed), 534f1ae32a1SGerd Hoffmann dev->product_desc); 535f1ae32a1SGerd Hoffmann } 536f1ae32a1SGerd Hoffmann } 537f1ae32a1SGerd Hoffmann } 538f1ae32a1SGerd Hoffmann 539f1ae32a1SGerd Hoffmann /* handle legacy -usbdevice cmd line option */ 540f1ae32a1SGerd Hoffmann USBDevice *usbdevice_create(const char *cmdline) 541f1ae32a1SGerd Hoffmann { 542f1ae32a1SGerd Hoffmann USBBus *bus = usb_bus_find(-1 /* any */); 543f1ae32a1SGerd Hoffmann LegacyUSBFactory *f = NULL; 544f1ae32a1SGerd Hoffmann GSList *i; 545f1ae32a1SGerd Hoffmann char driver[32]; 546f1ae32a1SGerd Hoffmann const char *params; 547f1ae32a1SGerd Hoffmann int len; 548f1ae32a1SGerd Hoffmann 549f1ae32a1SGerd Hoffmann params = strchr(cmdline,':'); 550f1ae32a1SGerd Hoffmann if (params) { 551f1ae32a1SGerd Hoffmann params++; 552f1ae32a1SGerd Hoffmann len = params - cmdline; 553f1ae32a1SGerd Hoffmann if (len > sizeof(driver)) 554f1ae32a1SGerd Hoffmann len = sizeof(driver); 555f1ae32a1SGerd Hoffmann pstrcpy(driver, len, cmdline); 556f1ae32a1SGerd Hoffmann } else { 557f1ae32a1SGerd Hoffmann params = ""; 558f1ae32a1SGerd Hoffmann pstrcpy(driver, sizeof(driver), cmdline); 559f1ae32a1SGerd Hoffmann } 560f1ae32a1SGerd Hoffmann 561f1ae32a1SGerd Hoffmann for (i = legacy_usb_factory; i; i = i->next) { 562f1ae32a1SGerd Hoffmann f = i->data; 563f1ae32a1SGerd Hoffmann if (strcmp(f->usbdevice_name, driver) == 0) { 564f1ae32a1SGerd Hoffmann break; 565f1ae32a1SGerd Hoffmann } 566f1ae32a1SGerd Hoffmann } 567f1ae32a1SGerd Hoffmann if (i == NULL) { 568f1ae32a1SGerd Hoffmann #if 0 569f1ae32a1SGerd Hoffmann /* no error because some drivers are not converted (yet) */ 570f1ae32a1SGerd Hoffmann error_report("usbdevice %s not found", driver); 571f1ae32a1SGerd Hoffmann #endif 572f1ae32a1SGerd Hoffmann return NULL; 573f1ae32a1SGerd Hoffmann } 574f1ae32a1SGerd Hoffmann 575f1ae32a1SGerd Hoffmann if (!f->usbdevice_init) { 576f1ae32a1SGerd Hoffmann if (*params) { 577f1ae32a1SGerd Hoffmann error_report("usbdevice %s accepts no params", driver); 578f1ae32a1SGerd Hoffmann return NULL; 579f1ae32a1SGerd Hoffmann } 580f1ae32a1SGerd Hoffmann return usb_create_simple(bus, f->name); 581f1ae32a1SGerd Hoffmann } 582f1ae32a1SGerd Hoffmann return f->usbdevice_init(bus, params); 583f1ae32a1SGerd Hoffmann } 584f1ae32a1SGerd Hoffmann 585f1ae32a1SGerd Hoffmann static void usb_device_class_init(ObjectClass *klass, void *data) 586f1ae32a1SGerd Hoffmann { 587f1ae32a1SGerd Hoffmann DeviceClass *k = DEVICE_CLASS(klass); 588*0d936928SAnthony Liguori k->bus_type = TYPE_USB_BUS; 589f1ae32a1SGerd Hoffmann k->init = usb_qdev_init; 590f1ae32a1SGerd Hoffmann k->unplug = qdev_simple_unplug_cb; 591f1ae32a1SGerd Hoffmann k->exit = usb_qdev_exit; 592bce54474SPaolo Bonzini k->props = usb_props; 593f1ae32a1SGerd Hoffmann } 594f1ae32a1SGerd Hoffmann 595f1ae32a1SGerd Hoffmann static TypeInfo usb_device_type_info = { 596f1ae32a1SGerd Hoffmann .name = TYPE_USB_DEVICE, 597f1ae32a1SGerd Hoffmann .parent = TYPE_DEVICE, 598f1ae32a1SGerd Hoffmann .instance_size = sizeof(USBDevice), 599f1ae32a1SGerd Hoffmann .abstract = true, 600f1ae32a1SGerd Hoffmann .class_size = sizeof(USBDeviceClass), 601f1ae32a1SGerd Hoffmann .class_init = usb_device_class_init, 602f1ae32a1SGerd Hoffmann }; 603f1ae32a1SGerd Hoffmann 604f1ae32a1SGerd Hoffmann static void usb_register_types(void) 605f1ae32a1SGerd Hoffmann { 606*0d936928SAnthony Liguori type_register_static(&usb_bus_info); 607f1ae32a1SGerd Hoffmann type_register_static(&usb_device_type_info); 608f1ae32a1SGerd Hoffmann } 609f1ae32a1SGerd Hoffmann 610f1ae32a1SGerd Hoffmann type_init(usb_register_types) 611