[qemu.git] / hw / usb-bus.c

#include "hw.h"
#include "usb.h"
#include "qdev.h"
#include "sysemu.h"
#include "monitor.h"
#include "trace.h"

static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent);

static char *usb_get_dev_path(DeviceState *dev);
static char *usb_get_fw_dev_path(DeviceState *qdev);
static int usb_qdev_exit(DeviceState *qdev);

static struct BusInfo usb_bus_info = {
    .name      = "USB",
    .size      = sizeof(USBBus),
    .print_dev = usb_bus_dev_print,
    .get_dev_path = usb_get_dev_path,
    .get_fw_dev_path = usb_get_fw_dev_path,
    .props      = (Property[]) {
        DEFINE_PROP_STRING("port", USBDevice, port_path),
        DEFINE_PROP_END_OF_LIST()
    },
};
static int next_usb_bus = 0;
static QTAILQ_HEAD(, USBBus) busses = QTAILQ_HEAD_INITIALIZER(busses);

const VMStateDescription vmstate_usb_device = {
    .name = "USBDevice",
    .version_id = 1,
    .minimum_version_id = 1,
    .fields = (VMStateField []) {
        VMSTATE_UINT8(addr, USBDevice),
        VMSTATE_INT32(state, USBDevice),
        VMSTATE_INT32(remote_wakeup, USBDevice),
        VMSTATE_INT32(setup_state, USBDevice),
        VMSTATE_INT32(setup_len, USBDevice),
        VMSTATE_INT32(setup_index, USBDevice),
        VMSTATE_UINT8_ARRAY(setup_buf, USBDevice, 8),
        VMSTATE_END_OF_LIST(),
    }
};

void usb_bus_new(USBBus *bus, USBBusOps *ops, DeviceState *host)
{
    qbus_create_inplace(&bus->qbus, &usb_bus_info, host, NULL);
    bus->ops = ops;
    bus->busnr = next_usb_bus++;
    bus->qbus.allow_hotplug = 1; /* Yes, we can */
    QTAILQ_INIT(&bus->free);
    QTAILQ_INIT(&bus->used);
    QTAILQ_INSERT_TAIL(&busses, bus, next);
}

USBBus *usb_bus_find(int busnr)
{
    USBBus *bus;

    if (-1 == busnr)
        return QTAILQ_FIRST(&busses);
    QTAILQ_FOREACH(bus, &busses, next) {
        if (bus->busnr == busnr)
            return bus;
    }
    return NULL;
}

static int usb_qdev_init(DeviceState *qdev, DeviceInfo *base)
{
    USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
    USBDeviceInfo *info = DO_UPCAST(USBDeviceInfo, qdev, base);
    int rc;

    pstrcpy(dev->product_desc, sizeof(dev->product_desc), info->product_desc);
    dev->info = info;
    dev->auto_attach = 1;
    QLIST_INIT(&dev->strings);
    usb_ep_init(dev);
    rc = usb_claim_port(dev);
    if (rc != 0) {
        return rc;
    }
    rc = dev->info->init(dev);
    if (rc != 0) {
        usb_release_port(dev);
        return rc;
    }
    if (dev->auto_attach) {
        rc = usb_device_attach(dev);
        if (rc != 0) {
            usb_qdev_exit(qdev);
            return rc;
        }
    }
    return 0;
}

static int usb_qdev_exit(DeviceState *qdev)
{
    USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);

    if (dev->attached) {
        usb_device_detach(dev);
    }
    if (dev->info->handle_destroy) {
        dev->info->handle_destroy(dev);
    }
    if (dev->port) {
        usb_release_port(dev);
    }
    return 0;
}

void usb_qdev_register(USBDeviceInfo *info)
{
    info->qdev.bus_info = &usb_bus_info;
    info->qdev.init     = usb_qdev_init;
    info->qdev.unplug   = qdev_simple_unplug_cb;
    info->qdev.exit     = usb_qdev_exit;
    qdev_register(&info->qdev);
}

void usb_qdev_register_many(USBDeviceInfo *info)
{
    while (info->qdev.name) {
        usb_qdev_register(info);
        info++;
    }
}

USBDevice *usb_create(USBBus *bus, const char *name)
{
    DeviceState *dev;

#if 1
    /* temporary stopgap until all usb is properly qdev-ified */
    if (!bus) {
        bus = usb_bus_find(-1);
        if (!bus)
            return NULL;
        error_report("%s: no bus specified, using \"%s\" for \"%s\"",
                __FUNCTION__, bus->qbus.name, name);
    }
#endif

    dev = qdev_create(&bus->qbus, name);
    return DO_UPCAST(USBDevice, qdev, dev);
}

USBDevice *usb_create_simple(USBBus *bus, const char *name)
{
    USBDevice *dev = usb_create(bus, name);
    int rc;

    if (!dev) {
        error_report("Failed to create USB device '%s'", name);
        return NULL;
    }
    rc = qdev_init(&dev->qdev);
    if (rc < 0) {
        error_report("Failed to initialize USB device '%s'", name);
        return NULL;
    }
    return dev;
}

static void usb_fill_port(USBPort *port, void *opaque, int index,
                          USBPortOps *ops, int speedmask)
{
    port->opaque = opaque;
    port->index = index;
    port->ops = ops;
    port->speedmask = speedmask;
    usb_port_location(port, NULL, index + 1);
}

void usb_register_port(USBBus *bus, USBPort *port, void *opaque, int index,
                       USBPortOps *ops, int speedmask)
{
    usb_fill_port(port, opaque, index, ops, speedmask);
    QTAILQ_INSERT_TAIL(&bus->free, port, next);
    bus->nfree++;
}

int usb_register_companion(const char *masterbus, USBPort *ports[],
                           uint32_t portcount, uint32_t firstport,
                           void *opaque, USBPortOps *ops, int speedmask)
{
    USBBus *bus;
    int i;

    QTAILQ_FOREACH(bus, &busses, next) {
        if (strcmp(bus->qbus.name, masterbus) == 0) {
            break;
        }
    }

    if (!bus || !bus->ops->register_companion) {
        qerror_report(QERR_INVALID_PARAMETER_VALUE, "masterbus",
                      "an USB masterbus");
        if (bus) {
            error_printf_unless_qmp(
                "USB bus '%s' does not allow companion controllers\n",
                masterbus);
        }
        return -1;
    }

    for (i = 0; i < portcount; i++) {
        usb_fill_port(ports[i], opaque, i, ops, speedmask);
    }

    return bus->ops->register_companion(bus, ports, portcount, firstport);
}

void usb_port_location(USBPort *downstream, USBPort *upstream, int portnr)
{
    if (upstream) {
        snprintf(downstream->path, sizeof(downstream->path), "%s.%d",
                 upstream->path, portnr);
    } else {
        snprintf(downstream->path, sizeof(downstream->path), "%d", portnr);
    }
}

void usb_unregister_port(USBBus *bus, USBPort *port)
{
    if (port->dev)
        qdev_free(&port->dev->qdev);
    QTAILQ_REMOVE(&bus->free, port, next);
    bus->nfree--;
}

int usb_claim_port(USBDevice *dev)
{
    USBBus *bus = usb_bus_from_device(dev);
    USBPort *port;

    assert(dev->port == NULL);

    if (dev->port_path) {
        QTAILQ_FOREACH(port, &bus->free, next) {
            if (strcmp(port->path, dev->port_path) == 0) {
                break;
            }
        }
        if (port == NULL) {
            error_report("Error: usb port %s (bus %s) not found (in use?)",
                         dev->port_path, bus->qbus.name);
            return -1;
        }
    } else {
        if (bus->nfree == 1 && strcmp(object_get_typename(OBJECT(dev)), "usb-hub") != 0) {
            /* Create a new hub and chain it on */
            usb_create_simple(bus, "usb-hub");
        }
        if (bus->nfree == 0) {
            error_report("Error: tried to attach usb device %s to a bus "
                         "with no free ports", dev->product_desc);
            return -1;
        }
        port = QTAILQ_FIRST(&bus->free);
    }
    trace_usb_port_claim(bus->busnr, port->path);

    QTAILQ_REMOVE(&bus->free, port, next);
    bus->nfree--;

    dev->port = port;
    port->dev = dev;

    QTAILQ_INSERT_TAIL(&bus->used, port, next);
    bus->nused++;
    return 0;
}

void usb_release_port(USBDevice *dev)
{
    USBBus *bus = usb_bus_from_device(dev);
    USBPort *port = dev->port;

    assert(port != NULL);
    trace_usb_port_release(bus->busnr, port->path);

    QTAILQ_REMOVE(&bus->used, port, next);
    bus->nused--;

    dev->port = NULL;
    port->dev = NULL;

    QTAILQ_INSERT_TAIL(&bus->free, port, next);
    bus->nfree++;
}

