4 * Copyright (c) 2005 Fabrice Bellard
6 * Permission is hereby granted, free of charge, to any person obtaining a copy
7 * of this software and associated documentation files (the "Software"), to deal
8 * in the Software without restriction, including without limitation the rights
9 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10 * copies of the Software, and to permit persons to whom the Software is
11 * furnished to do so, subject to the following conditions:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
16 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
26 void usb_attach(USBPort
*port
, USBDevice
*dev
)
28 port
->attach(port
, dev
);
31 /**********************/
32 /* generic USB device helpers (you are not forced to use them when
33 writing your USB device driver, but they help handling the
37 #define SETUP_STATE_IDLE 0
38 #define SETUP_STATE_DATA 1
39 #define SETUP_STATE_ACK 2
41 int usb_generic_handle_packet(USBDevice
*s
, int pid
,
42 uint8_t devaddr
, uint8_t devep
,
43 uint8_t *data
, int len
)
49 s
->state
= USB_STATE_ATTACHED
;
52 s
->state
= USB_STATE_NOTATTACHED
;
57 s
->state
= USB_STATE_DEFAULT
;
61 if (s
->state
< USB_STATE_DEFAULT
|| devaddr
!= s
->addr
)
65 memcpy(s
->setup_buf
, data
, 8);
66 s
->setup_len
= (s
->setup_buf
[7] << 8) | s
->setup_buf
[6];
68 if (s
->setup_buf
[0] & USB_DIR_IN
) {
69 ret
= s
->handle_control(s
,
70 (s
->setup_buf
[0] << 8) | s
->setup_buf
[1],
71 (s
->setup_buf
[3] << 8) | s
->setup_buf
[2],
72 (s
->setup_buf
[5] << 8) | s
->setup_buf
[4],
77 if (ret
< s
->setup_len
)
79 s
->setup_state
= SETUP_STATE_DATA
;
81 if (s
->setup_len
== 0)
82 s
->setup_state
= SETUP_STATE_ACK
;
84 s
->setup_state
= SETUP_STATE_DATA
;
88 if (s
->state
< USB_STATE_DEFAULT
|| devaddr
!= s
->addr
)
92 switch(s
->setup_state
) {
94 s
->setup_state
= SETUP_STATE_IDLE
;
95 if (!(s
->setup_buf
[0] & USB_DIR_IN
)) {
96 ret
= s
->handle_control(s
,
97 (s
->setup_buf
[0] << 8) | s
->setup_buf
[1],
98 (s
->setup_buf
[3] << 8) | s
->setup_buf
[2],
99 (s
->setup_buf
[5] << 8) | s
->setup_buf
[4],
108 case SETUP_STATE_DATA
:
109 if (s
->setup_buf
[0] & USB_DIR_IN
) {
110 l
= s
->setup_len
- s
->setup_index
;
113 memcpy(data
, s
->data_buf
+ s
->setup_index
, l
);
115 if (s
->setup_index
>= s
->setup_len
)
116 s
->setup_state
= SETUP_STATE_ACK
;
119 s
->setup_state
= SETUP_STATE_IDLE
;
128 ret
= s
->handle_data(s
, pid
, devep
, data
, len
);
133 if (s
->state
< USB_STATE_DEFAULT
|| devaddr
!= s
->addr
)
134 return USB_RET_NODEV
;
137 switch(s
->setup_state
) {
138 case SETUP_STATE_ACK
:
139 s
->setup_state
= SETUP_STATE_IDLE
;
140 if (s
->setup_buf
[0] & USB_DIR_IN
) {
146 case SETUP_STATE_DATA
:
147 if (!(s
->setup_buf
[0] & USB_DIR_IN
)) {
148 l
= s
->setup_len
- s
->setup_index
;
151 memcpy(s
->data_buf
+ s
->setup_index
, data
, l
);
153 if (s
->setup_index
>= s
->setup_len
)
154 s
->setup_state
= SETUP_STATE_ACK
;
157 s
->setup_state
= SETUP_STATE_IDLE
;
166 ret
= s
->handle_data(s
, pid
, devep
, data
, len
);
178 /* XXX: fix overflow */
179 int set_usb_string(uint8_t *buf
, const char *str
)
188 for(i
= 0; i
< len
; i
++) {
195 /**********************/
196 /* USB hub emulation */
202 typedef struct USBHubPort
{
205 uint16_t wPortStatus
;
206 uint16_t wPortChange
;
209 typedef struct USBHubState
{
212 USBHubPort ports
[MAX_PORTS
];
215 #define ClearHubFeature (0x2000 | USB_REQ_CLEAR_FEATURE)
216 #define ClearPortFeature (0x2300 | USB_REQ_CLEAR_FEATURE)
217 #define GetHubDescriptor (0xa000 | USB_REQ_GET_DESCRIPTOR)
218 #define GetHubStatus (0xa000 | USB_REQ_GET_STATUS)
219 #define GetPortStatus (0xa300 | USB_REQ_GET_STATUS)
220 #define SetHubFeature (0x2000 | USB_REQ_SET_FEATURE)
221 #define SetPortFeature (0x2300 | USB_REQ_SET_FEATURE)
223 #define PORT_STAT_CONNECTION 0x0001
224 #define PORT_STAT_ENABLE 0x0002
225 #define PORT_STAT_SUSPEND 0x0004
226 #define PORT_STAT_OVERCURRENT 0x0008
227 #define PORT_STAT_RESET 0x0010
228 #define PORT_STAT_POWER 0x0100
229 #define PORT_STAT_LOW_SPEED 0x0200
230 #define PORT_STAT_HIGH_SPEED 0x0400
231 #define PORT_STAT_TEST 0x0800
232 #define PORT_STAT_INDICATOR 0x1000
234 #define PORT_STAT_C_CONNECTION 0x0001
235 #define PORT_STAT_C_ENABLE 0x0002
236 #define PORT_STAT_C_SUSPEND 0x0004
237 #define PORT_STAT_C_OVERCURRENT 0x0008
238 #define PORT_STAT_C_RESET 0x0010
240 #define PORT_CONNECTION 0
241 #define PORT_ENABLE 1
242 #define PORT_SUSPEND 2
243 #define PORT_OVERCURRENT 3
246 #define PORT_LOWSPEED 9
247 #define PORT_HIGHSPEED 10
248 #define PORT_C_CONNECTION 16
249 #define PORT_C_ENABLE 17
250 #define PORT_C_SUSPEND 18
251 #define PORT_C_OVERCURRENT 19
252 #define PORT_C_RESET 20
254 #define PORT_INDICATOR 22
256 /* same as Linux kernel root hubs */
258 static const uint8_t qemu_hub_dev_descriptor
[] = {
259 0x12, /* u8 bLength; */
260 0x01, /* u8 bDescriptorType; Device */
261 0x10, 0x01, /* u16 bcdUSB; v1.1 */
263 0x09, /* u8 bDeviceClass; HUB_CLASSCODE */
264 0x00, /* u8 bDeviceSubClass; */
265 0x00, /* u8 bDeviceProtocol; [ low/full speeds only ] */
266 0x08, /* u8 bMaxPacketSize0; 8 Bytes */
268 0x00, 0x00, /* u16 idVendor; */
269 0x00, 0x00, /* u16 idProduct; */
270 0x01, 0x01, /* u16 bcdDevice */
272 0x03, /* u8 iManufacturer; */
273 0x02, /* u8 iProduct; */
274 0x01, /* u8 iSerialNumber; */
275 0x01 /* u8 bNumConfigurations; */
278 /* XXX: patch interrupt size */
279 static const uint8_t qemu_hub_config_descriptor
[] = {
281 /* one configuration */
282 0x09, /* u8 bLength; */
283 0x02, /* u8 bDescriptorType; Configuration */
284 0x19, 0x00, /* u16 wTotalLength; */
285 0x01, /* u8 bNumInterfaces; (1) */
286 0x01, /* u8 bConfigurationValue; */
287 0x00, /* u8 iConfiguration; */
288 0xc0, /* u8 bmAttributes;
293 0x00, /* u8 MaxPower; */
296 * USB 2.0, single TT organization (mandatory):
297 * one interface, protocol 0
299 * USB 2.0, multiple TT organization (optional):
300 * two interfaces, protocols 1 (like single TT)
301 * and 2 (multiple TT mode) ... config is
307 0x09, /* u8 if_bLength; */
308 0x04, /* u8 if_bDescriptorType; Interface */
309 0x00, /* u8 if_bInterfaceNumber; */
310 0x00, /* u8 if_bAlternateSetting; */
311 0x01, /* u8 if_bNumEndpoints; */
312 0x09, /* u8 if_bInterfaceClass; HUB_CLASSCODE */
313 0x00, /* u8 if_bInterfaceSubClass; */
314 0x00, /* u8 if_bInterfaceProtocol; [usb1.1 or single tt] */
315 0x00, /* u8 if_iInterface; */
317 /* one endpoint (status change endpoint) */
318 0x07, /* u8 ep_bLength; */
319 0x05, /* u8 ep_bDescriptorType; Endpoint */
320 0x81, /* u8 ep_bEndpointAddress; IN Endpoint 1 */
321 0x03, /* u8 ep_bmAttributes; Interrupt */
322 0x02, 0x00, /* u16 ep_wMaxPacketSize; 1 + (MAX_ROOT_PORTS / 8) */
323 0xff /* u8 ep_bInterval; (255ms -- usb 2.0 spec) */
326 static const uint8_t qemu_hub_hub_descriptor
[] =
328 0x09, /* u8 bLength; */
329 0x29, /* u8 bDescriptorType; Hub-descriptor */
330 0x00, /* u8 bNbrPorts; (patched later) */
331 0x0a, /* u16 wHubCharacteristics; */
332 0x00, /* (per-port OC, no power switching) */
333 0x01, /* u8 bPwrOn2pwrGood; 2ms */
334 0x00, /* u8 bHubContrCurrent; 0 mA */
335 0x00, /* u8 DeviceRemovable; *** 7 Ports max *** */
336 0xff /* u8 PortPwrCtrlMask; *** 7 ports max *** */
339 static void usb_hub_attach(USBPort
*port1
, USBDevice
*dev
)
341 USBHubState
*s
= port1
->opaque
;
342 USBHubPort
*port
= &s
->ports
[port1
->index
];
346 usb_attach(port1
, NULL
);
348 port
->wPortStatus
|= PORT_STAT_CONNECTION
;
349 port
->wPortChange
|= PORT_STAT_C_CONNECTION
;
350 if (dev
->speed
== USB_SPEED_LOW
)
351 port
->wPortStatus
|= PORT_STAT_LOW_SPEED
;
353 port
->wPortStatus
&= ~PORT_STAT_LOW_SPEED
;
358 port
->wPortStatus
&= ~PORT_STAT_CONNECTION
;
359 port
->wPortChange
|= PORT_STAT_C_CONNECTION
;
360 if (port
->wPortStatus
& PORT_STAT_ENABLE
) {
361 port
->wPortStatus
&= ~PORT_STAT_ENABLE
;
362 port
->wPortChange
|= PORT_STAT_C_ENABLE
;
369 static void usb_hub_handle_reset(USBDevice
*dev
)
374 static int usb_hub_handle_control(USBDevice
*dev
, int request
, int value
,
375 int index
, int length
, uint8_t *data
)
377 USBHubState
*s
= (USBHubState
*)dev
;
381 case DeviceRequest
| USB_REQ_GET_STATUS
:
382 data
[0] = (1 << USB_DEVICE_SELF_POWERED
) |
383 (dev
->remote_wakeup
<< USB_DEVICE_REMOTE_WAKEUP
);
387 case DeviceOutRequest
| USB_REQ_CLEAR_FEATURE
:
388 if (value
== USB_DEVICE_REMOTE_WAKEUP
) {
389 dev
->remote_wakeup
= 0;
395 case DeviceOutRequest
| USB_REQ_SET_FEATURE
:
396 if (value
== USB_DEVICE_REMOTE_WAKEUP
) {
397 dev
->remote_wakeup
= 1;
403 case DeviceOutRequest
| USB_REQ_SET_ADDRESS
:
407 case DeviceRequest
| USB_REQ_GET_DESCRIPTOR
:
410 memcpy(data
, qemu_hub_dev_descriptor
,
411 sizeof(qemu_hub_dev_descriptor
));
412 ret
= sizeof(qemu_hub_dev_descriptor
);
415 memcpy(data
, qemu_hub_config_descriptor
,
416 sizeof(qemu_hub_config_descriptor
));
417 ret
= sizeof(qemu_hub_config_descriptor
);
420 switch(value
& 0xff) {
431 ret
= set_usb_string(data
, "314159");
434 /* product description */
435 ret
= set_usb_string(data
, "QEMU USB Hub");
438 /* vendor description */
439 ret
= set_usb_string(data
, "QEMU " QEMU_VERSION
);
449 case DeviceRequest
| USB_REQ_GET_CONFIGURATION
:
453 case DeviceOutRequest
| USB_REQ_SET_CONFIGURATION
:
456 case DeviceRequest
| USB_REQ_GET_INTERFACE
:
460 case DeviceOutRequest
| USB_REQ_SET_INTERFACE
:
463 /* usb specific requests */
473 unsigned int n
= index
- 1;
475 if (n
>= s
->nb_ports
)
478 data
[0] = port
->wPortStatus
;
479 data
[1] = port
->wPortStatus
>> 8;
480 data
[2] = port
->wPortChange
;
481 data
[3] = port
->wPortChange
>> 8;
486 case ClearHubFeature
:
487 if (value
== 0 || value
== 1) {
495 unsigned int n
= index
- 1;
498 if (n
>= s
->nb_ports
)
504 port
->wPortStatus
|= PORT_STAT_SUSPEND
;
508 dev
->handle_packet(dev
,
509 USB_MSG_RESET
, 0, 0, NULL
, 0);
510 port
->wPortChange
|= PORT_STAT_C_RESET
;
512 port
->wPortChange
|= PORT_STAT_C_ENABLE
;
513 port
->wPortStatus
|= PORT_STAT_ENABLE
;
524 case ClearPortFeature
:
526 unsigned int n
= index
- 1;
529 if (n
>= s
->nb_ports
)
535 port
->wPortStatus
&= ~PORT_STAT_ENABLE
;
538 port
->wPortChange
&= ~PORT_STAT_C_ENABLE
;
541 port
->wPortStatus
&= ~PORT_STAT_SUSPEND
;
544 port
->wPortChange
&= ~PORT_STAT_C_SUSPEND
;
546 case PORT_C_CONNECTION
:
547 port
->wPortChange
&= ~PORT_STAT_C_CONNECTION
;
549 case PORT_C_OVERCURRENT
:
550 port
->wPortChange
&= ~PORT_STAT_C_OVERCURRENT
;
553 port
->wPortChange
&= ~PORT_STAT_C_RESET
;
561 case GetHubDescriptor
:
562 memcpy(data
, qemu_hub_hub_descriptor
,
563 sizeof(qemu_hub_hub_descriptor
));
564 data
[2] = s
->nb_ports
;
565 ret
= sizeof(qemu_hub_hub_descriptor
);
575 static int usb_hub_handle_data(USBDevice
*dev
, int pid
,
576 uint8_t devep
, uint8_t *data
, int len
)
578 USBHubState
*s
= (USBHubState
*)dev
;
587 n
= (s
->nb_ports
+ 1 + 7) / 8;
589 return USB_RET_BABBLE
;
591 for(i
= 0; i
< s
->nb_ports
; i
++) {
593 if (port
->wPortChange
)
594 status
|= (1 << (i
+ 1));
597 for(i
= 0; i
< n
; i
++) {
598 data
[i
] = status
>> (8 * i
);
617 static int usb_hub_broadcast_packet(USBHubState
*s
, int pid
,
618 uint8_t devaddr
, uint8_t devep
,
619 uint8_t *data
, int len
)
625 for(i
= 0; i
< s
->nb_ports
; i
++) {
628 if (dev
&& (port
->wPortStatus
& PORT_STAT_ENABLE
)) {
629 ret
= dev
->handle_packet(dev
, pid
,
632 if (ret
!= USB_RET_NODEV
) {
637 return USB_RET_NODEV
;
640 static int usb_hub_handle_packet(USBDevice
*dev
, int pid
,
641 uint8_t devaddr
, uint8_t devep
,
642 uint8_t *data
, int len
)
644 USBHubState
*s
= (USBHubState
*)dev
;
646 #if defined(DEBUG) && 0
647 printf("usb_hub: pid=0x%x\n", pid
);
649 if (dev
->state
== USB_STATE_DEFAULT
&&
651 devaddr
!= dev
->addr
&&
652 (pid
== USB_TOKEN_SETUP
||
653 pid
== USB_TOKEN_OUT
||
654 pid
== USB_TOKEN_IN
)) {
655 /* broadcast the packet to the devices */
656 return usb_hub_broadcast_packet(s
, pid
, devaddr
, devep
, data
, len
);
658 return usb_generic_handle_packet(dev
, pid
, devaddr
, devep
, data
, len
);
661 USBDevice
*usb_hub_init(USBPort
**usb_ports
, int nb_ports
)
667 if (nb_ports
> MAX_PORTS
)
669 s
= qemu_mallocz(sizeof(USBHubState
));
672 s
->dev
.speed
= USB_SPEED_FULL
;
673 s
->dev
.handle_packet
= usb_hub_handle_packet
;
675 /* generic USB device init */
676 s
->dev
.handle_reset
= usb_hub_handle_reset
;
677 s
->dev
.handle_control
= usb_hub_handle_control
;
678 s
->dev
.handle_data
= usb_hub_handle_data
;
680 s
->nb_ports
= nb_ports
;
681 for(i
= 0; i
< s
->nb_ports
; i
++) {
683 port
->wPortStatus
= PORT_STAT_POWER
;
684 port
->wPortChange
= 0;
685 port
->port
.attach
= usb_hub_attach
;
686 port
->port
.opaque
= s
;
687 port
->port
.index
= i
;
688 usb_ports
[i
] = &port
->port
;
690 return (USBDevice
*)s
;