usb hub: use new descriptor infrastructure.
Switch the usb hub driver over to the new descriptor infrastructure. It also removes the nr_ports variable and MAX_PORTS define and introduces a NUM_PORTS define instead. The numver of ports was (and still is) fixed at 8 anyway. Signed-off-by: Gerd Hoffmann <kraxel@redhat.com>
This commit is contained in:
parent
4696425cd0
commit
062651c7e7
141
hw/usb-hub.c
141
hw/usb-hub.c
|
@ -23,10 +23,11 @@
|
||||||
*/
|
*/
|
||||||
#include "qemu-common.h"
|
#include "qemu-common.h"
|
||||||
#include "usb.h"
|
#include "usb.h"
|
||||||
|
#include "usb-desc.h"
|
||||||
|
|
||||||
//#define DEBUG
|
//#define DEBUG
|
||||||
|
|
||||||
#define MAX_PORTS 8
|
#define NUM_PORTS 8
|
||||||
|
|
||||||
typedef struct USBHubPort {
|
typedef struct USBHubPort {
|
||||||
USBPort port;
|
USBPort port;
|
||||||
|
@ -36,8 +37,7 @@ typedef struct USBHubPort {
|
||||||
|
|
||||||
typedef struct USBHubState {
|
typedef struct USBHubState {
|
||||||
USBDevice dev;
|
USBDevice dev;
|
||||||
int nb_ports;
|
USBHubPort ports[NUM_PORTS];
|
||||||
USBHubPort ports[MAX_PORTS];
|
|
||||||
} USBHubState;
|
} USBHubState;
|
||||||
|
|
||||||
#define ClearHubFeature (0x2000 | USB_REQ_CLEAR_FEATURE)
|
#define ClearHubFeature (0x2000 | USB_REQ_CLEAR_FEATURE)
|
||||||
|
@ -83,6 +83,60 @@ typedef struct USBHubState {
|
||||||
|
|
||||||
/* same as Linux kernel root hubs */
|
/* 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,
|
||||||
|
.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_dev_descriptor[] = {
|
static const uint8_t qemu_hub_dev_descriptor[] = {
|
||||||
0x12, /* u8 bLength; */
|
0x12, /* u8 bLength; */
|
||||||
0x01, /* u8 bDescriptorType; Device */
|
0x01, /* u8 bDescriptorType; Device */
|
||||||
|
@ -209,6 +263,11 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
USBHubState *s = (USBHubState *)dev;
|
USBHubState *s = (USBHubState *)dev;
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
|
ret = usb_desc_handle_control(dev, request, value, index, length, data);
|
||||||
|
if (ret >= 0) {
|
||||||
|
return ret;
|
||||||
|
}
|
||||||
|
|
||||||
switch(request) {
|
switch(request) {
|
||||||
case DeviceRequest | USB_REQ_GET_STATUS:
|
case DeviceRequest | USB_REQ_GET_STATUS:
|
||||||
data[0] = (1 << USB_DEVICE_SELF_POWERED) |
|
data[0] = (1 << USB_DEVICE_SELF_POWERED) |
|
||||||
|
@ -242,53 +301,6 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
dev->addr = value;
|
dev->addr = value;
|
||||||
ret = 0;
|
ret = 0;
|
||||||
break;
|
break;
|
||||||
case DeviceRequest | USB_REQ_GET_DESCRIPTOR:
|
|
||||||
switch(value >> 8) {
|
|
||||||
case USB_DT_DEVICE:
|
|
||||||
memcpy(data, qemu_hub_dev_descriptor,
|
|
||||||
sizeof(qemu_hub_dev_descriptor));
|
|
||||||
ret = sizeof(qemu_hub_dev_descriptor);
|
|
||||||
break;
|
|
||||||
case USB_DT_CONFIG:
|
|
||||||
memcpy(data, qemu_hub_config_descriptor,
|
|
||||||
sizeof(qemu_hub_config_descriptor));
|
|
||||||
|
|
||||||
/* status change endpoint size based on number
|
|
||||||
* of ports */
|
|
||||||
data[22] = (s->nb_ports + 1 + 7) / 8;
|
|
||||||
|
|
||||||
ret = sizeof(qemu_hub_config_descriptor);
|
|
||||||
break;
|
|
||||||
case USB_DT_STRING:
|
|
||||||
switch(value & 0xff) {
|
|
||||||
case 0:
|
|
||||||
/* language ids */
|
|
||||||
data[0] = 4;
|
|
||||||
data[1] = 3;
|
|
||||||
data[2] = 0x09;
|
|
||||||
data[3] = 0x04;
|
|
||||||
ret = 4;
|
|
||||||
break;
|
|
||||||
case 1:
|
|
||||||
/* serial number */
|
|
||||||
ret = set_usb_string(data, "314159");
|
|
||||||
break;
|
|
||||||
case 2:
|
|
||||||
/* product description */
|
|
||||||
ret = set_usb_string(data, "QEMU USB Hub");
|
|
||||||
break;
|
|
||||||
case 3:
|
|
||||||
/* vendor description */
|
|
||||||
ret = set_usb_string(data, "QEMU " QEMU_VERSION);
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
goto fail;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
default:
|
|
||||||
goto fail;
|
|
||||||
}
|
|
||||||
break;
|
|
||||||
case DeviceRequest | USB_REQ_GET_CONFIGURATION:
|
case DeviceRequest | USB_REQ_GET_CONFIGURATION:
|
||||||
data[0] = 1;
|
data[0] = 1;
|
||||||
ret = 1;
|
ret = 1;
|
||||||
|
@ -315,8 +327,9 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
{
|
{
|
||||||
unsigned int n = index - 1;
|
unsigned int n = index - 1;
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
if (n >= s->nb_ports)
|
if (n >= NUM_PORTS) {
|
||||||
goto fail;
|
goto fail;
|
||||||
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
data[0] = port->wPortStatus;
|
data[0] = port->wPortStatus;
|
||||||
data[1] = port->wPortStatus >> 8;
|
data[1] = port->wPortStatus >> 8;
|
||||||
|
@ -338,8 +351,9 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
unsigned int n = index - 1;
|
unsigned int n = index - 1;
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
USBDevice *dev;
|
USBDevice *dev;
|
||||||
if (n >= s->nb_ports)
|
if (n >= NUM_PORTS) {
|
||||||
goto fail;
|
goto fail;
|
||||||
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
dev = port->port.dev;
|
dev = port->port.dev;
|
||||||
switch(value) {
|
switch(value) {
|
||||||
|
@ -367,8 +381,9 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
unsigned int n = index - 1;
|
unsigned int n = index - 1;
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
|
|
||||||
if (n >= s->nb_ports)
|
if (n >= NUM_PORTS) {
|
||||||
goto fail;
|
goto fail;
|
||||||
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
switch(value) {
|
switch(value) {
|
||||||
case PORT_ENABLE:
|
case PORT_ENABLE:
|
||||||
|
@ -403,17 +418,17 @@ static int usb_hub_handle_control(USBDevice *dev, int request, int value,
|
||||||
unsigned int n, limit, var_hub_size = 0;
|
unsigned int n, limit, var_hub_size = 0;
|
||||||
memcpy(data, qemu_hub_hub_descriptor,
|
memcpy(data, qemu_hub_hub_descriptor,
|
||||||
sizeof(qemu_hub_hub_descriptor));
|
sizeof(qemu_hub_hub_descriptor));
|
||||||
data[2] = s->nb_ports;
|
data[2] = NUM_PORTS;
|
||||||
|
|
||||||
/* fill DeviceRemovable bits */
|
/* fill DeviceRemovable bits */
|
||||||
limit = ((s->nb_ports + 1 + 7) / 8) + 7;
|
limit = ((NUM_PORTS + 1 + 7) / 8) + 7;
|
||||||
for (n = 7; n < limit; n++) {
|
for (n = 7; n < limit; n++) {
|
||||||
data[n] = 0x00;
|
data[n] = 0x00;
|
||||||
var_hub_size++;
|
var_hub_size++;
|
||||||
}
|
}
|
||||||
|
|
||||||
/* fill PortPwrCtrlMask bits */
|
/* fill PortPwrCtrlMask bits */
|
||||||
limit = limit + ((s->nb_ports + 7) / 8);
|
limit = limit + ((NUM_PORTS + 7) / 8);
|
||||||
for (;n < limit; n++) {
|
for (;n < limit; n++) {
|
||||||
data[n] = 0xff;
|
data[n] = 0xff;
|
||||||
var_hub_size++;
|
var_hub_size++;
|
||||||
|
@ -442,14 +457,14 @@ static int usb_hub_handle_data(USBDevice *dev, USBPacket *p)
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
unsigned int status;
|
unsigned int status;
|
||||||
int i, n;
|
int i, n;
|
||||||
n = (s->nb_ports + 1 + 7) / 8;
|
n = (NUM_PORTS + 1 + 7) / 8;
|
||||||
if (p->len == 1) { /* FreeBSD workaround */
|
if (p->len == 1) { /* FreeBSD workaround */
|
||||||
n = 1;
|
n = 1;
|
||||||
} else if (n > p->len) {
|
} else if (n > p->len) {
|
||||||
return USB_RET_BABBLE;
|
return USB_RET_BABBLE;
|
||||||
}
|
}
|
||||||
status = 0;
|
status = 0;
|
||||||
for(i = 0; i < s->nb_ports; i++) {
|
for(i = 0; i < NUM_PORTS; i++) {
|
||||||
port = &s->ports[i];
|
port = &s->ports[i];
|
||||||
if (port->wPortChange)
|
if (port->wPortChange)
|
||||||
status |= (1 << (i + 1));
|
status |= (1 << (i + 1));
|
||||||
|
@ -481,7 +496,7 @@ static int usb_hub_broadcast_packet(USBHubState *s, USBPacket *p)
|
||||||
USBDevice *dev;
|
USBDevice *dev;
|
||||||
int i, ret;
|
int i, ret;
|
||||||
|
|
||||||
for(i = 0; i < s->nb_ports; i++) {
|
for(i = 0; i < NUM_PORTS; i++) {
|
||||||
port = &s->ports[i];
|
port = &s->ports[i];
|
||||||
dev = port->port.dev;
|
dev = port->port.dev;
|
||||||
if (dev && (port->wPortStatus & PORT_STAT_ENABLE)) {
|
if (dev && (port->wPortStatus & PORT_STAT_ENABLE)) {
|
||||||
|
@ -518,7 +533,7 @@ static void usb_hub_handle_destroy(USBDevice *dev)
|
||||||
USBHubState *s = (USBHubState *)dev;
|
USBHubState *s = (USBHubState *)dev;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for (i = 0; i < s->nb_ports; i++) {
|
for (i = 0; i < NUM_PORTS; i++) {
|
||||||
usb_unregister_port(usb_bus_from_device(dev),
|
usb_unregister_port(usb_bus_from_device(dev),
|
||||||
&s->ports[i].port);
|
&s->ports[i].port);
|
||||||
}
|
}
|
||||||
|
@ -530,9 +545,8 @@ static int usb_hub_initfn(USBDevice *dev)
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
s->dev.speed = USB_SPEED_FULL,
|
s->dev.speed = USB_SPEED_FULL;
|
||||||
s->nb_ports = MAX_PORTS; /* FIXME: make configurable */
|
for (i = 0; i < NUM_PORTS; i++) {
|
||||||
for (i = 0; i < s->nb_ports; i++) {
|
|
||||||
port = &s->ports[i];
|
port = &s->ports[i];
|
||||||
usb_register_port(usb_bus_from_device(dev),
|
usb_register_port(usb_bus_from_device(dev),
|
||||||
&port->port, s, i, &s->dev, usb_hub_attach);
|
&port->port, s, i, &s->dev, usb_hub_attach);
|
||||||
|
@ -547,6 +561,7 @@ static struct USBDeviceInfo hub_info = {
|
||||||
.qdev.name = "usb-hub",
|
.qdev.name = "usb-hub",
|
||||||
.qdev.fw_name = "hub",
|
.qdev.fw_name = "hub",
|
||||||
.qdev.size = sizeof(USBHubState),
|
.qdev.size = sizeof(USBHubState),
|
||||||
|
.usb_desc = &desc_hub,
|
||||||
.init = usb_hub_initfn,
|
.init = usb_hub_initfn,
|
||||||
.handle_packet = usb_hub_handle_packet,
|
.handle_packet = usb_hub_handle_packet,
|
||||||
.handle_reset = usb_hub_handle_reset,
|
.handle_reset = usb_hub_handle_reset,
|
||||||
|
|
Loading…
Reference in New Issue