int usb_device_attach(USBDevice *dev)
{
    USBBus *bus = usb_bus_from_device(dev);
    USBPort *port = dev->port;

    assert(port != NULL);
    assert(!dev->attached);
    trace_usb_port_attach(bus->busnr, port->path);

    if (!(port->speedmask & dev->speedmask)) {
        error_report("Warning: speed mismatch trying to attach "
                     "usb device %s to bus %s",
                     dev->product_desc, bus->qbus.name);
        return -1;
    }

    dev->attached++;
    usb_attach(port);

    return 0;
}

int usb_device_detach(USBDevice *dev)
{
    USBBus *bus = usb_bus_from_device(dev);
    USBPort *port = dev->port;

    assert(port != NULL);
    assert(dev->attached);
    trace_usb_port_detach(bus->busnr, port->path);

    usb_detach(port);
    dev->attached--;
    return 0;
}

int usb_device_delete_addr(int busnr, int addr)
{
    USBBus *bus;
    USBPort *port;
    USBDevice *dev;

    bus = usb_bus_find(busnr);
    if (!bus)
        return -1;

    QTAILQ_FOREACH(port, &bus->used, next) {
        if (port->dev->addr == addr)
            break;
    }
    if (!port)
        return -1;
    dev = port->dev;

    qdev_free(&dev->qdev);
    return 0;
}

static const char *usb_speed(unsigned int speed)
{
    static const char *txt[] = {
        [ USB_SPEED_LOW  ] = "1.5",
        [ USB_SPEED_FULL ] = "12",
        [ USB_SPEED_HIGH ] = "480",
        [ USB_SPEED_SUPER ] = "5000",
    };
    if (speed >= ARRAY_SIZE(txt))
        return "?";
    return txt[speed];
}

static void usb_bus_dev_print(Monitor *mon, DeviceState *qdev, int indent)
{
    USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
    USBBus *bus = usb_bus_from_device(dev);

    monitor_printf(mon, "%*saddr %d.%d, port %s, speed %s, name %s%s\n",
                   indent, "", bus->busnr, dev->addr,
                   dev->port ? dev->port->path : "-",
                   usb_speed(dev->speed), dev->product_desc,
                   dev->attached ? ", attached" : "");
}

static char *usb_get_dev_path(DeviceState *qdev)
{
    USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
    return g_strdup(dev->port->path);
}

static char *usb_get_fw_dev_path(DeviceState *qdev)
{
    USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
    char *fw_path, *in;
    ssize_t pos = 0, fw_len;
    long nr;

    fw_len = 32 + strlen(dev->port->path) * 6;
    fw_path = g_malloc(fw_len);
    in = dev->port->path;
    while (fw_len - pos > 0) {
        nr = strtol(in, &in, 10);
        if (in[0] == '.') {
            /* some hub between root port and device */
            pos += snprintf(fw_path + pos, fw_len - pos, "hub@%ld/", nr);
            in++;
        } else {
            /* the device itself */
            pos += snprintf(fw_path + pos, fw_len - pos, "%s@%ld",
                            qdev_fw_name(qdev), nr);
            break;
        }
    }
    return fw_path;
}

void usb_info(Monitor *mon)
{
    USBBus *bus;
    USBDevice *dev;
    USBPort *port;

    if (QTAILQ_EMPTY(&busses)) {
        monitor_printf(mon, "USB support not enabled\n");
        return;
    }

    QTAILQ_FOREACH(bus, &busses, next) {
        QTAILQ_FOREACH(port, &bus->used, next) {
            dev = port->dev;
            if (!dev)
                continue;
            monitor_printf(mon, "  Device %d.%d, Port %s, Speed %s Mb/s, Product %s\n",
                           bus->busnr, dev->addr, port->path, usb_speed(dev->speed),
                           dev->product_desc);
        }
    }
}

