mirror of https://github.com/xemu-project/xemu.git
usb-hub: port count config option, emulate power switching, cleanups.
usb-tablet, usb-host: bugfixes. -----BEGIN PGP SIGNATURE----- Version: GnuPG v2.0.22 (GNU/Linux) iQIcBAABAgAGBQJc7iaCAAoJEEy22O7T6HE4EJYQAL25pK8tGwib4YOKjf6qEnax Uh/BRJUWFdGxTi3CI5JfDonmL88Ksm65cv68er+AbWMKizKybVkB3QtzuKOrfnhT hv8H4OyVZr4kdoYFyMHn9aW+/wVyl8OyMXDTUmJwSLW74im9Nqr57WKEpf3G5gIi uP49vRHdnC0efz9pyvYVGp2pj4yjymhGTrm3j4tMXfYsfjTz39LxkwGyQx/XNkgC HVqj/d1wTkmISqPmWoHt+S9+wGmxzd0UcBoBi05EMp6cnRzSyr27io2xhxfb/2cf 5Dwjm4Kiw0wasmbNUW3VT36Mu5B+6vyW483dJIWQeUSYRW3kzs+pk16mNj7JxMhu aSydUei2GH7OfIGdiDEeReXgu/WT/iEq3S14fbnP7Vxu2rEkpLyDXIAoeGBr3nZ6 xsLcb18WHEKDq2D3QWK1yOsp+JSP9GqXbdKJryoeAjJefm6aamUiCLu6qp5Ersc6 p0lsygt97gCxkmjB/71xSvViivf3dR3gKn+QdO6y5s3v6Y0FJOgb8y6L6p98Z7T+ sd+pwvOMUZryyo9EIWrhe4GxSqc6Jtse2Cjn3BXSmIEiEtZ7cBoYYrX43vxVl2gx DnQE5KyHcOUELs8e0t7ewfMdWEA/GLLKgGAONjicB3CcZokOCFPjGUJ1ge+kcjNx a9BLv1dTD04yhD0aKvfs =mPfJ -----END PGP SIGNATURE----- Merge remote-tracking branch 'remotes/kraxel/tags/usb-20190529-pull-request' into staging usb-hub: port count config option, emulate power switching, cleanups. usb-tablet, usb-host: bugfixes. # gpg: Signature made Wed 29 May 2019 07:28:18 BST # gpg: using RSA key 4CB6D8EED3E87138 # gpg: Good signature from "Gerd Hoffmann (work) <kraxel@redhat.com>" [full] # gpg: aka "Gerd Hoffmann <gerd@kraxel.org>" [full] # gpg: aka "Gerd Hoffmann (private) <kraxel@gmail.com>" [full] # Primary key fingerprint: A032 8CFF B93A 17A7 9901 FE7D 4CB6 D8EE D3E8 7138 * remotes/kraxel/tags/usb-20190529-pull-request: usb-tablet: fix serial compat property usb-hub: emulate per port power switching usb-hub: add usb_hub_port_update() usb-hub: add helpers to update port state usb-hub: make number of ports runtime-configurable usb-hub: tweak feature names usb-host: avoid libusb_set_configuration calls usb-host: skip reset for untouched devices usb: call reset handler before updating state Signed-off-by: Peter Maydell <peter.maydell@linaro.org>
This commit is contained in:
commit
48a8b39961
|
@ -36,7 +36,7 @@ GlobalProperty hw_compat_3_1[] = {
|
||||||
{ "tpm-tis", "ppi", "false" },
|
{ "tpm-tis", "ppi", "false" },
|
||||||
{ "usb-kbd", "serial", "42" },
|
{ "usb-kbd", "serial", "42" },
|
||||||
{ "usb-mouse", "serial", "42" },
|
{ "usb-mouse", "serial", "42" },
|
||||||
{ "usb-kbd", "serial", "42" },
|
{ "usb-tablet", "serial", "42" },
|
||||||
{ "virtio-blk-device", "discard", "false" },
|
{ "virtio-blk-device", "discard", "false" },
|
||||||
{ "virtio-blk-device", "write-zeroes", "false" },
|
{ "virtio-blk-device", "write-zeroes", "false" },
|
||||||
};
|
};
|
||||||
|
|
|
@ -87,10 +87,10 @@ void usb_device_reset(USBDevice *dev)
|
||||||
if (dev == NULL || !dev->attached) {
|
if (dev == NULL || !dev->attached) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
usb_device_handle_reset(dev);
|
||||||
dev->remote_wakeup = 0;
|
dev->remote_wakeup = 0;
|
||||||
dev->addr = 0;
|
dev->addr = 0;
|
||||||
dev->state = USB_STATE_DEFAULT;
|
dev->state = USB_STATE_DEFAULT;
|
||||||
usb_device_handle_reset(dev);
|
|
||||||
}
|
}
|
||||||
|
|
||||||
void usb_wakeup(USBEndpoint *ep, unsigned int stream)
|
void usb_wakeup(USBEndpoint *ep, unsigned int stream)
|
||||||
|
|
221
hw/usb/dev-hub.c
221
hw/usb/dev-hub.c
|
@ -24,12 +24,13 @@
|
||||||
#include "qemu/osdep.h"
|
#include "qemu/osdep.h"
|
||||||
#include "qapi/error.h"
|
#include "qapi/error.h"
|
||||||
#include "qemu-common.h"
|
#include "qemu-common.h"
|
||||||
|
#include "qemu/timer.h"
|
||||||
#include "trace.h"
|
#include "trace.h"
|
||||||
#include "hw/usb.h"
|
#include "hw/usb.h"
|
||||||
#include "desc.h"
|
#include "desc.h"
|
||||||
#include "qemu/error-report.h"
|
#include "qemu/error-report.h"
|
||||||
|
|
||||||
#define NUM_PORTS 8
|
#define MAX_PORTS 8
|
||||||
|
|
||||||
typedef struct USBHubPort {
|
typedef struct USBHubPort {
|
||||||
USBPort port;
|
USBPort port;
|
||||||
|
@ -40,7 +41,10 @@ typedef struct USBHubPort {
|
||||||
typedef struct USBHubState {
|
typedef struct USBHubState {
|
||||||
USBDevice dev;
|
USBDevice dev;
|
||||||
USBEndpoint *intr;
|
USBEndpoint *intr;
|
||||||
USBHubPort ports[NUM_PORTS];
|
uint32_t num_ports;
|
||||||
|
bool port_power;
|
||||||
|
QEMUTimer *port_timer;
|
||||||
|
USBHubPort ports[MAX_PORTS];
|
||||||
} USBHubState;
|
} USBHubState;
|
||||||
|
|
||||||
#define TYPE_USB_HUB "usb-hub"
|
#define TYPE_USB_HUB "usb-hub"
|
||||||
|
@ -109,7 +113,7 @@ static const USBDescIface desc_iface_hub = {
|
||||||
{
|
{
|
||||||
.bEndpointAddress = USB_DIR_IN | 0x01,
|
.bEndpointAddress = USB_DIR_IN | 0x01,
|
||||||
.bmAttributes = USB_ENDPOINT_XFER_INT,
|
.bmAttributes = USB_ENDPOINT_XFER_INT,
|
||||||
.wMaxPacketSize = 1 + DIV_ROUND_UP(NUM_PORTS, 8),
|
.wMaxPacketSize = 1 + DIV_ROUND_UP(MAX_PORTS, 8),
|
||||||
.bInterval = 0xff,
|
.bInterval = 0xff,
|
||||||
},
|
},
|
||||||
}
|
}
|
||||||
|
@ -158,19 +162,71 @@ static const uint8_t qemu_hub_hub_descriptor[] =
|
||||||
/* DeviceRemovable and PortPwrCtrlMask patched in later */
|
/* DeviceRemovable and PortPwrCtrlMask patched in later */
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static bool usb_hub_port_change(USBHubPort *port, uint16_t status)
|
||||||
|
{
|
||||||
|
bool notify = false;
|
||||||
|
|
||||||
|
if (status & 0x1f) {
|
||||||
|
port->wPortChange |= status;
|
||||||
|
notify = true;
|
||||||
|
}
|
||||||
|
return notify;
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool usb_hub_port_set(USBHubPort *port, uint16_t status)
|
||||||
|
{
|
||||||
|
if (port->wPortStatus & status) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
port->wPortStatus |= status;
|
||||||
|
return usb_hub_port_change(port, status);
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool usb_hub_port_clear(USBHubPort *port, uint16_t status)
|
||||||
|
{
|
||||||
|
if (!(port->wPortStatus & status)) {
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
port->wPortStatus &= ~status;
|
||||||
|
return usb_hub_port_change(port, status);
|
||||||
|
}
|
||||||
|
|
||||||
|
static bool usb_hub_port_update(USBHubPort *port)
|
||||||
|
{
|
||||||
|
bool notify = false;
|
||||||
|
|
||||||
|
if (port->port.dev && port->port.dev->attached) {
|
||||||
|
notify = usb_hub_port_set(port, PORT_STAT_CONNECTION);
|
||||||
|
if (port->port.dev->speed == USB_SPEED_LOW) {
|
||||||
|
usb_hub_port_set(port, PORT_STAT_LOW_SPEED);
|
||||||
|
} else {
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_LOW_SPEED);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return notify;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void usb_hub_port_update_timer(void *opaque)
|
||||||
|
{
|
||||||
|
USBHubState *s = opaque;
|
||||||
|
bool notify = false;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
for (i = 0; i < s->num_ports; i++) {
|
||||||
|
notify |= usb_hub_port_update(&s->ports[i]);
|
||||||
|
}
|
||||||
|
if (notify) {
|
||||||
|
usb_wakeup(s->intr, 0);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
static void usb_hub_attach(USBPort *port1)
|
static void usb_hub_attach(USBPort *port1)
|
||||||
{
|
{
|
||||||
USBHubState *s = port1->opaque;
|
USBHubState *s = port1->opaque;
|
||||||
USBHubPort *port = &s->ports[port1->index];
|
USBHubPort *port = &s->ports[port1->index];
|
||||||
|
|
||||||
trace_usb_hub_attach(s->dev.addr, port1->index + 1);
|
trace_usb_hub_attach(s->dev.addr, port1->index + 1);
|
||||||
port->wPortStatus |= PORT_STAT_CONNECTION;
|
usb_hub_port_update(port);
|
||||||
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;
|
|
||||||
}
|
|
||||||
usb_wakeup(s->intr, 0);
|
usb_wakeup(s->intr, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -185,16 +241,9 @@ static void usb_hub_detach(USBPort *port1)
|
||||||
/* Let upstream know the device on this port is gone */
|
/* Let upstream know the device on this port is gone */
|
||||||
s->dev.port->ops->child_detach(s->dev.port, port1->dev);
|
s->dev.port->ops->child_detach(s->dev.port, port1->dev);
|
||||||
|
|
||||||
port->wPortStatus &= ~PORT_STAT_CONNECTION;
|
usb_hub_port_clear(port, PORT_STAT_CONNECTION);
|
||||||
port->wPortChange |= PORT_STAT_C_CONNECTION;
|
usb_hub_port_clear(port, PORT_STAT_ENABLE);
|
||||||
if (port->wPortStatus & PORT_STAT_ENABLE) {
|
usb_hub_port_clear(port, PORT_STAT_SUSPEND);
|
||||||
port->wPortStatus &= ~PORT_STAT_ENABLE;
|
|
||||||
port->wPortChange |= PORT_STAT_C_ENABLE;
|
|
||||||
}
|
|
||||||
if (port->wPortStatus & PORT_STAT_SUSPEND) {
|
|
||||||
port->wPortStatus &= ~PORT_STAT_SUSPEND;
|
|
||||||
port->wPortChange |= PORT_STAT_C_SUSPEND;
|
|
||||||
}
|
|
||||||
usb_wakeup(s->intr, 0);
|
usb_wakeup(s->intr, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -211,9 +260,7 @@ static void usb_hub_wakeup(USBPort *port1)
|
||||||
USBHubState *s = port1->opaque;
|
USBHubState *s = port1->opaque;
|
||||||
USBHubPort *port = &s->ports[port1->index];
|
USBHubPort *port = &s->ports[port1->index];
|
||||||
|
|
||||||
if (port->wPortStatus & PORT_STAT_SUSPEND) {
|
if (usb_hub_port_clear(port, PORT_STAT_SUSPEND)) {
|
||||||
port->wPortStatus &= ~PORT_STAT_SUSPEND;
|
|
||||||
port->wPortChange |= PORT_STAT_C_SUSPEND;
|
|
||||||
usb_wakeup(s->intr, 0);
|
usb_wakeup(s->intr, 0);
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -242,7 +289,7 @@ static USBDevice *usb_hub_find_device(USBDevice *dev, uint8_t addr)
|
||||||
USBDevice *downstream;
|
USBDevice *downstream;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for (i = 0; i < NUM_PORTS; i++) {
|
for (i = 0; i < s->num_ports; i++) {
|
||||||
port = &s->ports[i];
|
port = &s->ports[i];
|
||||||
if (!(port->wPortStatus & PORT_STAT_ENABLE)) {
|
if (!(port->wPortStatus & PORT_STAT_ENABLE)) {
|
||||||
continue;
|
continue;
|
||||||
|
@ -262,17 +309,12 @@ static void usb_hub_handle_reset(USBDevice *dev)
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
trace_usb_hub_reset(s->dev.addr);
|
trace_usb_hub_reset(s->dev.addr);
|
||||||
for (i = 0; i < NUM_PORTS; i++) {
|
for (i = 0; i < s->num_ports; i++) {
|
||||||
port = s->ports + i;
|
port = s->ports + i;
|
||||||
port->wPortStatus = PORT_STAT_POWER;
|
port->wPortStatus = 0;
|
||||||
port->wPortChange = 0;
|
port->wPortChange = 0;
|
||||||
if (port->port.dev && port->port.dev->attached) {
|
usb_hub_port_set(port, PORT_STAT_POWER);
|
||||||
port->wPortStatus |= PORT_STAT_CONNECTION;
|
usb_hub_port_update(port);
|
||||||
port->wPortChange |= PORT_STAT_C_CONNECTION;
|
|
||||||
if (port->port.dev->speed == USB_SPEED_LOW) {
|
|
||||||
port->wPortStatus |= PORT_STAT_LOW_SPEED;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
@ -287,11 +329,11 @@ static const char *feature_name(int feature)
|
||||||
[PORT_POWER] = "power",
|
[PORT_POWER] = "power",
|
||||||
[PORT_LOWSPEED] = "lowspeed",
|
[PORT_LOWSPEED] = "lowspeed",
|
||||||
[PORT_HIGHSPEED] = "highspeed",
|
[PORT_HIGHSPEED] = "highspeed",
|
||||||
[PORT_C_CONNECTION] = "change connection",
|
[PORT_C_CONNECTION] = "change-connection",
|
||||||
[PORT_C_ENABLE] = "change enable",
|
[PORT_C_ENABLE] = "change-enable",
|
||||||
[PORT_C_SUSPEND] = "change suspend",
|
[PORT_C_SUSPEND] = "change-suspend",
|
||||||
[PORT_C_OVERCURRENT] = "change overcurrent",
|
[PORT_C_OVERCURRENT] = "change-overcurrent",
|
||||||
[PORT_C_RESET] = "change reset",
|
[PORT_C_RESET] = "change-reset",
|
||||||
[PORT_TEST] = "test",
|
[PORT_TEST] = "test",
|
||||||
[PORT_INDICATOR] = "indicator",
|
[PORT_INDICATOR] = "indicator",
|
||||||
};
|
};
|
||||||
|
@ -332,7 +374,7 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
{
|
{
|
||||||
unsigned int n = index - 1;
|
unsigned int n = index - 1;
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
if (n >= NUM_PORTS) {
|
if (n >= s->num_ports) {
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
|
@ -361,7 +403,7 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
trace_usb_hub_set_port_feature(s->dev.addr, index,
|
trace_usb_hub_set_port_feature(s->dev.addr, index,
|
||||||
feature_name(value));
|
feature_name(value));
|
||||||
|
|
||||||
if (n >= NUM_PORTS) {
|
if (n >= s->num_ports) {
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
|
@ -371,15 +413,20 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
port->wPortStatus |= PORT_STAT_SUSPEND;
|
port->wPortStatus |= PORT_STAT_SUSPEND;
|
||||||
break;
|
break;
|
||||||
case PORT_RESET:
|
case PORT_RESET:
|
||||||
|
usb_hub_port_set(port, PORT_STAT_RESET);
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_RESET);
|
||||||
if (dev && dev->attached) {
|
if (dev && dev->attached) {
|
||||||
usb_device_reset(dev);
|
usb_device_reset(dev);
|
||||||
port->wPortChange |= PORT_STAT_C_RESET;
|
usb_hub_port_set(port, PORT_STAT_ENABLE);
|
||||||
/* set enable bit */
|
|
||||||
port->wPortStatus |= PORT_STAT_ENABLE;
|
|
||||||
usb_wakeup(s->intr, 0);
|
|
||||||
}
|
}
|
||||||
|
usb_wakeup(s->intr, 0);
|
||||||
break;
|
break;
|
||||||
case PORT_POWER:
|
case PORT_POWER:
|
||||||
|
if (s->port_power) {
|
||||||
|
int64_t now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
|
||||||
|
usb_hub_port_set(port, PORT_STAT_POWER);
|
||||||
|
timer_mod(s->port_timer, now + 5000000); /* 5 ms */
|
||||||
|
}
|
||||||
break;
|
break;
|
||||||
default:
|
default:
|
||||||
goto fail;
|
goto fail;
|
||||||
|
@ -394,7 +441,7 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
trace_usb_hub_clear_port_feature(s->dev.addr, index,
|
trace_usb_hub_clear_port_feature(s->dev.addr, index,
|
||||||
feature_name(value));
|
feature_name(value));
|
||||||
|
|
||||||
if (n >= NUM_PORTS) {
|
if (n >= s->num_ports) {
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
}
|
||||||
port = &s->ports[n];
|
port = &s->ports[n];
|
||||||
|
@ -406,20 +453,7 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
port->wPortChange &= ~PORT_STAT_C_ENABLE;
|
port->wPortChange &= ~PORT_STAT_C_ENABLE;
|
||||||
break;
|
break;
|
||||||
case PORT_SUSPEND:
|
case PORT_SUSPEND:
|
||||||
if (port->wPortStatus & PORT_STAT_SUSPEND) {
|
usb_hub_port_clear(port, PORT_STAT_SUSPEND);
|
||||||
port->wPortStatus &= ~PORT_STAT_SUSPEND;
|
|
||||||
|
|
||||||
/*
|
|
||||||
* USB Spec rev2.0 11.24.2.7.2.3 C_PORT_SUSPEND
|
|
||||||
* "This bit is set on the following transitions:
|
|
||||||
* - On transition from the Resuming state to the
|
|
||||||
* SendEOP [sic] state"
|
|
||||||
*
|
|
||||||
* Note that this includes both remote wake-up and
|
|
||||||
* explicit ClearPortFeature(PORT_SUSPEND).
|
|
||||||
*/
|
|
||||||
port->wPortChange |= PORT_STAT_C_SUSPEND;
|
|
||||||
}
|
|
||||||
break;
|
break;
|
||||||
case PORT_C_SUSPEND:
|
case PORT_C_SUSPEND:
|
||||||
port->wPortChange &= ~PORT_STAT_C_SUSPEND;
|
port->wPortChange &= ~PORT_STAT_C_SUSPEND;
|
||||||
|
@ -433,6 +467,14 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
case PORT_C_RESET:
|
case PORT_C_RESET:
|
||||||
port->wPortChange &= ~PORT_STAT_C_RESET;
|
port->wPortChange &= ~PORT_STAT_C_RESET;
|
||||||
break;
|
break;
|
||||||
|
case PORT_POWER:
|
||||||
|
if (s->port_power) {
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_POWER);
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_CONNECTION);
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_ENABLE);
|
||||||
|
usb_hub_port_clear(port, PORT_STAT_SUSPEND);
|
||||||
|
port->wPortChange = 0;
|
||||||
|
}
|
||||||
default:
|
default:
|
||||||
goto fail;
|
goto fail;
|
||||||
}
|
}
|
||||||
|
@ -443,17 +485,22 @@ static void usb_hub_handle_control(USBDevice *dev, USBPacket *p,
|
||||||
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] = NUM_PORTS;
|
data[2] = s->num_ports;
|
||||||
|
|
||||||
|
if (s->port_power) {
|
||||||
|
data[3] &= ~0x03;
|
||||||
|
data[3] |= 0x01;
|
||||||
|
}
|
||||||
|
|
||||||
/* fill DeviceRemovable bits */
|
/* fill DeviceRemovable bits */
|
||||||
limit = DIV_ROUND_UP(NUM_PORTS + 1, 8) + 7;
|
limit = DIV_ROUND_UP(s->num_ports + 1, 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 + DIV_ROUND_UP(NUM_PORTS, 8);
|
limit = limit + DIV_ROUND_UP(s->num_ports, 8);
|
||||||
for (;n < limit; n++) {
|
for (;n < limit; n++) {
|
||||||
data[n] = 0xff;
|
data[n] = 0xff;
|
||||||
var_hub_size++;
|
var_hub_size++;
|
||||||
|
@ -481,7 +528,7 @@ static void usb_hub_handle_data(USBDevice *dev, USBPacket *p)
|
||||||
unsigned int status;
|
unsigned int status;
|
||||||
uint8_t buf[4];
|
uint8_t buf[4];
|
||||||
int i, n;
|
int i, n;
|
||||||
n = DIV_ROUND_UP(NUM_PORTS + 1, 8);
|
n = DIV_ROUND_UP(s->num_ports + 1, 8);
|
||||||
if (p->iov.size == 1) { /* FreeBSD workaround */
|
if (p->iov.size == 1) { /* FreeBSD workaround */
|
||||||
n = 1;
|
n = 1;
|
||||||
} else if (n > p->iov.size) {
|
} else if (n > p->iov.size) {
|
||||||
|
@ -489,7 +536,7 @@ static void usb_hub_handle_data(USBDevice *dev, USBPacket *p)
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
status = 0;
|
status = 0;
|
||||||
for(i = 0; i < NUM_PORTS; i++) {
|
for (i = 0; i < s->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));
|
||||||
|
@ -520,10 +567,13 @@ static void usb_hub_unrealize(USBDevice *dev, Error **errp)
|
||||||
USBHubState *s = (USBHubState *)dev;
|
USBHubState *s = (USBHubState *)dev;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
for (i = 0; i < NUM_PORTS; i++) {
|
for (i = 0; i < s->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);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
timer_del(s->port_timer);
|
||||||
|
timer_free(s->port_timer);
|
||||||
}
|
}
|
||||||
|
|
||||||
static USBPortOps usb_hub_port_ops = {
|
static USBPortOps usb_hub_port_ops = {
|
||||||
|
@ -540,6 +590,12 @@ static void usb_hub_realize(USBDevice *dev, Error **errp)
|
||||||
USBHubPort *port;
|
USBHubPort *port;
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
|
if (s->num_ports < 1 || s->num_ports > MAX_PORTS) {
|
||||||
|
error_setg(errp, "num_ports (%d) out of range (1..%d)",
|
||||||
|
s->num_ports, MAX_PORTS);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
if (dev->port->hubcount == 5) {
|
if (dev->port->hubcount == 5) {
|
||||||
error_setg(errp, "usb hub chain too deep");
|
error_setg(errp, "usb hub chain too deep");
|
||||||
return;
|
return;
|
||||||
|
@ -547,8 +603,10 @@ static void usb_hub_realize(USBDevice *dev, Error **errp)
|
||||||
|
|
||||||
usb_desc_create_serial(dev);
|
usb_desc_create_serial(dev);
|
||||||
usb_desc_init(dev);
|
usb_desc_init(dev);
|
||||||
|
s->port_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
|
||||||
|
usb_hub_port_update_timer, s);
|
||||||
s->intr = usb_ep_get(dev, USB_TOKEN_IN, 1);
|
s->intr = usb_ep_get(dev, USB_TOKEN_IN, 1);
|
||||||
for (i = 0; i < NUM_PORTS; i++) {
|
for (i = 0; i < s->num_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, &usb_hub_port_ops,
|
&port->port, s, i, &usb_hub_port_ops,
|
||||||
|
@ -569,18 +627,46 @@ static const VMStateDescription vmstate_usb_hub_port = {
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static bool usb_hub_port_timer_needed(void *opaque)
|
||||||
|
{
|
||||||
|
USBHubState *s = opaque;
|
||||||
|
|
||||||
|
return s->port_power;
|
||||||
|
}
|
||||||
|
|
||||||
|
static const VMStateDescription vmstate_usb_hub_port_timer = {
|
||||||
|
.name = "usb-hub/port-timer",
|
||||||
|
.version_id = 1,
|
||||||
|
.minimum_version_id = 1,
|
||||||
|
.needed = usb_hub_port_timer_needed,
|
||||||
|
.fields = (VMStateField[]) {
|
||||||
|
VMSTATE_TIMER_PTR(port_timer, USBHubState),
|
||||||
|
VMSTATE_END_OF_LIST()
|
||||||
|
},
|
||||||
|
};
|
||||||
|
|
||||||
static const VMStateDescription vmstate_usb_hub = {
|
static const VMStateDescription vmstate_usb_hub = {
|
||||||
.name = "usb-hub",
|
.name = "usb-hub",
|
||||||
.version_id = 1,
|
.version_id = 1,
|
||||||
.minimum_version_id = 1,
|
.minimum_version_id = 1,
|
||||||
.fields = (VMStateField[]) {
|
.fields = (VMStateField[]) {
|
||||||
VMSTATE_USB_DEVICE(dev, USBHubState),
|
VMSTATE_USB_DEVICE(dev, USBHubState),
|
||||||
VMSTATE_STRUCT_ARRAY(ports, USBHubState, NUM_PORTS, 0,
|
VMSTATE_STRUCT_ARRAY(ports, USBHubState, MAX_PORTS, 0,
|
||||||
vmstate_usb_hub_port, USBHubPort),
|
vmstate_usb_hub_port, USBHubPort),
|
||||||
VMSTATE_END_OF_LIST()
|
VMSTATE_END_OF_LIST()
|
||||||
|
},
|
||||||
|
.subsections = (const VMStateDescription * []) {
|
||||||
|
&vmstate_usb_hub_port_timer,
|
||||||
|
NULL
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
|
static Property usb_hub_properties[] = {
|
||||||
|
DEFINE_PROP_UINT32("ports", USBHubState, num_ports, 8),
|
||||||
|
DEFINE_PROP_BOOL("port-power", USBHubState, port_power, false),
|
||||||
|
DEFINE_PROP_END_OF_LIST(),
|
||||||
|
};
|
||||||
|
|
||||||
static void usb_hub_class_initfn(ObjectClass *klass, void *data)
|
static void usb_hub_class_initfn(ObjectClass *klass, void *data)
|
||||||
{
|
{
|
||||||
DeviceClass *dc = DEVICE_CLASS(klass);
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
||||||
|
@ -597,6 +683,7 @@ static void usb_hub_class_initfn(ObjectClass *klass, void *data)
|
||||||
set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
|
set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
|
||||||
dc->fw_name = "hub";
|
dc->fw_name = "hub";
|
||||||
dc->vmsd = &vmstate_usb_hub;
|
dc->vmsd = &vmstate_usb_hub;
|
||||||
|
dc->props = usb_hub_properties;
|
||||||
}
|
}
|
||||||
|
|
||||||
static const TypeInfo hub_info = {
|
static const TypeInfo hub_info = {
|
||||||
|
|
|
@ -1225,19 +1225,21 @@ static void usb_host_set_address(USBHostDevice *s, int addr)
|
||||||
|
|
||||||
static void usb_host_set_config(USBHostDevice *s, int config, USBPacket *p)
|
static void usb_host_set_config(USBHostDevice *s, int config, USBPacket *p)
|
||||||
{
|
{
|
||||||
int rc;
|
int rc = 0;
|
||||||
|
|
||||||
trace_usb_host_set_config(s->bus_num, s->addr, config);
|
trace_usb_host_set_config(s->bus_num, s->addr, config);
|
||||||
|
|
||||||
usb_host_release_interfaces(s);
|
usb_host_release_interfaces(s);
|
||||||
rc = libusb_set_configuration(s->dh, config);
|
if (s->ddesc.bNumConfigurations != 1) {
|
||||||
if (rc != 0) {
|
rc = libusb_set_configuration(s->dh, config);
|
||||||
usb_host_libusb_error("libusb_set_configuration", rc);
|
if (rc != 0) {
|
||||||
p->status = USB_RET_STALL;
|
usb_host_libusb_error("libusb_set_configuration", rc);
|
||||||
if (rc == LIBUSB_ERROR_NO_DEVICE) {
|
p->status = USB_RET_STALL;
|
||||||
usb_host_nodev(s);
|
if (rc == LIBUSB_ERROR_NO_DEVICE) {
|
||||||
|
usb_host_nodev(s);
|
||||||
|
}
|
||||||
|
return;
|
||||||
}
|
}
|
||||||
return;
|
|
||||||
}
|
}
|
||||||
p->status = usb_host_claim_interfaces(s, config);
|
p->status = usb_host_claim_interfaces(s, config);
|
||||||
if (p->status != USB_RET_SUCCESS) {
|
if (p->status != USB_RET_SUCCESS) {
|
||||||
|
@ -1459,6 +1461,9 @@ static void usb_host_handle_reset(USBDevice *udev)
|
||||||
if (!s->allow_guest_reset) {
|
if (!s->allow_guest_reset) {
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
|
if (udev->addr == 0) {
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
trace_usb_host_reset(s->bus_num, s->addr);
|
trace_usb_host_reset(s->bus_num, s->addr);
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue