1f1ae32a1SGerd Hoffmann /* 2f1ae32a1SGerd Hoffmann * QEMU USB HUB emulation 3f1ae32a1SGerd Hoffmann * 4f1ae32a1SGerd Hoffmann * Copyright (c) 2005 Fabrice Bellard 5f1ae32a1SGerd Hoffmann * 6f1ae32a1SGerd Hoffmann * Permission is hereby granted, free of charge, to any person obtaining a copy 7f1ae32a1SGerd Hoffmann * of this software and associated documentation files (the "Software"), to deal 8f1ae32a1SGerd Hoffmann * in the Software without restriction, including without limitation the rights 9f1ae32a1SGerd Hoffmann * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell 10f1ae32a1SGerd Hoffmann * copies of the Software, and to permit persons to whom the Software is 11f1ae32a1SGerd Hoffmann * furnished to do so, subject to the following conditions: 12f1ae32a1SGerd Hoffmann * 13f1ae32a1SGerd Hoffmann * The above copyright notice and this permission notice shall be included in 14f1ae32a1SGerd Hoffmann * all copies or substantial portions of the Software. 15f1ae32a1SGerd Hoffmann * 16f1ae32a1SGerd Hoffmann * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR 17f1ae32a1SGerd Hoffmann * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 18f1ae32a1SGerd Hoffmann * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL 19f1ae32a1SGerd Hoffmann * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER 20f1ae32a1SGerd Hoffmann * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, 21f1ae32a1SGerd Hoffmann * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN 22f1ae32a1SGerd Hoffmann * THE SOFTWARE. 23f1ae32a1SGerd Hoffmann */ 24f1ae32a1SGerd Hoffmann #include "qemu-common.h" 25529f8f9fSGerd Hoffmann #include "trace.h" 26f1ae32a1SGerd Hoffmann #include "hw/usb.h" 27f1ae32a1SGerd Hoffmann #include "hw/usb/desc.h" 28c24e4aacSGerd Hoffmann #include "qemu/error-report.h" 29f1ae32a1SGerd Hoffmann 30f1ae32a1SGerd Hoffmann #define NUM_PORTS 8 31f1ae32a1SGerd Hoffmann 32f1ae32a1SGerd Hoffmann typedef struct USBHubPort { 33f1ae32a1SGerd Hoffmann USBPort port; 34f1ae32a1SGerd Hoffmann uint16_t wPortStatus; 35f1ae32a1SGerd Hoffmann uint16_t wPortChange; 36f1ae32a1SGerd Hoffmann } USBHubPort; 37f1ae32a1SGerd Hoffmann 38f1ae32a1SGerd Hoffmann typedef struct USBHubState { 39f1ae32a1SGerd Hoffmann USBDevice dev; 40f1ae32a1SGerd Hoffmann USBEndpoint *intr; 41f1ae32a1SGerd Hoffmann USBHubPort ports[NUM_PORTS]; 42f1ae32a1SGerd Hoffmann } USBHubState; 43f1ae32a1SGerd Hoffmann 44f1ae32a1SGerd Hoffmann #define ClearHubFeature (0x2000 | USB_REQ_CLEAR_FEATURE) 45f1ae32a1SGerd Hoffmann #define ClearPortFeature (0x2300 | USB_REQ_CLEAR_FEATURE) 46f1ae32a1SGerd Hoffmann #define GetHubDescriptor (0xa000 | USB_REQ_GET_DESCRIPTOR) 47f1ae32a1SGerd Hoffmann #define GetHubStatus (0xa000 | USB_REQ_GET_STATUS) 48f1ae32a1SGerd Hoffmann #define GetPortStatus (0xa300 | USB_REQ_GET_STATUS) 49f1ae32a1SGerd Hoffmann #define SetHubFeature (0x2000 | USB_REQ_SET_FEATURE) 50f1ae32a1SGerd Hoffmann #define SetPortFeature (0x2300 | USB_REQ_SET_FEATURE) 51f1ae32a1SGerd Hoffmann 52f1ae32a1SGerd Hoffmann #define PORT_STAT_CONNECTION 0x0001 53f1ae32a1SGerd Hoffmann #define PORT_STAT_ENABLE 0x0002 54f1ae32a1SGerd Hoffmann #define PORT_STAT_SUSPEND 0x0004 55f1ae32a1SGerd Hoffmann #define PORT_STAT_OVERCURRENT 0x0008 56f1ae32a1SGerd Hoffmann #define PORT_STAT_RESET 0x0010 57f1ae32a1SGerd Hoffmann #define PORT_STAT_POWER 0x0100 58f1ae32a1SGerd Hoffmann #define PORT_STAT_LOW_SPEED 0x0200 59f1ae32a1SGerd Hoffmann #define PORT_STAT_HIGH_SPEED 0x0400 60f1ae32a1SGerd Hoffmann #define PORT_STAT_TEST 0x0800 61f1ae32a1SGerd Hoffmann #define PORT_STAT_INDICATOR 0x1000 62f1ae32a1SGerd Hoffmann 63f1ae32a1SGerd Hoffmann #define PORT_STAT_C_CONNECTION 0x0001 64f1ae32a1SGerd Hoffmann #define PORT_STAT_C_ENABLE 0x0002 65f1ae32a1SGerd Hoffmann #define PORT_STAT_C_SUSPEND 0x0004 66f1ae32a1SGerd Hoffmann #define PORT_STAT_C_OVERCURRENT 0x0008 67f1ae32a1SGerd Hoffmann #define PORT_STAT_C_RESET 0x0010 68f1ae32a1SGerd Hoffmann 69f1ae32a1SGerd Hoffmann #define PORT_CONNECTION 0 70f1ae32a1SGerd Hoffmann #define PORT_ENABLE 1 71f1ae32a1SGerd Hoffmann #define PORT_SUSPEND 2 72f1ae32a1SGerd Hoffmann #define PORT_OVERCURRENT 3 73f1ae32a1SGerd Hoffmann #define PORT_RESET 4 74f1ae32a1SGerd Hoffmann #define PORT_POWER 8 75f1ae32a1SGerd Hoffmann #define PORT_LOWSPEED 9 76f1ae32a1SGerd Hoffmann #define PORT_HIGHSPEED 10 77f1ae32a1SGerd Hoffmann #define PORT_C_CONNECTION 16 78f1ae32a1SGerd Hoffmann #define PORT_C_ENABLE 17 79f1ae32a1SGerd Hoffmann #define PORT_C_SUSPEND 18 80f1ae32a1SGerd Hoffmann #define PORT_C_OVERCURRENT 19 81f1ae32a1SGerd Hoffmann #define PORT_C_RESET 20 82f1ae32a1SGerd Hoffmann #define PORT_TEST 21 83f1ae32a1SGerd Hoffmann #define PORT_INDICATOR 22 84f1ae32a1SGerd Hoffmann 85f1ae32a1SGerd Hoffmann /* same as Linux kernel root hubs */ 86f1ae32a1SGerd Hoffmann 87f1ae32a1SGerd Hoffmann enum { 88f1ae32a1SGerd Hoffmann STR_MANUFACTURER = 1, 89f1ae32a1SGerd Hoffmann STR_PRODUCT, 90f1ae32a1SGerd Hoffmann STR_SERIALNUMBER, 91f1ae32a1SGerd Hoffmann }; 92f1ae32a1SGerd Hoffmann 93f1ae32a1SGerd Hoffmann static const USBDescStrings desc_strings = { 9493bfef4cSCrístian Viana [STR_MANUFACTURER] = "QEMU", 95f1ae32a1SGerd Hoffmann [STR_PRODUCT] = "QEMU USB Hub", 96f1ae32a1SGerd Hoffmann [STR_SERIALNUMBER] = "314159", 97f1ae32a1SGerd Hoffmann }; 98f1ae32a1SGerd Hoffmann 99f1ae32a1SGerd Hoffmann static const USBDescIface desc_iface_hub = { 100f1ae32a1SGerd Hoffmann .bInterfaceNumber = 0, 101f1ae32a1SGerd Hoffmann .bNumEndpoints = 1, 102f1ae32a1SGerd Hoffmann .bInterfaceClass = USB_CLASS_HUB, 103f1ae32a1SGerd Hoffmann .eps = (USBDescEndpoint[]) { 104f1ae32a1SGerd Hoffmann { 105f1ae32a1SGerd Hoffmann .bEndpointAddress = USB_DIR_IN | 0x01, 106f1ae32a1SGerd Hoffmann .bmAttributes = USB_ENDPOINT_XFER_INT, 107f1ae32a1SGerd Hoffmann .wMaxPacketSize = 1 + (NUM_PORTS + 7) / 8, 108f1ae32a1SGerd Hoffmann .bInterval = 0xff, 109f1ae32a1SGerd Hoffmann }, 110f1ae32a1SGerd Hoffmann } 111f1ae32a1SGerd Hoffmann }; 112f1ae32a1SGerd Hoffmann 113f1ae32a1SGerd Hoffmann static const USBDescDevice desc_device_hub = { 114f1ae32a1SGerd Hoffmann .bcdUSB = 0x0110, 115f1ae32a1SGerd Hoffmann .bDeviceClass = USB_CLASS_HUB, 116f1ae32a1SGerd Hoffmann .bMaxPacketSize0 = 8, 117f1ae32a1SGerd Hoffmann .bNumConfigurations = 1, 118f1ae32a1SGerd Hoffmann .confs = (USBDescConfig[]) { 119f1ae32a1SGerd Hoffmann { 120f1ae32a1SGerd Hoffmann .bNumInterfaces = 1, 121f1ae32a1SGerd Hoffmann .bConfigurationValue = 1, 122*bd93976aSPantelis Koukousoulas .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER | 123*bd93976aSPantelis Koukousoulas USB_CFG_ATT_WAKEUP, 124f1ae32a1SGerd Hoffmann .nif = 1, 125f1ae32a1SGerd Hoffmann .ifs = &desc_iface_hub, 126f1ae32a1SGerd Hoffmann }, 127f1ae32a1SGerd Hoffmann }, 128f1ae32a1SGerd Hoffmann }; 129f1ae32a1SGerd Hoffmann 130f1ae32a1SGerd Hoffmann static const USBDesc desc_hub = { 131f1ae32a1SGerd Hoffmann .id = { 132f1ae32a1SGerd Hoffmann .idVendor = 0x0409, 133f1ae32a1SGerd Hoffmann .idProduct = 0x55aa, 134f1ae32a1SGerd Hoffmann .bcdDevice = 0x0101, 135f1ae32a1SGerd Hoffmann .iManufacturer = STR_MANUFACTURER, 136f1ae32a1SGerd Hoffmann .iProduct = STR_PRODUCT, 137f1ae32a1SGerd Hoffmann .iSerialNumber = STR_SERIALNUMBER, 138f1ae32a1SGerd Hoffmann }, 139f1ae32a1SGerd Hoffmann .full = &desc_device_hub, 140f1ae32a1SGerd Hoffmann .str = desc_strings, 141f1ae32a1SGerd Hoffmann }; 142f1ae32a1SGerd Hoffmann 143f1ae32a1SGerd Hoffmann static const uint8_t qemu_hub_hub_descriptor[] = 144f1ae32a1SGerd Hoffmann { 145f1ae32a1SGerd Hoffmann 0x00, /* u8 bLength; patched in later */ 146f1ae32a1SGerd Hoffmann 0x29, /* u8 bDescriptorType; Hub-descriptor */ 147f1ae32a1SGerd Hoffmann 0x00, /* u8 bNbrPorts; (patched later) */ 148f1ae32a1SGerd Hoffmann 0x0a, /* u16 wHubCharacteristics; */ 149f1ae32a1SGerd Hoffmann 0x00, /* (per-port OC, no power switching) */ 150f1ae32a1SGerd Hoffmann 0x01, /* u8 bPwrOn2pwrGood; 2ms */ 151f1ae32a1SGerd Hoffmann 0x00 /* u8 bHubContrCurrent; 0 mA */ 152f1ae32a1SGerd Hoffmann 153f1ae32a1SGerd Hoffmann /* DeviceRemovable and PortPwrCtrlMask patched in later */ 154f1ae32a1SGerd Hoffmann }; 155f1ae32a1SGerd Hoffmann 156f1ae32a1SGerd Hoffmann static void usb_hub_attach(USBPort *port1) 157f1ae32a1SGerd Hoffmann { 158f1ae32a1SGerd Hoffmann USBHubState *s = port1->opaque; 159f1ae32a1SGerd Hoffmann USBHubPort *port = &s->ports[port1->index]; 160f1ae32a1SGerd Hoffmann 161529f8f9fSGerd Hoffmann trace_usb_hub_attach(s->dev.addr, port1->index + 1); 162f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_CONNECTION; 163f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_CONNECTION; 164f1ae32a1SGerd Hoffmann if (port->port.dev->speed == USB_SPEED_LOW) { 165f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_LOW_SPEED; 166f1ae32a1SGerd Hoffmann } else { 167f1ae32a1SGerd Hoffmann port->wPortStatus &= ~PORT_STAT_LOW_SPEED; 168f1ae32a1SGerd Hoffmann } 1698550a02dSGerd Hoffmann usb_wakeup(s->intr, 0); 170f1ae32a1SGerd Hoffmann } 171f1ae32a1SGerd Hoffmann 172f1ae32a1SGerd Hoffmann static void usb_hub_detach(USBPort *port1) 173f1ae32a1SGerd Hoffmann { 174f1ae32a1SGerd Hoffmann USBHubState *s = port1->opaque; 175f1ae32a1SGerd Hoffmann USBHubPort *port = &s->ports[port1->index]; 176f1ae32a1SGerd Hoffmann 177529f8f9fSGerd Hoffmann trace_usb_hub_detach(s->dev.addr, port1->index + 1); 1788550a02dSGerd Hoffmann usb_wakeup(s->intr, 0); 179f1ae32a1SGerd Hoffmann 180f1ae32a1SGerd Hoffmann /* Let upstream know the device on this port is gone */ 181f1ae32a1SGerd Hoffmann s->dev.port->ops->child_detach(s->dev.port, port1->dev); 182f1ae32a1SGerd Hoffmann 183f1ae32a1SGerd Hoffmann port->wPortStatus &= ~PORT_STAT_CONNECTION; 184f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_CONNECTION; 185f1ae32a1SGerd Hoffmann if (port->wPortStatus & PORT_STAT_ENABLE) { 186f1ae32a1SGerd Hoffmann port->wPortStatus &= ~PORT_STAT_ENABLE; 187f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_ENABLE; 188f1ae32a1SGerd Hoffmann } 1898550a02dSGerd Hoffmann usb_wakeup(s->intr, 0); 190f1ae32a1SGerd Hoffmann } 191f1ae32a1SGerd Hoffmann 192f1ae32a1SGerd Hoffmann static void usb_hub_child_detach(USBPort *port1, USBDevice *child) 193f1ae32a1SGerd Hoffmann { 194f1ae32a1SGerd Hoffmann USBHubState *s = port1->opaque; 195f1ae32a1SGerd Hoffmann 196f1ae32a1SGerd Hoffmann /* Pass along upstream */ 197f1ae32a1SGerd Hoffmann s->dev.port->ops->child_detach(s->dev.port, child); 198f1ae32a1SGerd Hoffmann } 199f1ae32a1SGerd Hoffmann 200f1ae32a1SGerd Hoffmann static void usb_hub_wakeup(USBPort *port1) 201f1ae32a1SGerd Hoffmann { 202f1ae32a1SGerd Hoffmann USBHubState *s = port1->opaque; 203f1ae32a1SGerd Hoffmann USBHubPort *port = &s->ports[port1->index]; 204f1ae32a1SGerd Hoffmann 205f1ae32a1SGerd Hoffmann if (port->wPortStatus & PORT_STAT_SUSPEND) { 206f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_SUSPEND; 2078550a02dSGerd Hoffmann usb_wakeup(s->intr, 0); 208f1ae32a1SGerd Hoffmann } 209f1ae32a1SGerd Hoffmann } 210f1ae32a1SGerd Hoffmann 211f1ae32a1SGerd Hoffmann static void usb_hub_complete(USBPort *port, USBPacket *packet) 212f1ae32a1SGerd Hoffmann { 213f1ae32a1SGerd Hoffmann USBHubState *s = port->opaque; 214f1ae32a1SGerd Hoffmann 215f1ae32a1SGerd Hoffmann /* 216f1ae32a1SGerd Hoffmann * Just pass it along upstream for now. 217f1ae32a1SGerd Hoffmann * 218f1ae32a1SGerd Hoffmann * If we ever implement usb 2.0 split transactions this will 219f1ae32a1SGerd Hoffmann * become a little more complicated ... 220f1ae32a1SGerd Hoffmann * 221f1ae32a1SGerd Hoffmann * Can't use usb_packet_complete() here because packet->owner is 222f1ae32a1SGerd Hoffmann * cleared already, go call the ->complete() callback directly 223f1ae32a1SGerd Hoffmann * instead. 224f1ae32a1SGerd Hoffmann */ 225f1ae32a1SGerd Hoffmann s->dev.port->ops->complete(s->dev.port, packet); 226f1ae32a1SGerd Hoffmann } 227f1ae32a1SGerd Hoffmann 228f1ae32a1SGerd Hoffmann static USBDevice *usb_hub_find_device(USBDevice *dev, uint8_t addr) 229f1ae32a1SGerd Hoffmann { 230f1ae32a1SGerd Hoffmann USBHubState *s = DO_UPCAST(USBHubState, dev, dev); 231f1ae32a1SGerd Hoffmann USBHubPort *port; 232f1ae32a1SGerd Hoffmann USBDevice *downstream; 233f1ae32a1SGerd Hoffmann int i; 234f1ae32a1SGerd Hoffmann 235f1ae32a1SGerd Hoffmann for (i = 0; i < NUM_PORTS; i++) { 236f1ae32a1SGerd Hoffmann port = &s->ports[i]; 237f1ae32a1SGerd Hoffmann if (!(port->wPortStatus & PORT_STAT_ENABLE)) { 238f1ae32a1SGerd Hoffmann continue; 239f1ae32a1SGerd Hoffmann } 240f1ae32a1SGerd Hoffmann downstream = usb_find_device(&port->port, addr); 241f1ae32a1SGerd Hoffmann if (downstream != NULL) { 242f1ae32a1SGerd Hoffmann return downstream; 243f1ae32a1SGerd Hoffmann } 244f1ae32a1SGerd Hoffmann } 245f1ae32a1SGerd Hoffmann return NULL; 246f1ae32a1SGerd Hoffmann } 247f1ae32a1SGerd Hoffmann 248f1ae32a1SGerd Hoffmann static void usb_hub_handle_reset(USBDevice *dev) 249f1ae32a1SGerd Hoffmann { 250f1ae32a1SGerd Hoffmann USBHubState *s = DO_UPCAST(USBHubState, dev, dev); 251f1ae32a1SGerd Hoffmann USBHubPort *port; 252f1ae32a1SGerd Hoffmann int i; 253f1ae32a1SGerd Hoffmann 254529f8f9fSGerd Hoffmann trace_usb_hub_reset(s->dev.addr); 255f1ae32a1SGerd Hoffmann for (i = 0; i < NUM_PORTS; i++) { 256f1ae32a1SGerd Hoffmann port = s->ports + i; 257f1ae32a1SGerd Hoffmann port->wPortStatus = PORT_STAT_POWER; 258f1ae32a1SGerd Hoffmann port->wPortChange = 0; 259f1ae32a1SGerd Hoffmann if (port->port.dev && port->port.dev->attached) { 260f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_CONNECTION; 261f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_CONNECTION; 262f1ae32a1SGerd Hoffmann if (port->port.dev->speed == USB_SPEED_LOW) { 263f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_LOW_SPEED; 264f1ae32a1SGerd Hoffmann } 265f1ae32a1SGerd Hoffmann } 266f1ae32a1SGerd Hoffmann } 267f1ae32a1SGerd Hoffmann } 268f1ae32a1SGerd Hoffmann 269529f8f9fSGerd Hoffmann static const char *feature_name(int feature) 270529f8f9fSGerd Hoffmann { 271529f8f9fSGerd Hoffmann static const char *name[] = { 272529f8f9fSGerd Hoffmann [PORT_CONNECTION] = "connection", 273529f8f9fSGerd Hoffmann [PORT_ENABLE] = "enable", 274529f8f9fSGerd Hoffmann [PORT_SUSPEND] = "suspend", 275529f8f9fSGerd Hoffmann [PORT_OVERCURRENT] = "overcurrent", 276529f8f9fSGerd Hoffmann [PORT_RESET] = "reset", 277529f8f9fSGerd Hoffmann [PORT_POWER] = "power", 278529f8f9fSGerd Hoffmann [PORT_LOWSPEED] = "lowspeed", 279529f8f9fSGerd Hoffmann [PORT_HIGHSPEED] = "highspeed", 280529f8f9fSGerd Hoffmann [PORT_C_CONNECTION] = "change connection", 281529f8f9fSGerd Hoffmann [PORT_C_ENABLE] = "change enable", 282529f8f9fSGerd Hoffmann [PORT_C_SUSPEND] = "change suspend", 283529f8f9fSGerd Hoffmann [PORT_C_OVERCURRENT] = "change overcurrent", 284529f8f9fSGerd Hoffmann [PORT_C_RESET] = "change reset", 285529f8f9fSGerd Hoffmann [PORT_TEST] = "test", 286529f8f9fSGerd Hoffmann [PORT_INDICATOR] = "indicator", 287529f8f9fSGerd Hoffmann }; 288529f8f9fSGerd Hoffmann if (feature < 0 || feature >= ARRAY_SIZE(name)) { 289529f8f9fSGerd Hoffmann return "?"; 290529f8f9fSGerd Hoffmann } 291529f8f9fSGerd Hoffmann return name[feature] ?: "?"; 292529f8f9fSGerd Hoffmann } 293529f8f9fSGerd Hoffmann 2949a77a0f5SHans de Goede static void usb_hub_handle_control(USBDevice *dev, USBPacket *p, 295f1ae32a1SGerd Hoffmann int request, int value, int index, int length, uint8_t *data) 296f1ae32a1SGerd Hoffmann { 297f1ae32a1SGerd Hoffmann USBHubState *s = (USBHubState *)dev; 298f1ae32a1SGerd Hoffmann int ret; 299f1ae32a1SGerd Hoffmann 300529f8f9fSGerd Hoffmann trace_usb_hub_control(s->dev.addr, request, value, index, length); 301529f8f9fSGerd Hoffmann 302f1ae32a1SGerd Hoffmann ret = usb_desc_handle_control(dev, p, request, value, index, length, data); 303f1ae32a1SGerd Hoffmann if (ret >= 0) { 3049a77a0f5SHans de Goede return; 305f1ae32a1SGerd Hoffmann } 306f1ae32a1SGerd Hoffmann 307f1ae32a1SGerd Hoffmann switch(request) { 308f1ae32a1SGerd Hoffmann case EndpointOutRequest | USB_REQ_CLEAR_FEATURE: 309f1ae32a1SGerd Hoffmann if (value == 0 && index != 0x81) { /* clear ep halt */ 310f1ae32a1SGerd Hoffmann goto fail; 311f1ae32a1SGerd Hoffmann } 312f1ae32a1SGerd Hoffmann break; 313f1ae32a1SGerd Hoffmann /* usb specific requests */ 314f1ae32a1SGerd Hoffmann case GetHubStatus: 315f1ae32a1SGerd Hoffmann data[0] = 0; 316f1ae32a1SGerd Hoffmann data[1] = 0; 317f1ae32a1SGerd Hoffmann data[2] = 0; 318f1ae32a1SGerd Hoffmann data[3] = 0; 3199a77a0f5SHans de Goede p->actual_length = 4; 320f1ae32a1SGerd Hoffmann break; 321f1ae32a1SGerd Hoffmann case GetPortStatus: 322f1ae32a1SGerd Hoffmann { 323f1ae32a1SGerd Hoffmann unsigned int n = index - 1; 324f1ae32a1SGerd Hoffmann USBHubPort *port; 325f1ae32a1SGerd Hoffmann if (n >= NUM_PORTS) { 326f1ae32a1SGerd Hoffmann goto fail; 327f1ae32a1SGerd Hoffmann } 328f1ae32a1SGerd Hoffmann port = &s->ports[n]; 329529f8f9fSGerd Hoffmann trace_usb_hub_get_port_status(s->dev.addr, index, 330529f8f9fSGerd Hoffmann port->wPortStatus, 331529f8f9fSGerd Hoffmann port->wPortChange); 332f1ae32a1SGerd Hoffmann data[0] = port->wPortStatus; 333f1ae32a1SGerd Hoffmann data[1] = port->wPortStatus >> 8; 334f1ae32a1SGerd Hoffmann data[2] = port->wPortChange; 335f1ae32a1SGerd Hoffmann data[3] = port->wPortChange >> 8; 3369a77a0f5SHans de Goede p->actual_length = 4; 337f1ae32a1SGerd Hoffmann } 338f1ae32a1SGerd Hoffmann break; 339f1ae32a1SGerd Hoffmann case SetHubFeature: 340f1ae32a1SGerd Hoffmann case ClearHubFeature: 3419a77a0f5SHans de Goede if (value != 0 && value != 1) { 342f1ae32a1SGerd Hoffmann goto fail; 343f1ae32a1SGerd Hoffmann } 344f1ae32a1SGerd Hoffmann break; 345f1ae32a1SGerd Hoffmann case SetPortFeature: 346f1ae32a1SGerd Hoffmann { 347f1ae32a1SGerd Hoffmann unsigned int n = index - 1; 348f1ae32a1SGerd Hoffmann USBHubPort *port; 349f1ae32a1SGerd Hoffmann USBDevice *dev; 350529f8f9fSGerd Hoffmann 351529f8f9fSGerd Hoffmann trace_usb_hub_set_port_feature(s->dev.addr, index, 352529f8f9fSGerd Hoffmann feature_name(value)); 353529f8f9fSGerd Hoffmann 354f1ae32a1SGerd Hoffmann if (n >= NUM_PORTS) { 355f1ae32a1SGerd Hoffmann goto fail; 356f1ae32a1SGerd Hoffmann } 357f1ae32a1SGerd Hoffmann port = &s->ports[n]; 358f1ae32a1SGerd Hoffmann dev = port->port.dev; 359f1ae32a1SGerd Hoffmann switch(value) { 360f1ae32a1SGerd Hoffmann case PORT_SUSPEND: 361f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_SUSPEND; 362f1ae32a1SGerd Hoffmann break; 363f1ae32a1SGerd Hoffmann case PORT_RESET: 364f1ae32a1SGerd Hoffmann if (dev && dev->attached) { 365f1ae32a1SGerd Hoffmann usb_device_reset(dev); 366f1ae32a1SGerd Hoffmann port->wPortChange |= PORT_STAT_C_RESET; 367f1ae32a1SGerd Hoffmann /* set enable bit */ 368f1ae32a1SGerd Hoffmann port->wPortStatus |= PORT_STAT_ENABLE; 3698550a02dSGerd Hoffmann usb_wakeup(s->intr, 0); 370f1ae32a1SGerd Hoffmann } 371f1ae32a1SGerd Hoffmann break; 372f1ae32a1SGerd Hoffmann case PORT_POWER: 373f1ae32a1SGerd Hoffmann break; 374f1ae32a1SGerd Hoffmann default: 375f1ae32a1SGerd Hoffmann goto fail; 376f1ae32a1SGerd Hoffmann } 377f1ae32a1SGerd Hoffmann } 378f1ae32a1SGerd Hoffmann break; 379f1ae32a1SGerd Hoffmann case ClearPortFeature: 380f1ae32a1SGerd Hoffmann { 381f1ae32a1SGerd Hoffmann unsigned int n = index - 1; 382f1ae32a1SGerd Hoffmann USBHubPort *port; 383f1ae32a1SGerd Hoffmann 384529f8f9fSGerd Hoffmann trace_usb_hub_clear_port_feature(s->dev.addr, index, 385529f8f9fSGerd Hoffmann feature_name(value)); 386529f8f9fSGerd Hoffmann 387f1ae32a1SGerd Hoffmann if (n >= NUM_PORTS) { 388f1ae32a1SGerd Hoffmann goto fail; 389f1ae32a1SGerd Hoffmann } 390f1ae32a1SGerd Hoffmann port = &s->ports[n]; 391f1ae32a1SGerd Hoffmann switch(value) { 392f1ae32a1SGerd Hoffmann case PORT_ENABLE: 393f1ae32a1SGerd Hoffmann port->wPortStatus &= ~PORT_STAT_ENABLE; 394f1ae32a1SGerd Hoffmann break; 395f1ae32a1SGerd Hoffmann case PORT_C_ENABLE: 396f1ae32a1SGerd Hoffmann port->wPortChange &= ~PORT_STAT_C_ENABLE; 397f1ae32a1SGerd Hoffmann break; 398f1ae32a1SGerd Hoffmann case PORT_SUSPEND: 399f1ae32a1SGerd Hoffmann port->wPortStatus &= ~PORT_STAT_SUSPEND; 400f1ae32a1SGerd Hoffmann break; 401f1ae32a1SGerd Hoffmann case PORT_C_SUSPEND: 402f1ae32a1SGerd Hoffmann port->wPortChange &= ~PORT_STAT_C_SUSPEND; 403f1ae32a1SGerd Hoffmann break; 404f1ae32a1SGerd Hoffmann case PORT_C_CONNECTION: 405f1ae32a1SGerd Hoffmann port->wPortChange &= ~PORT_STAT_C_CONNECTION; 406f1ae32a1SGerd Hoffmann break; 407f1ae32a1SGerd Hoffmann case PORT_C_OVERCURRENT: 408f1ae32a1SGerd Hoffmann port->wPortChange &= ~PORT_STAT_C_OVERCURRENT; 409f1ae32a1SGerd Hoffmann break; 410f1ae32a1SGerd Hoffmann case PORT_C_RESET: 411f1ae32a1SGerd Hoffmann port->wPortChange &= ~PORT_STAT_C_RESET; 412f1ae32a1SGerd Hoffmann break; 413f1ae32a1SGerd Hoffmann default: 414f1ae32a1SGerd Hoffmann goto fail; 415f1ae32a1SGerd Hoffmann } 416f1ae32a1SGerd Hoffmann } 417f1ae32a1SGerd Hoffmann break; 418f1ae32a1SGerd Hoffmann case GetHubDescriptor: 419f1ae32a1SGerd Hoffmann { 420f1ae32a1SGerd Hoffmann unsigned int n, limit, var_hub_size = 0; 421f1ae32a1SGerd Hoffmann memcpy(data, qemu_hub_hub_descriptor, 422f1ae32a1SGerd Hoffmann sizeof(qemu_hub_hub_descriptor)); 423f1ae32a1SGerd Hoffmann data[2] = NUM_PORTS; 424f1ae32a1SGerd Hoffmann 425f1ae32a1SGerd Hoffmann /* fill DeviceRemovable bits */ 426f1ae32a1SGerd Hoffmann limit = ((NUM_PORTS + 1 + 7) / 8) + 7; 427f1ae32a1SGerd Hoffmann for (n = 7; n < limit; n++) { 428f1ae32a1SGerd Hoffmann data[n] = 0x00; 429f1ae32a1SGerd Hoffmann var_hub_size++; 430f1ae32a1SGerd Hoffmann } 431f1ae32a1SGerd Hoffmann 432f1ae32a1SGerd Hoffmann /* fill PortPwrCtrlMask bits */ 433f1ae32a1SGerd Hoffmann limit = limit + ((NUM_PORTS + 7) / 8); 434f1ae32a1SGerd Hoffmann for (;n < limit; n++) { 435f1ae32a1SGerd Hoffmann data[n] = 0xff; 436f1ae32a1SGerd Hoffmann var_hub_size++; 437f1ae32a1SGerd Hoffmann } 438f1ae32a1SGerd Hoffmann 4399a77a0f5SHans de Goede p->actual_length = sizeof(qemu_hub_hub_descriptor) + var_hub_size; 4409a77a0f5SHans de Goede data[0] = p->actual_length; 441f1ae32a1SGerd Hoffmann break; 442f1ae32a1SGerd Hoffmann } 443f1ae32a1SGerd Hoffmann default: 444f1ae32a1SGerd Hoffmann fail: 4459a77a0f5SHans de Goede p->status = USB_RET_STALL; 446f1ae32a1SGerd Hoffmann break; 447f1ae32a1SGerd Hoffmann } 448f1ae32a1SGerd Hoffmann } 449f1ae32a1SGerd Hoffmann 4509a77a0f5SHans de Goede static void usb_hub_handle_data(USBDevice *dev, USBPacket *p) 451f1ae32a1SGerd Hoffmann { 452f1ae32a1SGerd Hoffmann USBHubState *s = (USBHubState *)dev; 453f1ae32a1SGerd Hoffmann 454f1ae32a1SGerd Hoffmann switch(p->pid) { 455f1ae32a1SGerd Hoffmann case USB_TOKEN_IN: 456f1ae32a1SGerd Hoffmann if (p->ep->nr == 1) { 457f1ae32a1SGerd Hoffmann USBHubPort *port; 458f1ae32a1SGerd Hoffmann unsigned int status; 459f1ae32a1SGerd Hoffmann uint8_t buf[4]; 460f1ae32a1SGerd Hoffmann int i, n; 461f1ae32a1SGerd Hoffmann n = (NUM_PORTS + 1 + 7) / 8; 462f1ae32a1SGerd Hoffmann if (p->iov.size == 1) { /* FreeBSD workaround */ 463f1ae32a1SGerd Hoffmann n = 1; 464f1ae32a1SGerd Hoffmann } else if (n > p->iov.size) { 4659a77a0f5SHans de Goede p->status = USB_RET_BABBLE; 4669a77a0f5SHans de Goede return; 467f1ae32a1SGerd Hoffmann } 468f1ae32a1SGerd Hoffmann status = 0; 469f1ae32a1SGerd Hoffmann for(i = 0; i < NUM_PORTS; i++) { 470f1ae32a1SGerd Hoffmann port = &s->ports[i]; 471bdebd6eeSGerd Hoffmann if (port->wPortChange) 472f1ae32a1SGerd Hoffmann status |= (1 << (i + 1)); 473f1ae32a1SGerd Hoffmann } 474f1ae32a1SGerd Hoffmann if (status != 0) { 475b8cbc137SGerd Hoffmann trace_usb_hub_status_report(s->dev.addr, status); 476f1ae32a1SGerd Hoffmann for(i = 0; i < n; i++) { 477f1ae32a1SGerd Hoffmann buf[i] = status >> (8 * i); 478f1ae32a1SGerd Hoffmann } 479f1ae32a1SGerd Hoffmann usb_packet_copy(p, buf, n); 480f1ae32a1SGerd Hoffmann } else { 4819a77a0f5SHans de Goede p->status = USB_RET_NAK; /* usb11 11.13.1 */ 482f1ae32a1SGerd Hoffmann } 483f1ae32a1SGerd Hoffmann } else { 484f1ae32a1SGerd Hoffmann goto fail; 485f1ae32a1SGerd Hoffmann } 486f1ae32a1SGerd Hoffmann break; 487f1ae32a1SGerd Hoffmann case USB_TOKEN_OUT: 488f1ae32a1SGerd Hoffmann default: 489f1ae32a1SGerd Hoffmann fail: 4909a77a0f5SHans de Goede p->status = USB_RET_STALL; 491f1ae32a1SGerd Hoffmann break; 492f1ae32a1SGerd Hoffmann } 493f1ae32a1SGerd Hoffmann } 494f1ae32a1SGerd Hoffmann 495f1ae32a1SGerd Hoffmann static void usb_hub_handle_destroy(USBDevice *dev) 496f1ae32a1SGerd Hoffmann { 497f1ae32a1SGerd Hoffmann USBHubState *s = (USBHubState *)dev; 498f1ae32a1SGerd Hoffmann int i; 499f1ae32a1SGerd Hoffmann 500f1ae32a1SGerd Hoffmann for (i = 0; i < NUM_PORTS; i++) { 501f1ae32a1SGerd Hoffmann usb_unregister_port(usb_bus_from_device(dev), 502f1ae32a1SGerd Hoffmann &s->ports[i].port); 503f1ae32a1SGerd Hoffmann } 504f1ae32a1SGerd Hoffmann } 505f1ae32a1SGerd Hoffmann 506f1ae32a1SGerd Hoffmann static USBPortOps usb_hub_port_ops = { 507f1ae32a1SGerd Hoffmann .attach = usb_hub_attach, 508f1ae32a1SGerd Hoffmann .detach = usb_hub_detach, 509f1ae32a1SGerd Hoffmann .child_detach = usb_hub_child_detach, 510f1ae32a1SGerd Hoffmann .wakeup = usb_hub_wakeup, 511f1ae32a1SGerd Hoffmann .complete = usb_hub_complete, 512f1ae32a1SGerd Hoffmann }; 513f1ae32a1SGerd Hoffmann 514f1ae32a1SGerd Hoffmann static int usb_hub_initfn(USBDevice *dev) 515f1ae32a1SGerd Hoffmann { 516f1ae32a1SGerd Hoffmann USBHubState *s = DO_UPCAST(USBHubState, dev, dev); 517f1ae32a1SGerd Hoffmann USBHubPort *port; 518f1ae32a1SGerd Hoffmann int i; 519f1ae32a1SGerd Hoffmann 520c24e4aacSGerd Hoffmann if (dev->port->hubcount == 5) { 521c24e4aacSGerd Hoffmann error_report("usb hub chain too deep"); 522c24e4aacSGerd Hoffmann return -1; 523c24e4aacSGerd Hoffmann } 524c24e4aacSGerd Hoffmann 5259d55d1adSGerd Hoffmann usb_desc_create_serial(dev); 526f1ae32a1SGerd Hoffmann usb_desc_init(dev); 527f1ae32a1SGerd Hoffmann s->intr = usb_ep_get(dev, USB_TOKEN_IN, 1); 528f1ae32a1SGerd Hoffmann for (i = 0; i < NUM_PORTS; i++) { 529f1ae32a1SGerd Hoffmann port = &s->ports[i]; 530f1ae32a1SGerd Hoffmann usb_register_port(usb_bus_from_device(dev), 531f1ae32a1SGerd Hoffmann &port->port, s, i, &usb_hub_port_ops, 532f1ae32a1SGerd Hoffmann USB_SPEED_MASK_LOW | USB_SPEED_MASK_FULL); 533f1ae32a1SGerd Hoffmann usb_port_location(&port->port, dev->port, i+1); 534f1ae32a1SGerd Hoffmann } 535f1ae32a1SGerd Hoffmann usb_hub_handle_reset(dev); 536f1ae32a1SGerd Hoffmann return 0; 537f1ae32a1SGerd Hoffmann } 538f1ae32a1SGerd Hoffmann 539f1ae32a1SGerd Hoffmann static const VMStateDescription vmstate_usb_hub_port = { 540f1ae32a1SGerd Hoffmann .name = "usb-hub-port", 541f1ae32a1SGerd Hoffmann .version_id = 1, 542f1ae32a1SGerd Hoffmann .minimum_version_id = 1, 543f1ae32a1SGerd Hoffmann .fields = (VMStateField []) { 544f1ae32a1SGerd Hoffmann VMSTATE_UINT16(wPortStatus, USBHubPort), 545f1ae32a1SGerd Hoffmann VMSTATE_UINT16(wPortChange, USBHubPort), 546f1ae32a1SGerd Hoffmann VMSTATE_END_OF_LIST() 547f1ae32a1SGerd Hoffmann } 548f1ae32a1SGerd Hoffmann }; 549f1ae32a1SGerd Hoffmann 550f1ae32a1SGerd Hoffmann static const VMStateDescription vmstate_usb_hub = { 551f1ae32a1SGerd Hoffmann .name = "usb-hub", 552f1ae32a1SGerd Hoffmann .version_id = 1, 553f1ae32a1SGerd Hoffmann .minimum_version_id = 1, 554f1ae32a1SGerd Hoffmann .fields = (VMStateField []) { 555f1ae32a1SGerd Hoffmann VMSTATE_USB_DEVICE(dev, USBHubState), 556f1ae32a1SGerd Hoffmann VMSTATE_STRUCT_ARRAY(ports, USBHubState, NUM_PORTS, 0, 557f1ae32a1SGerd Hoffmann vmstate_usb_hub_port, USBHubPort), 558f1ae32a1SGerd Hoffmann VMSTATE_END_OF_LIST() 559f1ae32a1SGerd Hoffmann } 560f1ae32a1SGerd Hoffmann }; 561f1ae32a1SGerd Hoffmann 562f1ae32a1SGerd Hoffmann static void usb_hub_class_initfn(ObjectClass *klass, void *data) 563f1ae32a1SGerd Hoffmann { 564f1ae32a1SGerd Hoffmann DeviceClass *dc = DEVICE_CLASS(klass); 565f1ae32a1SGerd Hoffmann USBDeviceClass *uc = USB_DEVICE_CLASS(klass); 566f1ae32a1SGerd Hoffmann 567f1ae32a1SGerd Hoffmann uc->init = usb_hub_initfn; 568f1ae32a1SGerd Hoffmann uc->product_desc = "QEMU USB Hub"; 569f1ae32a1SGerd Hoffmann uc->usb_desc = &desc_hub; 570f1ae32a1SGerd Hoffmann uc->find_device = usb_hub_find_device; 571f1ae32a1SGerd Hoffmann uc->handle_reset = usb_hub_handle_reset; 572f1ae32a1SGerd Hoffmann uc->handle_control = usb_hub_handle_control; 573f1ae32a1SGerd Hoffmann uc->handle_data = usb_hub_handle_data; 574f1ae32a1SGerd Hoffmann uc->handle_destroy = usb_hub_handle_destroy; 575125ee0edSMarcel Apfelbaum set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories); 576f1ae32a1SGerd Hoffmann dc->fw_name = "hub"; 577f1ae32a1SGerd Hoffmann dc->vmsd = &vmstate_usb_hub; 578f1ae32a1SGerd Hoffmann } 579f1ae32a1SGerd Hoffmann 5808c43a6f0SAndreas Färber static const TypeInfo hub_info = { 581f1ae32a1SGerd Hoffmann .name = "usb-hub", 582f1ae32a1SGerd Hoffmann .parent = TYPE_USB_DEVICE, 583f1ae32a1SGerd Hoffmann .instance_size = sizeof(USBHubState), 584f1ae32a1SGerd Hoffmann .class_init = usb_hub_class_initfn, 585f1ae32a1SGerd Hoffmann }; 586f1ae32a1SGerd Hoffmann 587f1ae32a1SGerd Hoffmann static void usb_hub_register_types(void) 588f1ae32a1SGerd Hoffmann { 589f1ae32a1SGerd Hoffmann type_register_static(&hub_info); 590f1ae32a1SGerd Hoffmann } 591f1ae32a1SGerd Hoffmann 592f1ae32a1SGerd Hoffmann type_init(usb_hub_register_types) 593