/* handle legacy -usbdevice cmd line option */
USBDevice *usbdevice_create(const char *cmdline)
{
    USBBus *bus = usb_bus_find(-1 /* any */);
    DeviceInfo *info;
    USBDeviceInfo *usb;
    char driver[32];
    const char *params;
    int len;

    params = strchr(cmdline,':');
    if (params) {
        params++;
        len = params - cmdline;
        if (len > sizeof(driver))
            len = sizeof(driver);
        pstrcpy(driver, len, cmdline);
    } else {
        params = "";
        pstrcpy(driver, sizeof(driver), cmdline);
    }

    for (info = device_info_list; info != NULL; info = info->next) {
        if (info->bus_info != &usb_bus_info)
            continue;
        usb = DO_UPCAST(USBDeviceInfo, qdev, info);
        if (usb->usbdevice_name == NULL)
            continue;
        if (strcmp(usb->usbdevice_name, driver) != 0)
            continue;
        break;
    }
    if (info == NULL) {
#if 0
        /* no error because some drivers are not converted (yet) */
        error_report("usbdevice %s not found", driver);
#endif
        return NULL;
    }

    if (!usb->usbdevice_init) {
        if (*params) {
            error_report("usbdevice %s accepts no params", driver);
            return NULL;
        }
        return usb_create_simple(bus, usb->qdev.name);
    }
    return usb->usbdevice_init(params);
}
Commit	Line	Data
806b6024 GH	1	#include "hw.h"
	2	#include "usb.h"
	3	#include "qdev.h"
a5d2f727 GH	4	#include "sysemu.h"
a5d2f727 GH	5	#include "monitor.h"
891fb2cd	6	#include "trace.h"
a5d2f727 GH	7
a5d2f727 GH	8	static void usb_bus_dev_print(Monitor mon, DeviceState qdev, int indent);
c7a2196a GH	9
c7a2196a GH	10	static char usb_get_dev_path(DeviceState dev);
70d31cb2	11	static char usb_get_fw_dev_path(DeviceState qdev);
f462141f	12	static int usb_qdev_exit(DeviceState *qdev);
806b6024 GH	13
806b6024 GH	14	static struct BusInfo usb_bus_info = {
a5d2f727 GH	15	.name = "USB",
	16	.size = sizeof(USBBus),
	17	.print_dev = usb_bus_dev_print,
c7a2196a	18	.get_dev_path = usb_get_dev_path,
70d31cb2	19	.get_fw_dev_path = usb_get_fw_dev_path,
5f69076b GH	20	.props = (Property[]) {
	21	DEFINE_PROP_STRING("port", USBDevice, port_path),
	22	DEFINE_PROP_END_OF_LIST()
	23	},
806b6024 GH	24	};
806b6024 GH	25	static int next_usb_bus = 0;
72cf2d4f	26	static QTAILQ_HEAD(, USBBus) busses = QTAILQ_HEAD_INITIALIZER(busses);
806b6024	27
c1ecb40a GH	28	const VMStateDescription vmstate_usb_device = {
	29	.name = "USBDevice",
	30	.version_id = 1,
	31	.minimum_version_id = 1,
	32	.fields = (VMStateField []) {
	33	VMSTATE_UINT8(addr, USBDevice),
	34	VMSTATE_INT32(state, USBDevice),
	35	VMSTATE_INT32(remote_wakeup, USBDevice),
	36	VMSTATE_INT32(setup_state, USBDevice),
	37	VMSTATE_INT32(setup_len, USBDevice),
	38	VMSTATE_INT32(setup_index, USBDevice),
	39	VMSTATE_UINT8_ARRAY(setup_buf, USBDevice, 8),
	40	VMSTATE_END_OF_LIST(),
	41	}
	42	};
	43
07771f6f	44	void usb_bus_new(USBBus bus, USBBusOps ops, DeviceState *host)
806b6024	45	{
b2317837	46	qbus_create_inplace(&bus->qbus, &usb_bus_info, host, NULL);
07771f6f	47	bus->ops = ops;
806b6024	48	bus->busnr = next_usb_bus++;
ef816d83	49	bus->qbus.allow_hotplug = 1; /* Yes, we can */
72cf2d4f BS	50	QTAILQ_INIT(&bus->free);
	51	QTAILQ_INIT(&bus->used);
	52	QTAILQ_INSERT_TAIL(&busses, bus, next);
806b6024 GH	53	}
	54
	55	USBBus *usb_bus_find(int busnr)
	56	{
	57	USBBus *bus;
	58
	59	if (-1 == busnr)
72cf2d4f BS	60	return QTAILQ_FIRST(&busses);
72cf2d4f BS	61	QTAILQ_FOREACH(bus, &busses, next) {
806b6024 GH	62	if (bus->busnr == busnr)
	63	return bus;
	64	}
	65	return NULL;
	66	}
	67
	68	static int usb_qdev_init(DeviceState qdev, DeviceInfo base)
	69	{
	70	USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
	71	USBDeviceInfo *info = DO_UPCAST(USBDeviceInfo, qdev, base);
	72	int rc;
	73
06384698	74	pstrcpy(dev->product_desc, sizeof(dev->product_desc), info->product_desc);
806b6024	75	dev->info = info;
61e094c0	76	dev->auto_attach = 1;
132a3f55	77	QLIST_INIT(&dev->strings);
d8e17efd	78	usb_ep_init(dev);
891fb2cd	79	rc = usb_claim_port(dev);
f462141f	80	if (rc != 0) {
db3a5ed7	81	return rc;
891fb2cd	82	}
f462141f GH	83	rc = dev->info->init(dev);
f462141f GH	84	if (rc != 0) {
db3a5ed7 SH	85	usb_release_port(dev);
db3a5ed7 SH	86	return rc;
f462141f GH	87	}
f462141f GH	88	if (dev->auto_attach) {
fa19bf83	89	rc = usb_device_attach(dev);
f462141f	90	if (rc != 0) {
db3a5ed7 SH	91	usb_qdev_exit(qdev);
db3a5ed7 SH	92	return rc;
f462141f	93	}
891fb2cd	94	}
f462141f	95	return 0;
806b6024 GH	96	}
806b6024 GH	97
a8e662b5 GH	98	static int usb_qdev_exit(DeviceState *qdev)
	99	{
	100	USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
	101
290a5c60 HG	102	if (dev->attached) {
	103	usb_device_detach(dev);
	104	}
a8e662b5 GH	105	if (dev->info->handle_destroy) {
	106	dev->info->handle_destroy(dev);
	107	}
891fb2cd GH	108	if (dev->port) {
	109	usb_release_port(dev);
	110	}
a8e662b5 GH	111	return 0;
	112	}
	113
806b6024 GH	114	void usb_qdev_register(USBDeviceInfo *info)
	115	{
	116	info->qdev.bus_info = &usb_bus_info;
	117	info->qdev.init = usb_qdev_init;
ef816d83	118	info->qdev.unplug = qdev_simple_unplug_cb;
a8e662b5	119	info->qdev.exit = usb_qdev_exit;
806b6024 GH	120	qdev_register(&info->qdev);
	121	}
	122
	123	void usb_qdev_register_many(USBDeviceInfo *info)
	124	{
	125	while (info->qdev.name) {
	126	usb_qdev_register(info);
	127	info++;
	128	}
	129	}
	130
a5d2f727	131	USBDevice usb_create(USBBus bus, const char *name)
806b6024 GH	132	{
	133	DeviceState *dev;
	134
	135	#if 1
	136	/* temporary stopgap until all usb is properly qdev-ified */
	137	if (!bus) {
	138	bus = usb_bus_find(-1);
	139	if (!bus)
	140	return NULL;
be62a2eb	141	error_report("%s: no bus specified, using \"%s\" for \"%s\"",
806b6024 GH	142	__FUNCTION__, bus->qbus.name, name);
	143	}
	144	#endif
	145
	146	dev = qdev_create(&bus->qbus, name);
806b6024 GH	147	return DO_UPCAST(USBDevice, qdev, dev);
806b6024 GH	148	}
a5d2f727 GH	149
	150	USBDevice usb_create_simple(USBBus bus, const char *name)
	151	{
	152	USBDevice *dev = usb_create(bus, name);
2af2a1b8 GH	153	int rc;
2af2a1b8 GH	154
d44168ff	155	if (!dev) {
be62a2eb	156	error_report("Failed to create USB device '%s'", name);
2af2a1b8 GH	157	return NULL;
	158	}
	159	rc = qdev_init(&dev->qdev);
	160	if (rc < 0) {
be62a2eb	161	error_report("Failed to initialize USB device '%s'", name);
2af2a1b8	162	return NULL;
d44168ff	163	}
a5d2f727 GH	164	return dev;
	165	}
	166
