542 lines
15 KiB
C
542 lines
15 KiB
C
/*
|
|
* QEMU USB HUB emulation
|
|
*
|
|
* Copyright (c) 2005 Fabrice Bellard
|
|
*
|
|
* Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
* of this software and associated documentation files (the "Software"), to deal
|
|
* in the Software without restriction, including without limitation the rights
|
|
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
* copies of the Software, and to permit persons to whom the Software is
|
|
* furnished to do so, subject to the following conditions:
|
|
*
|
|
* The above copyright notice and this permission notice shall be included in
|
|
* all copies or substantial portions of the Software.
|
|
*
|
|
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
|
* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
* THE SOFTWARE.
|
|
*/
|
|
#include "qemu-common.h"
|
|
#include "usb.h"
|
|
#include "usb-desc.h"
|
|
|
|
//#define DEBUG
|
|
|
|
#define NUM_PORTS 8
|
|
|
|
typedef struct USBHubPort {
|
|
USBPort port;
|
|
uint16_t wPortStatus;
|
|
uint16_t wPortChange;
|
|
} USBHubPort;
|
|
|
|
typedef struct USBHubState {
|
|
USBDevice dev;
|
|
USBHubPort ports[NUM_PORTS];
|
|
} USBHubState;
|
|
|
|
#define ClearHubFeature (0x2000 | USB_REQ_CLEAR_FEATURE)
|
|
#define ClearPortFeature (0x2300 | USB_REQ_CLEAR_FEATURE)
|
|
#define GetHubDescriptor (0xa000 | USB_REQ_GET_DESCRIPTOR)
|
|
#define GetHubStatus (0xa000 | USB_REQ_GET_STATUS)
|
|
#define GetPortStatus (0xa300 | USB_REQ_GET_STATUS)
|
|
#define SetHubFeature (0x2000 | USB_REQ_SET_FEATURE)
|
|
#define SetPortFeature (0x2300 | USB_REQ_SET_FEATURE)
|
|
|
|
#define PORT_STAT_CONNECTION 0x0001
|
|
#define PORT_STAT_ENABLE 0x0002
|
|
#define PORT_STAT_SUSPEND 0x0004
|
|
#define PORT_STAT_OVERCURRENT 0x0008
|
|
#define PORT_STAT_RESET 0x0010
|
|
#define PORT_STAT_POWER 0x0100
|
|
#define PORT_STAT_LOW_SPEED 0x0200
|
|
#define PORT_STAT_HIGH_SPEED 0x0400
|
|
#define PORT_STAT_TEST 0x0800
|
|
#define PORT_STAT_INDICATOR 0x1000
|
|
|
|
#define PORT_STAT_C_CONNECTION 0x0001
|
|
#define PORT_STAT_C_ENABLE 0x0002
|
|
#define PORT_STAT_C_SUSPEND 0x0004
|
|
#define PORT_STAT_C_OVERCURRENT 0x0008
|
|
#define PORT_STAT_C_RESET 0x0010
|
|
|
|
#define PORT_CONNECTION 0
|
|
#define PORT_ENABLE 1
|
|
#define PORT_SUSPEND 2
|
|
#define PORT_OVERCURRENT 3
|
|
#define PORT_RESET 4
|
|
#define PORT_POWER 8
|
|
#define PORT_LOWSPEED 9
|
|
#define PORT_HIGHSPEED 10
|
|
#define PORT_C_CONNECTION 16
|
|
#define PORT_C_ENABLE 17
|
|
#define PORT_C_SUSPEND 18
|
|
#define PORT_C_OVERCURRENT 19
|
|
#define PORT_C_RESET 20
|
|
#define PORT_TEST 21
|
|
#define PORT_INDICATOR 22
|
|
|
|
/* same as Linux kernel root hubs */
|
|
|
|
enum {
|
|
STR_MANUFACTURER = 1,
|
|
STR_PRODUCT,
|
|
STR_SERIALNUMBER,
|
|
};
|
|
|
|
static const USBDescStrings desc_strings = {
|
|
[STR_MANUFACTURER] = "QEMU " QEMU_VERSION,
|
|
[STR_PRODUCT] = "QEMU USB Hub",
|
|
[STR_SERIALNUMBER] = "314159",
|
|
};
|
|
|
|
static const USBDescIface desc_iface_hub = {
|
|
.bInterfaceNumber = 0,
|
|
.bNumEndpoints = 1,
|
|
.bInterfaceClass = USB_CLASS_HUB,
|
|
.eps = (USBDescEndpoint[]) {
|
|
{
|
|
.bEndpointAddress = USB_DIR_IN | 0x01,
|
|
.bmAttributes = USB_ENDPOINT_XFER_INT,
|
|
.wMaxPacketSize = 1 + (NUM_PORTS + 7) / 8,
|
|
.bInterval = 0xff,
|
|
},
|
|
}
|
|
};
|
|
|
|
static const USBDescDevice desc_device_hub = {
|
|
.bcdUSB = 0x0110,
|
|
.bDeviceClass = USB_CLASS_HUB,
|
|
.bMaxPacketSize0 = 8,
|
|
.bNumConfigurations = 1,
|
|
.confs = (USBDescConfig[]) {
|
|
{
|
|
.bNumInterfaces = 1,
|
|
.bConfigurationValue = 1,
|
|
.bmAttributes = 0xe0,
|
|
.nif = 1,
|
|
.ifs = &desc_iface_hub,
|
|
},
|
|
},
|
|
};
|
|
|
|
static const USBDesc desc_hub = {
|
|
.id = {
|
|
.idVendor = 0,
|
|
.idProduct = 0,
|
|
.bcdDevice = 0x0101,
|
|
.iManufacturer = STR_MANUFACTURER,
|
|
.iProduct = STR_PRODUCT,
|
|
.iSerialNumber = STR_SERIALNUMBER,
|
|
},
|
|
.full = &desc_device_hub,
|
|
.str = desc_strings,
|
|
};
|
|
|
|
static const uint8_t qemu_hub_hub_descriptor[] =
|
|
{
|
|
0x00, /* u8 bLength; patched in later */
|
|
0x29, /* u8 bDescriptorType; Hub-descriptor */
|
|
0x00, /* u8 bNbrPorts; (patched later) */
|
|
0x0a, /* u16 wHubCharacteristics; */
|
|
0x00, /* (per-port OC, no power switching) */
|
|
0x01, /* u8 bPwrOn2pwrGood; 2ms */
|
|
0x00 /* u8 bHubContrCurrent; 0 mA */
|
|
|
|
/* DeviceRemovable and PortPwrCtrlMask patched in later */
|
|
};
|
|
|
|
static void usb_hub_attach(USBPort *port1)
|
|
{
|
|
USBHubState *s = port1->opaque;
|
|
USBHubPort *port = &s->ports[port1->index];
|
|
|
|
port->wPortStatus |= PORT_STAT_CONNECTION;
|
|
port->wPortChange |= PORT_STAT_C_CONNECTION;
|
|
if (port->port.dev->speed == USB_SPEED_LOW) {
|
|
port->wPortStatus |= PORT_STAT_LOW_SPEED;
|
|
} else {
|
|
port->wPortStatus &= ~PORT_STAT_LOW_SPEED;
|
|
}
|
|
}
|
|
|
|
static void usb_hub_detach(USBPort *port1)
|
|
{
|
|
USBHubState *s = port1->opaque;
|
|
USBHubPort *port = &s->ports[port1->index];
|
|
|
|
/* Let upstream know the device on this port is gone */
|
|
s->dev.port->ops->child_detach(s->dev.port, port1->dev);
|
|
|
|
port->wPortStatus &= ~PORT_STAT_CONNECTION;
|
|
port->wPortChange |= PORT_STAT_C_CONNECTION;
|
|
if (port->wPortStatus & PORT_STAT_ENABLE) {
|
|
port->wPortStatus &= ~PORT_STAT_ENABLE;
|
|
port->wPortChange |= PORT_STAT_C_ENABLE;
|
|
}
|
|
}
|
|
|
|
static void usb_hub_child_detach(USBPort *port1, USBDevice *child)
|
|
{
|
|
USBHubState *s = port1->opaque;
|
|
|
|
/* Pass along upstream */
|
|
s->dev.port->ops->child_detach(s->dev.port, child);
|
|
}
|
|
|
|
static void usb_hub_wakeup(USBPort *port1)
|
|
{
|
|
USBHubState *s = port1->opaque;
|
|
USBHubPort *port = &s->ports[port1->index];
|
|
|
|
if (port->wPortStatus & PORT_STAT_SUSPEND) {
|
|
port->wPortChange |= PORT_STAT_C_SUSPEND;
|
|
usb_wakeup(&s->dev);
|
|
}
|
|
}
|
|
|
|
static void usb_hub_complete(USBPort *port, USBPacket *packet)
|
|
{
|
|
USBHubState *s = port->opaque;
|
|
|
|
/*
|
|
* Just pass it along upstream for now.
|
|
*
|
|
* If we ever inplement usb 2.0 split transactions this will
|
|
* become a little more complicated ...
|
|
*/
|
|
usb_packet_complete(&s->dev, packet);
|
|
}
|
|
|
|
static void usb_hub_handle_reset(USBDevice *dev)
|
|
{
|
|
/* XXX: do it */
|
|
}
|
|
|
|
static int usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
|
int request, int value, int index, int length, uint8_t *data)
|
|
{
|
|
USBHubState *s = (USBHubState *)dev;
|
|
int ret;
|
|
|
|
ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
|
|
if (ret >= 0) {
|
|
return ret;
|
|
}
|
|
|
|
switch(request) {
|
|
case EndpointOutRequest | USB_REQ_CLEAR_FEATURE:
|
|
if (value == 0 && index != 0x81) { /* clear ep halt */
|
|
goto fail;
|
|
}
|
|
ret = 0;
|
|
break;
|
|
case DeviceRequest | USB_REQ_GET_INTERFACE:
|
|
data[0] = 0;
|
|
ret = 1;
|
|
break;
|
|
case DeviceOutRequest | USB_REQ_SET_INTERFACE:
|
|
ret = 0;
|
|
break;
|
|
/* usb specific requests */
|
|
case GetHubStatus:
|
|
data[0] = 0;
|
|
data[1] = 0;
|
|
data[2] = 0;
|
|
data[3] = 0;
|
|
ret = 4;
|
|
break;
|
|
case GetPortStatus:
|
|
{
|
|
unsigned int n = index - 1;
|
|
USBHubPort *port;
|
|
if (n >= NUM_PORTS) {
|
|
goto fail;
|
|
}
|
|
port = &s->ports[n];
|
|
data[0] = port->wPortStatus;
|
|
data[1] = port->wPortStatus >> 8;
|
|
data[2] = port->wPortChange;
|
|
data[3] = port->wPortChange >> 8;
|
|
ret = 4;
|
|
}
|
|
break;
|
|
case SetHubFeature:
|
|
case ClearHubFeature:
|
|
if (value == 0 || value == 1) {
|
|
} else {
|
|
goto fail;
|
|
}
|
|
ret = 0;
|
|
break;
|
|
case SetPortFeature:
|
|
{
|
|
unsigned int n = index - 1;
|
|
USBHubPort *port;
|
|
USBDevice *dev;
|
|
if (n >= NUM_PORTS) {
|
|
goto fail;
|
|
}
|
|
port = &s->ports[n];
|
|
dev = port->port.dev;
|
|
switch(value) {
|
|
case PORT_SUSPEND:
|
|
port->wPortStatus |= PORT_STAT_SUSPEND;
|
|
break;
|
|
case PORT_RESET:
|
|
if (dev) {
|
|
usb_send_msg(dev, USB_MSG_RESET);
|
|
port->wPortChange |= PORT_STAT_C_RESET;
|
|
/* set enable bit */
|
|
port->wPortStatus |= PORT_STAT_ENABLE;
|
|
}
|
|
break;
|
|
case PORT_POWER:
|
|
break;
|
|
default:
|
|
goto fail;
|
|
}
|
|
ret = 0;
|
|
}
|
|
break;
|
|
case ClearPortFeature:
|
|
{
|
|
unsigned int n = index - 1;
|
|
USBHubPort *port;
|
|
|
|
if (n >= NUM_PORTS) {
|
|
goto fail;
|
|
}
|
|
port = &s->ports[n];
|
|
switch(value) {
|
|
case PORT_ENABLE:
|
|
port->wPortStatus &= ~PORT_STAT_ENABLE;
|
|
break;
|
|
case PORT_C_ENABLE:
|
|
port->wPortChange &= ~PORT_STAT_C_ENABLE;
|
|
break;
|
|
case PORT_SUSPEND:
|
|
port->wPortStatus &= ~PORT_STAT_SUSPEND;
|
|
break;
|
|
case PORT_C_SUSPEND:
|
|
port->wPortChange &= ~PORT_STAT_C_SUSPEND;
|
|
break;
|
|
case PORT_C_CONNECTION:
|
|
port->wPortChange &= ~PORT_STAT_C_CONNECTION;
|
|
break;
|
|
case PORT_C_OVERCURRENT:
|
|
port->wPortChange &= ~PORT_STAT_C_OVERCURRENT;
|
|
break;
|
|
case PORT_C_RESET:
|
|
port->wPortChange &= ~PORT_STAT_C_RESET;
|
|
break;
|
|
default:
|
|
goto fail;
|
|
}
|
|
ret = 0;
|
|
}
|
|
break;
|
|
case GetHubDescriptor:
|
|
{
|
|
unsigned int n, limit, var_hub_size = 0;
|
|
memcpy(data, qemu_hub_hub_descriptor,
|
|
sizeof(qemu_hub_hub_descriptor));
|
|
data[2] = NUM_PORTS;
|
|
|
|
/* fill DeviceRemovable bits */
|
|
limit = ((NUM_PORTS + 1 + 7) / 8) + 7;
|
|
for (n = 7; n < limit; n++) {
|
|
data[n] = 0x00;
|
|
var_hub_size++;
|
|
}
|
|
|
|
/* fill PortPwrCtrlMask bits */
|
|
limit = limit + ((NUM_PORTS + 7) / 8);
|
|
for (;n < limit; n++) {
|
|
data[n] = 0xff;
|
|
var_hub_size++;
|
|
}
|
|
|
|
ret = sizeof(qemu_hub_hub_descriptor) + var_hub_size;
|
|
data[0] = ret;
|
|
break;
|
|
}
|
|
default:
|
|
fail:
|
|
ret = USB_RET_STALL;
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int usb_hub_handle_data(USBDevice *dev, USBPacket *p)
|
|
{
|
|
USBHubState *s = (USBHubState *)dev;
|
|
int ret;
|
|
|
|
switch(p->pid) {
|
|
case USB_TOKEN_IN:
|
|
if (p->devep == 1) {
|
|
USBHubPort *port;
|
|
unsigned int status;
|
|
uint8_t buf[4];
|
|
int i, n;
|
|
n = (NUM_PORTS + 1 + 7) / 8;
|
|
if (p->iov.size == 1) { /* FreeBSD workaround */
|
|
n = 1;
|
|
} else if (n > p->iov.size) {
|
|
return USB_RET_BABBLE;
|
|
}
|
|
status = 0;
|
|
for(i = 0; i < NUM_PORTS; i++) {
|
|
port = &s->ports[i];
|
|
if (port->wPortChange)
|
|
status |= (1 << (i + 1));
|
|
}
|
|
if (status != 0) {
|
|
for(i = 0; i < n; i++) {
|
|
buf[i] = status >> (8 * i);
|
|
}
|
|
usb_packet_copy(p, buf, n);
|
|
ret = n;
|
|
} else {
|
|
ret = USB_RET_NAK; /* usb11 11.13.1 */
|
|
}
|
|
} else {
|
|
goto fail;
|
|
}
|
|
break;
|
|
case USB_TOKEN_OUT:
|
|
default:
|
|
fail:
|
|
ret = USB_RET_STALL;
|
|
break;
|
|
}
|
|
return ret;
|
|
}
|
|
|
|
static int usb_hub_broadcast_packet(USBHubState *s, USBPacket *p)
|
|
{
|
|
USBHubPort *port;
|
|
USBDevice *dev;
|
|
int i, ret;
|
|
|
|
for(i = 0; i < NUM_PORTS; i++) {
|
|
port = &s->ports[i];
|
|
dev = port->port.dev;
|
|
if (dev && (port->wPortStatus & PORT_STAT_ENABLE)) {
|
|
ret = usb_handle_packet(dev, p);
|
|
if (ret != USB_RET_NODEV) {
|
|
return ret;
|
|
}
|
|
}
|
|
}
|
|
return USB_RET_NODEV;
|
|
}
|
|
|
|
static int usb_hub_handle_packet(USBDevice *dev, USBPacket *p)
|
|
{
|
|
USBHubState *s = (USBHubState *)dev;
|
|
|
|
#if defined(DEBUG) && 0
|
|
printf("usb_hub: pid=0x%x\n", pid);
|
|
#endif
|
|
if (dev->state == USB_STATE_DEFAULT &&
|
|
dev->addr != 0 &&
|
|
p->devaddr != dev->addr &&
|
|
(p->pid == USB_TOKEN_SETUP ||
|
|
p->pid == USB_TOKEN_OUT ||
|
|
p->pid == USB_TOKEN_IN)) {
|
|
/* broadcast the packet to the devices */
|
|
return usb_hub_broadcast_packet(s, p);
|
|
}
|
|
return usb_generic_handle_packet(dev, p);
|
|
}
|
|
|
|
static void usb_hub_handle_destroy(USBDevice *dev)
|
|
{
|
|
USBHubState *s = (USBHubState *)dev;
|
|
int i;
|
|
|
|
for (i = 0; i < NUM_PORTS; i++) {
|
|
usb_unregister_port(usb_bus_from_device(dev),
|
|
&s->ports[i].port);
|
|
}
|
|
}
|
|
|
|
static USBPortOps usb_hub_port_ops = {
|
|
.attach = usb_hub_attach,
|
|
.detach = usb_hub_detach,
|
|
.child_detach = usb_hub_child_detach,
|
|
.wakeup = usb_hub_wakeup,
|
|
.complete = usb_hub_complete,
|
|
};
|
|
|
|
static int usb_hub_initfn(USBDevice *dev)
|
|
{
|
|
USBHubState *s = DO_UPCAST(USBHubState, dev, dev);
|
|
USBHubPort *port;
|
|
int i;
|
|
|
|
usb_desc_init(dev);
|
|
for (i = 0; i < NUM_PORTS; i++) {
|
|
port = &s->ports[i];
|
|
usb_register_port(usb_bus_from_device(dev),
|
|
&port->port, s, i, &usb_hub_port_ops,
|
|
USB_SPEED_MASK_LOW | USB_SPEED_MASK_FULL);
|
|
usb_port_location(&port->port, dev->port, i+1);
|
|
port->wPortStatus = PORT_STAT_POWER;
|
|
port->wPortChange = 0;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static const VMStateDescription vmstate_usb_hub_port = {
|
|
.name = "usb-hub-port",
|
|
.version_id = 1,
|
|
.minimum_version_id = 1,
|
|
.fields = (VMStateField []) {
|
|
VMSTATE_UINT16(wPortStatus, USBHubPort),
|
|
VMSTATE_UINT16(wPortChange, USBHubPort),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
static const VMStateDescription vmstate_usb_hub = {
|
|
.name = "usb-hub",
|
|
.version_id = 1,
|
|
.minimum_version_id = 1,
|
|
.fields = (VMStateField []) {
|
|
VMSTATE_USB_DEVICE(dev, USBHubState),
|
|
VMSTATE_STRUCT_ARRAY(ports, USBHubState, NUM_PORTS, 0,
|
|
vmstate_usb_hub_port, USBHubPort),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
static struct USBDeviceInfo hub_info = {
|
|
.product_desc = "QEMU USB Hub",
|
|
.qdev.name = "usb-hub",
|
|
.qdev.fw_name = "hub",
|
|
.qdev.size = sizeof(USBHubState),
|
|
.qdev.vmsd = &vmstate_usb_hub,
|
|
.usb_desc = &desc_hub,
|
|
.init = usb_hub_initfn,
|
|
.handle_packet = usb_hub_handle_packet,
|
|
.handle_reset = usb_hub_handle_reset,
|
|
.handle_control = usb_hub_handle_control,
|
|
.handle_data = usb_hub_handle_data,
|
|
.handle_destroy = usb_hub_handle_destroy,
|
|
};
|
|
|
|
static void usb_hub_register_devices(void)
|
|
{
|
|
usb_qdev_register(&hub_info);
|
|
}
|
|
device_init(usb_hub_register_devices)
|