090ac642 HG	167	static void usb_fill_port(USBPort port, void opaque, int index,
090ac642 HG	168	USBPortOps *ops, int speedmask)
a5d2f727	169	{
0d86d2be GH	170	port->opaque = opaque;
	171	port->index = index;
	172	port->ops = ops;
843d4e0c	173	port->speedmask = speedmask;
3631e6c8	174	usb_port_location(port, NULL, index + 1);
090ac642 HG	175	}
	176
	177	void usb_register_port(USBBus bus, USBPort port, void *opaque, int index,
	178	USBPortOps *ops, int speedmask)
	179	{
	180	usb_fill_port(port, opaque, index, ops, speedmask);
72cf2d4f	181	QTAILQ_INSERT_TAIL(&bus->free, port, next);
a5d2f727 GH	182	bus->nfree++;
	183	}
	184
ae60fea9 HG	185	int usb_register_companion(const char masterbus, USBPort ports[],
	186	uint32_t portcount, uint32_t firstport,
	187	void opaque, USBPortOps ops, int speedmask)
	188	{
	189	USBBus *bus;
	190	int i;
	191
	192	QTAILQ_FOREACH(bus, &busses, next) {
	193	if (strcmp(bus->qbus.name, masterbus) == 0) {
	194	break;
	195	}
	196	}
	197
	198	if (!bus \|\| !bus->ops->register_companion) {
	199	qerror_report(QERR_INVALID_PARAMETER_VALUE, "masterbus",
	200	"an USB masterbus");
	201	if (bus) {
	202	error_printf_unless_qmp(
	203	"USB bus '%s' does not allow companion controllers\n",
	204	masterbus);
	205	}
	206	return -1;
	207	}
	208
	209	for (i = 0; i < portcount; i++) {
	210	usb_fill_port(ports[i], opaque, i, ops, speedmask);
	211	}
	212
	213	return bus->ops->register_companion(bus, ports, portcount, firstport);
	214	}
	215
c7a2196a GH	216	void usb_port_location(USBPort downstream, USBPort upstream, int portnr)
	217	{
	218	if (upstream) {
	219	snprintf(downstream->path, sizeof(downstream->path), "%s.%d",
	220	upstream->path, portnr);
	221	} else {
	222	snprintf(downstream->path, sizeof(downstream->path), "%d", portnr);
	223	}
	224	}
	225
a8e662b5 GH	226	void usb_unregister_port(USBBus bus, USBPort port)
	227	{
	228	if (port->dev)
	229	qdev_free(&port->dev->qdev);
	230	QTAILQ_REMOVE(&bus->free, port, next);
	231	bus->nfree--;
	232	}
	233
891fb2cd	234	int usb_claim_port(USBDevice *dev)
a5d2f727 GH	235	{
	236	USBBus *bus = usb_bus_from_device(dev);
	237	USBPort *port;
	238
891fb2cd GH	239	assert(dev->port == NULL);
891fb2cd GH	240
5f69076b GH	241	if (dev->port_path) {
	242	QTAILQ_FOREACH(port, &bus->free, next) {
	243	if (strcmp(port->path, dev->port_path) == 0) {
	244	break;
	245	}
	246	}
	247	if (port == NULL) {
be62a2eb	248	error_report("Error: usb port %s (bus %s) not found (in use?)",
891fb2cd	249	dev->port_path, bus->qbus.name);
fa19bf83	250	return -1;
5f69076b GH	251	}
5f69076b GH	252	} else {
f79f2bfc	253	if (bus->nfree == 1 && strcmp(object_get_typename(OBJECT(dev)), "usb-hub") != 0) {
891fb2cd GH	254	/* Create a new hub and chain it on */
	255	usb_create_simple(bus, "usb-hub");
	256	}
	257	if (bus->nfree == 0) {
	258	error_report("Error: tried to attach usb device %s to a bus "
be62a2eb	259	"with no free ports", dev->product_desc);
891fb2cd GH	260	return -1;
891fb2cd GH	261	}
5f69076b GH	262	port = QTAILQ_FIRST(&bus->free);
5f69076b GH	263	}
891fb2cd	264	trace_usb_port_claim(bus->busnr, port->path);
a5d2f727	265
72cf2d4f	266	QTAILQ_REMOVE(&bus->free, port, next);
a5d2f727 GH	267	bus->nfree--;
a5d2f727 GH	268
891fb2cd GH	269	dev->port = port;
891fb2cd GH	270	port->dev = dev;
a5d2f727	271
72cf2d4f	272	QTAILQ_INSERT_TAIL(&bus->used, port, next);
a5d2f727	273	bus->nused++;
fa19bf83	274	return 0;
a5d2f727 GH	275	}
a5d2f727 GH	276
891fb2cd	277	void usb_release_port(USBDevice *dev)
a5d2f727 GH	278	{
a5d2f727 GH	279	USBBus *bus = usb_bus_from_device(dev);
891fb2cd	280	USBPort *port = dev->port;
a5d2f727	281
891fb2cd GH	282	assert(port != NULL);
	283	trace_usb_port_release(bus->busnr, port->path);
	284
	285	QTAILQ_REMOVE(&bus->used, port, next);
	286	bus->nused--;
	287
	288	dev->port = NULL;
	289	port->dev = NULL;
	290
	291	QTAILQ_INSERT_TAIL(&bus->free, port, next);
	292	bus->nfree++;
a5d2f727 GH	293	}
a5d2f727 GH	294
891fb2cd	295	int usb_device_attach(USBDevice *dev)
a8e662b5 GH	296	{
a8e662b5 GH	297	USBBus *bus = usb_bus_from_device(dev);
891fb2cd	298	USBPort *port = dev->port;
a8e662b5	299
891fb2cd GH	300	assert(port != NULL);
	301	assert(!dev->attached);
	302	trace_usb_port_attach(bus->busnr, port->path);
	303
	304	if (!(port->speedmask & dev->speedmask)) {
	305	error_report("Warning: speed mismatch trying to attach "
be62a2eb	306	"usb device %s to bus %s",
891fb2cd	307	dev->product_desc, bus->qbus.name);
a8e662b5 GH	308	return -1;
a8e662b5 GH	309	}
a8e662b5	310
891fb2cd GH	311	dev->attached++;
891fb2cd GH	312	usb_attach(port);
a8e662b5	313
891fb2cd GH	314	return 0;
	315	}
	316
	317	int usb_device_detach(USBDevice *dev)
	318	{
	319	USBBus *bus = usb_bus_from_device(dev);
	320	USBPort *port = dev->port;
a8e662b5	321
891fb2cd GH	322	assert(port != NULL);
	323	assert(dev->attached);
	324	trace_usb_port_detach(bus->busnr, port->path);
a8e662b5	325
891fb2cd GH	326	usb_detach(port);
891fb2cd GH	327	dev->attached--;
a8e662b5 GH	328	return 0;
	329	}
	330
a5d2f727 GH	331	int usb_device_delete_addr(int busnr, int addr)
	332	{
	333	USBBus *bus;
	334	USBPort *port;
	335	USBDevice *dev;
	336
	337	bus = usb_bus_find(busnr);
	338	if (!bus)
	339	return -1;
	340
72cf2d4f	341	QTAILQ_FOREACH(port, &bus->used, next) {
a5d2f727 GH	342	if (port->dev->addr == addr)
	343	break;
	344	}
	345	if (!port)
	346	return -1;
a5d2f727	347	dev = port->dev;
a5d2f727	348
a8e662b5	349	qdev_free(&dev->qdev);
a5d2f727 GH	350	return 0;
	351	}
	352
	353	static const char *usb_speed(unsigned int speed)
	354	{
	355	static const char *txt[] = {
	356	[ USB_SPEED_LOW ] = "1.5",
	357	[ USB_SPEED_FULL ] = "12",
	358	[ USB_SPEED_HIGH ] = "480",
290d26d2	359	[ USB_SPEED_SUPER ] = "5000",
a5d2f727 GH	360	};
	361	if (speed >= ARRAY_SIZE(txt))
	362	return "?";
	363	return txt[speed];
	364	}
	365
	366	static void usb_bus_dev_print(Monitor mon, DeviceState qdev, int indent)
	367	{
	368	USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
	369	USBBus *bus = usb_bus_from_device(dev);
	370
c7a2196a	371	monitor_printf(mon, "%*saddr %d.%d, port %s, speed %s, name %s%s\n",
66a6593a	372	indent, "", bus->busnr, dev->addr,
c7a2196a	373	dev->port ? dev->port->path : "-",
0fe6d12e	374	usb_speed(dev->speed), dev->product_desc,
66a6593a	375	dev->attached ? ", attached" : "");
a5d2f727 GH	376	}
a5d2f727 GH	377
c7a2196a GH	378	static char usb_get_dev_path(DeviceState qdev)
	379	{
	380	USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
7267c094	381	return g_strdup(dev->port->path);
c7a2196a GH	382	}
c7a2196a GH	383
70d31cb2 GH	384	static char usb_get_fw_dev_path(DeviceState qdev)
	385	{
	386	USBDevice *dev = DO_UPCAST(USBDevice, qdev, qdev);
	387	char fw_path, in;
ea87e95f	388	ssize_t pos = 0, fw_len;
70d31cb2 GH	389	long nr;
70d31cb2 GH	390
ea87e95f	391	fw_len = 32 + strlen(dev->port->path) * 6;
7267c094	392	fw_path = g_malloc(fw_len);
70d31cb2	393	in = dev->port->path;
ea87e95f	394	while (fw_len - pos > 0) {
70d31cb2 GH	395	nr = strtol(in, &in, 10);
	396	if (in[0] == '.') {
	397	/* some hub between root port and device */
ea87e95f	398	pos += snprintf(fw_path + pos, fw_len - pos, "hub@%ld/", nr);
70d31cb2 GH	399	in++;
	400	} else {
	401	/* the device itself */
ea87e95f BS	402	pos += snprintf(fw_path + pos, fw_len - pos, "%s@%ld",
ea87e95f BS	403	qdev_fw_name(qdev), nr);
70d31cb2 GH	404	break;
	405	}
	406	}
	407	return fw_path;
	408	}
	409
a5d2f727 GH	410	void usb_info(Monitor *mon)
	411	{
	412	USBBus *bus;
	413	USBDevice *dev;
	414	USBPort *port;
	415
72cf2d4f	416	if (QTAILQ_EMPTY(&busses)) {
a5d2f727 GH	417	monitor_printf(mon, "USB support not enabled\n");
	418	return;
	419	}
	420
72cf2d4f BS	421	QTAILQ_FOREACH(bus, &busses, next) {
72cf2d4f BS	422	QTAILQ_FOREACH(port, &bus->used, next) {
a5d2f727 GH	423	dev = port->dev;
	424	if (!dev)
	425	continue;
c7a2196a GH	426	monitor_printf(mon, " Device %d.%d, Port %s, Speed %s Mb/s, Product %s\n",
c7a2196a GH	427	bus->busnr, dev->addr, port->path, usb_speed(dev->speed),
0fe6d12e	428	dev->product_desc);
a5d2f727 GH	429	}
	430	}
	431	}
	432
0958b4cc GH	433	/* handle legacy -usbdevice cmd line option */
	434	USBDevice usbdevice_create(const char cmdline)
	435	{
	436	USBBus bus = usb_bus_find(-1 / any */);
	437	DeviceInfo *info;
	438	USBDeviceInfo *usb;
702f3e0f JK	439	char driver[32];
702f3e0f JK	440	const char *params;
0958b4cc GH	441	int len;
	442
	443	params = strchr(cmdline,':');
	444	if (params) {
	445	params++;
	446	len = params - cmdline;
	447	if (len > sizeof(driver))
	448	len = sizeof(driver);
	449	pstrcpy(driver, len, cmdline);
	450	} else {
702f3e0f	451	params = "";
0958b4cc GH	452	pstrcpy(driver, sizeof(driver), cmdline);
	453	}
	454
	455	for (info = device_info_list; info != NULL; info = info->next) {
	456	if (info->bus_info != &usb_bus_info)
	457	continue;
	458	usb = DO_UPCAST(USBDeviceInfo, qdev, info);
	459	if (usb->usbdevice_name == NULL)
	460	continue;
	461	if (strcmp(usb->usbdevice_name, driver) != 0)
	462	continue;
	463	break;
	464	}
	465	if (info == NULL) {
	466	#if 0
	467	/* no error because some drivers are not converted (yet) */
1ecda02b	468	error_report("usbdevice %s not found", driver);
0958b4cc GH	469	#endif
	470	return NULL;
	471	}
	472
	473	if (!usb->usbdevice_init) {
98f22dc1	474	if (*params) {
1ecda02b	475	error_report("usbdevice %s accepts no params", driver);
0958b4cc GH	476	return NULL;
	477	}
	478	return usb_create_simple(bus, usb->qdev.name);
	479	}
	480	return usb->usbdevice_init(params);
	481	}