| /* |
| * QEMU USB Net devices |
| * |
| * Copyright (c) 2006 Thomas Sailer |
| * Copyright (c) 2008 Andrzej Zaborowski |
| * |
| * 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 "net.h" |
| #include "sys-queue.h" |
| |
| /*#define TRAFFIC_DEBUG*/ |
| /* Thanks to NetChip Technologies for donating this product ID. |
| * It's for devices with only CDC Ethernet configurations. |
| */ |
| #define CDC_VENDOR_NUM 0x0525 /* NetChip */ |
| #define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */ |
| /* For hardware that can talk RNDIS and either of the above protocols, |
| * use this ID ... the windows INF files will know it. |
| */ |
| #define RNDIS_VENDOR_NUM 0x0525 /* NetChip */ |
| #define RNDIS_PRODUCT_NUM 0xa4a2 /* Ethernet/RNDIS Gadget */ |
| |
| enum usbstring_idx { |
| STRING_MANUFACTURER = 1, |
| STRING_PRODUCT, |
| STRING_ETHADDR, |
| STRING_DATA, |
| STRING_CONTROL, |
| STRING_RNDIS_CONTROL, |
| STRING_CDC, |
| STRING_SUBSET, |
| STRING_RNDIS, |
| STRING_SERIALNUMBER, |
| }; |
| |
| #define DEV_CONFIG_VALUE 1 /* CDC or a subset */ |
| #define DEV_RNDIS_CONFIG_VALUE 2 /* RNDIS; optional */ |
| |
| #define USB_CDC_SUBCLASS_ACM 0x02 |
| #define USB_CDC_SUBCLASS_ETHERNET 0x06 |
| |
| #define USB_CDC_PROTO_NONE 0 |
| #define USB_CDC_ACM_PROTO_VENDOR 0xff |
| |
| #define USB_CDC_HEADER_TYPE 0x00 /* header_desc */ |
| #define USB_CDC_CALL_MANAGEMENT_TYPE 0x01 /* call_mgmt_descriptor */ |
| #define USB_CDC_ACM_TYPE 0x02 /* acm_descriptor */ |
| #define USB_CDC_UNION_TYPE 0x06 /* union_desc */ |
| #define USB_CDC_ETHERNET_TYPE 0x0f /* ether_desc */ |
| |
| #define USB_DT_CS_INTERFACE 0x24 |
| #define USB_DT_CS_ENDPOINT 0x25 |
| |
| #define ClassInterfaceRequest \ |
| ((USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE) << 8) |
| #define ClassInterfaceOutRequest \ |
| ((USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE) << 8) |
| |
| #define USB_CDC_SEND_ENCAPSULATED_COMMAND 0x00 |
| #define USB_CDC_GET_ENCAPSULATED_RESPONSE 0x01 |
| #define USB_CDC_REQ_SET_LINE_CODING 0x20 |
| #define USB_CDC_REQ_GET_LINE_CODING 0x21 |
| #define USB_CDC_REQ_SET_CONTROL_LINE_STATE 0x22 |
| #define USB_CDC_REQ_SEND_BREAK 0x23 |
| #define USB_CDC_SET_ETHERNET_MULTICAST_FILTERS 0x40 |
| #define USB_CDC_SET_ETHERNET_PM_PATTERN_FILTER 0x41 |
| #define USB_CDC_GET_ETHERNET_PM_PATTERN_FILTER 0x42 |
| #define USB_CDC_SET_ETHERNET_PACKET_FILTER 0x43 |
| #define USB_CDC_GET_ETHERNET_STATISTIC 0x44 |
| |
| #define LOG2_STATUS_INTERVAL_MSEC 5 /* 1 << 5 == 32 msec */ |
| #define STATUS_BYTECOUNT 16 /* 8 byte header + data */ |
| |
| #define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ |
| |
| /* |
| * mostly the same descriptor as the linux gadget rndis driver |
| */ |
| static const uint8_t qemu_net_dev_descriptor[] = { |
| 0x12, /* u8 bLength; */ |
| USB_DT_DEVICE, /* u8 bDescriptorType; Device */ |
| 0x00, 0x02, /* u16 bcdUSB; v2.0 */ |
| USB_CLASS_COMM, /* u8 bDeviceClass; */ |
| 0x00, /* u8 bDeviceSubClass; */ |
| 0x00, /* u8 bDeviceProtocol; [ low/full only ] */ |
| 0x40, /* u8 bMaxPacketSize0 */ |
| RNDIS_VENDOR_NUM & 0xff, RNDIS_VENDOR_NUM >> 8, /* u16 idVendor; */ |
| RNDIS_PRODUCT_NUM & 0xff, RNDIS_PRODUCT_NUM >> 8, /* u16 idProduct; */ |
| 0x00, 0x00, /* u16 bcdDevice */ |
| STRING_MANUFACTURER, /* u8 iManufacturer; */ |
| STRING_PRODUCT, /* u8 iProduct; */ |
| STRING_SERIALNUMBER, /* u8 iSerialNumber; */ |
| 0x02, /* u8 bNumConfigurations; */ |
| }; |
| |
| static const uint8_t qemu_net_rndis_config_descriptor[] = { |
| /* Configuration Descriptor */ |
| 0x09, /* u8 bLength */ |
| USB_DT_CONFIG, /* u8 bDescriptorType */ |
| 0x43, 0x00, /* le16 wTotalLength */ |
| 0x02, /* u8 bNumInterfaces */ |
| DEV_RNDIS_CONFIG_VALUE, /* u8 bConfigurationValue */ |
| STRING_RNDIS, /* u8 iConfiguration */ |
| 0xc0, /* u8 bmAttributes */ |
| 0x32, /* u8 bMaxPower */ |
| /* RNDIS Control Interface */ |
| 0x09, /* u8 bLength */ |
| USB_DT_INTERFACE, /* u8 bDescriptorType */ |
| 0x00, /* u8 bInterfaceNumber */ |
| 0x00, /* u8 bAlternateSetting */ |
| 0x01, /* u8 bNumEndpoints */ |
| USB_CLASS_COMM, /* u8 bInterfaceClass */ |
| USB_CDC_SUBCLASS_ACM, /* u8 bInterfaceSubClass */ |
| USB_CDC_ACM_PROTO_VENDOR, /* u8 bInterfaceProtocol */ |
| STRING_RNDIS_CONTROL, /* u8 iInterface */ |
| /* Header Descriptor */ |
| 0x05, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */ |
| 0x10, 0x01, /* le16 bcdCDC */ |
| /* Call Management Descriptor */ |
| 0x05, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_CALL_MANAGEMENT_TYPE, /* u8 bDescriptorSubType */ |
| 0x00, /* u8 bmCapabilities */ |
| 0x01, /* u8 bDataInterface */ |
| /* ACM Descriptor */ |
| 0x04, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_ACM_TYPE, /* u8 bDescriptorSubType */ |
| 0x00, /* u8 bmCapabilities */ |
| /* Union Descriptor */ |
| 0x05, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */ |
| 0x00, /* u8 bMasterInterface0 */ |
| 0x01, /* u8 bSlaveInterface0 */ |
| /* Status Descriptor */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_IN | 1, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_INT, /* u8 bmAttributes */ |
| STATUS_BYTECOUNT & 0xff, STATUS_BYTECOUNT >> 8, /* le16 wMaxPacketSize */ |
| 1 << LOG2_STATUS_INTERVAL_MSEC, /* u8 bInterval */ |
| /* RNDIS Data Interface */ |
| 0x09, /* u8 bLength */ |
| USB_DT_INTERFACE, /* u8 bDescriptorType */ |
| 0x01, /* u8 bInterfaceNumber */ |
| 0x00, /* u8 bAlternateSetting */ |
| 0x02, /* u8 bNumEndpoints */ |
| USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ |
| 0x00, /* u8 bInterfaceSubClass */ |
| 0x00, /* u8 bInterfaceProtocol */ |
| STRING_DATA, /* u8 iInterface */ |
| /* Source Endpoint */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_IN | 2, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ |
| 0x40, 0x00, /* le16 wMaxPacketSize */ |
| 0x00, /* u8 bInterval */ |
| /* Sink Endpoint */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_OUT | 2, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ |
| 0x40, 0x00, /* le16 wMaxPacketSize */ |
| 0x00 /* u8 bInterval */ |
| }; |
| |
| static const uint8_t qemu_net_cdc_config_descriptor[] = { |
| /* Configuration Descriptor */ |
| 0x09, /* u8 bLength */ |
| USB_DT_CONFIG, /* u8 bDescriptorType */ |
| 0x50, 0x00, /* le16 wTotalLength */ |
| 0x02, /* u8 bNumInterfaces */ |
| DEV_CONFIG_VALUE, /* u8 bConfigurationValue */ |
| STRING_CDC, /* u8 iConfiguration */ |
| 0xc0, /* u8 bmAttributes */ |
| 0x32, /* u8 bMaxPower */ |
| /* CDC Control Interface */ |
| 0x09, /* u8 bLength */ |
| USB_DT_INTERFACE, /* u8 bDescriptorType */ |
| 0x00, /* u8 bInterfaceNumber */ |
| 0x00, /* u8 bAlternateSetting */ |
| 0x01, /* u8 bNumEndpoints */ |
| USB_CLASS_COMM, /* u8 bInterfaceClass */ |
| USB_CDC_SUBCLASS_ETHERNET, /* u8 bInterfaceSubClass */ |
| USB_CDC_PROTO_NONE, /* u8 bInterfaceProtocol */ |
| STRING_CONTROL, /* u8 iInterface */ |
| /* Header Descriptor */ |
| 0x05, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */ |
| 0x10, 0x01, /* le16 bcdCDC */ |
| /* Union Descriptor */ |
| 0x05, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */ |
| 0x00, /* u8 bMasterInterface0 */ |
| 0x01, /* u8 bSlaveInterface0 */ |
| /* Ethernet Descriptor */ |
| 0x0d, /* u8 bLength */ |
| USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ |
| USB_CDC_ETHERNET_TYPE, /* u8 bDescriptorSubType */ |
| STRING_ETHADDR, /* u8 iMACAddress */ |
| 0x00, 0x00, 0x00, 0x00, /* le32 bmEthernetStatistics */ |
| ETH_FRAME_LEN & 0xff, ETH_FRAME_LEN >> 8, /* le16 wMaxSegmentSize */ |
| 0x00, 0x00, /* le16 wNumberMCFilters */ |
| 0x00, /* u8 bNumberPowerFilters */ |
| /* Status Descriptor */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_IN | 1, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_INT, /* u8 bmAttributes */ |
| STATUS_BYTECOUNT & 0xff, STATUS_BYTECOUNT >> 8, /* le16 wMaxPacketSize */ |
| 1 << LOG2_STATUS_INTERVAL_MSEC, /* u8 bInterval */ |
| /* CDC Data (nop) Interface */ |
| 0x09, /* u8 bLength */ |
| USB_DT_INTERFACE, /* u8 bDescriptorType */ |
| 0x01, /* u8 bInterfaceNumber */ |
| 0x00, /* u8 bAlternateSetting */ |
| 0x00, /* u8 bNumEndpoints */ |
| USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ |
| 0x00, /* u8 bInterfaceSubClass */ |
| 0x00, /* u8 bInterfaceProtocol */ |
| 0x00, /* u8 iInterface */ |
| /* CDC Data Interface */ |
| 0x09, /* u8 bLength */ |
| USB_DT_INTERFACE, /* u8 bDescriptorType */ |
| 0x01, /* u8 bInterfaceNumber */ |
| 0x01, /* u8 bAlternateSetting */ |
| 0x02, /* u8 bNumEndpoints */ |
| USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ |
| 0x00, /* u8 bInterfaceSubClass */ |
| 0x00, /* u8 bInterfaceProtocol */ |
| STRING_DATA, /* u8 iInterface */ |
| /* Source Endpoint */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_IN | 2, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ |
| 0x40, 0x00, /* le16 wMaxPacketSize */ |
| 0x00, /* u8 bInterval */ |
| /* Sink Endpoint */ |
| 0x07, /* u8 bLength */ |
| USB_DT_ENDPOINT, /* u8 bDescriptorType */ |
| USB_DIR_OUT | 2, /* u8 bEndpointAddress */ |
| USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ |
| 0x40, 0x00, /* le16 wMaxPacketSize */ |
| 0x00 /* u8 bInterval */ |
| }; |
| |
| /* |
| * RNDIS Definitions - in theory not specific to USB. |
| */ |
| #define RNDIS_MAXIMUM_FRAME_SIZE 1518 |
| #define RNDIS_MAX_TOTAL_SIZE 1558 |
| |
| /* Remote NDIS Versions */ |
| #define RNDIS_MAJOR_VERSION 1 |
| #define RNDIS_MINOR_VERSION 0 |
| |
| /* Status Values */ |
| #define RNDIS_STATUS_SUCCESS 0x00000000U /* Success */ |
| #define RNDIS_STATUS_FAILURE 0xc0000001U /* Unspecified error */ |
| #define RNDIS_STATUS_INVALID_DATA 0xc0010015U /* Invalid data */ |
| #define RNDIS_STATUS_NOT_SUPPORTED 0xc00000bbU /* Unsupported request */ |
| #define RNDIS_STATUS_MEDIA_CONNECT 0x4001000bU /* Device connected */ |
| #define RNDIS_STATUS_MEDIA_DISCONNECT 0x4001000cU /* Device disconnected */ |
| |
| /* Message Set for Connectionless (802.3) Devices */ |
| enum { |
| RNDIS_PACKET_MSG = 1, |
| RNDIS_INITIALIZE_MSG = 2, /* Initialize device */ |
| RNDIS_HALT_MSG = 3, |
| RNDIS_QUERY_MSG = 4, |
| RNDIS_SET_MSG = 5, |
| RNDIS_RESET_MSG = 6, |
| RNDIS_INDICATE_STATUS_MSG = 7, |
| RNDIS_KEEPALIVE_MSG = 8, |
| }; |
| |
| /* Message completion */ |
| enum { |
| RNDIS_INITIALIZE_CMPLT = 0x80000002U, |
| RNDIS_QUERY_CMPLT = 0x80000004U, |
| RNDIS_SET_CMPLT = 0x80000005U, |
| RNDIS_RESET_CMPLT = 0x80000006U, |
| RNDIS_KEEPALIVE_CMPLT = 0x80000008U, |
| }; |
| |
| /* Device Flags */ |
| enum { |
| RNDIS_DF_CONNECTIONLESS = 1, |
| RNDIS_DF_CONNECTIONORIENTED = 2, |
| }; |
| |
| #define RNDIS_MEDIUM_802_3 0x00000000U |
| |
| /* from drivers/net/sk98lin/h/skgepnmi.h */ |
| #define OID_PNP_CAPABILITIES 0xfd010100 |
| #define OID_PNP_SET_POWER 0xfd010101 |
| #define OID_PNP_QUERY_POWER 0xfd010102 |
| #define OID_PNP_ADD_WAKE_UP_PATTERN 0xfd010103 |
| #define OID_PNP_REMOVE_WAKE_UP_PATTERN 0xfd010104 |
| #define OID_PNP_ENABLE_WAKE_UP 0xfd010106 |
| |
| typedef uint32_t le32; |
| |
| typedef struct rndis_init_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 MajorVersion; |
| le32 MinorVersion; |
| le32 MaxTransferSize; |
| } rndis_init_msg_type; |
| |
| typedef struct rndis_init_cmplt_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 Status; |
| le32 MajorVersion; |
| le32 MinorVersion; |
| le32 DeviceFlags; |
| le32 Medium; |
| le32 MaxPacketsPerTransfer; |
| le32 MaxTransferSize; |
| le32 PacketAlignmentFactor; |
| le32 AFListOffset; |
| le32 AFListSize; |
| } rndis_init_cmplt_type; |
| |
| typedef struct rndis_halt_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| } rndis_halt_msg_type; |
| |
| typedef struct rndis_query_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 OID; |
| le32 InformationBufferLength; |
| le32 InformationBufferOffset; |
| le32 DeviceVcHandle; |
| } rndis_query_msg_type; |
| |
| typedef struct rndis_query_cmplt_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 Status; |
| le32 InformationBufferLength; |
| le32 InformationBufferOffset; |
| } rndis_query_cmplt_type; |
| |
| typedef struct rndis_set_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 OID; |
| le32 InformationBufferLength; |
| le32 InformationBufferOffset; |
| le32 DeviceVcHandle; |
| } rndis_set_msg_type; |
| |
| typedef struct rndis_set_cmplt_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 Status; |
| } rndis_set_cmplt_type; |
| |
| typedef struct rndis_reset_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 Reserved; |
| } rndis_reset_msg_type; |
| |
| typedef struct rndis_reset_cmplt_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 Status; |
| le32 AddressingReset; |
| } rndis_reset_cmplt_type; |
| |
| typedef struct rndis_indicate_status_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 Status; |
| le32 StatusBufferLength; |
| le32 StatusBufferOffset; |
| } rndis_indicate_status_msg_type; |
| |
| typedef struct rndis_keepalive_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| } rndis_keepalive_msg_type; |
| |
| typedef struct rndis_keepalive_cmplt_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 RequestID; |
| le32 Status; |
| } rndis_keepalive_cmplt_type; |
| |
| struct rndis_packet_msg_type { |
| le32 MessageType; |
| le32 MessageLength; |
| le32 DataOffset; |
| le32 DataLength; |
| le32 OOBDataOffset; |
| le32 OOBDataLength; |
| le32 NumOOBDataElements; |
| le32 PerPacketInfoOffset; |
| le32 PerPacketInfoLength; |
| le32 VcHandle; |
| le32 Reserved; |
| }; |
| |
| struct rndis_config_parameter { |
| le32 ParameterNameOffset; |
| le32 ParameterNameLength; |
| le32 ParameterType; |
| le32 ParameterValueOffset; |
| le32 ParameterValueLength; |
| }; |
| |
| /* implementation specific */ |
| enum rndis_state |
| { |
| RNDIS_UNINITIALIZED, |
| RNDIS_INITIALIZED, |
| RNDIS_DATA_INITIALIZED, |
| }; |
| |
| /* from ndis.h */ |
| enum ndis_oid { |
| /* Required Object IDs (OIDs) */ |
| OID_GEN_SUPPORTED_LIST = 0x00010101, |
| OID_GEN_HARDWARE_STATUS = 0x00010102, |
| OID_GEN_MEDIA_SUPPORTED = 0x00010103, |
| OID_GEN_MEDIA_IN_USE = 0x00010104, |
| OID_GEN_MAXIMUM_LOOKAHEAD = 0x00010105, |
| OID_GEN_MAXIMUM_FRAME_SIZE = 0x00010106, |
| OID_GEN_LINK_SPEED = 0x00010107, |
| OID_GEN_TRANSMIT_BUFFER_SPACE = 0x00010108, |
| OID_GEN_RECEIVE_BUFFER_SPACE = 0x00010109, |
| OID_GEN_TRANSMIT_BLOCK_SIZE = 0x0001010a, |
| OID_GEN_RECEIVE_BLOCK_SIZE = 0x0001010b, |
| OID_GEN_VENDOR_ID = 0x0001010c, |
| OID_GEN_VENDOR_DESCRIPTION = 0x0001010d, |
| OID_GEN_CURRENT_PACKET_FILTER = 0x0001010e, |
| OID_GEN_CURRENT_LOOKAHEAD = 0x0001010f, |
| OID_GEN_DRIVER_VERSION = 0x00010110, |
| OID_GEN_MAXIMUM_TOTAL_SIZE = 0x00010111, |
| OID_GEN_PROTOCOL_OPTIONS = 0x00010112, |
| OID_GEN_MAC_OPTIONS = 0x00010113, |
| OID_GEN_MEDIA_CONNECT_STATUS = 0x00010114, |
| OID_GEN_MAXIMUM_SEND_PACKETS = 0x00010115, |
| OID_GEN_VENDOR_DRIVER_VERSION = 0x00010116, |
| OID_GEN_SUPPORTED_GUIDS = 0x00010117, |
| OID_GEN_NETWORK_LAYER_ADDRESSES = 0x00010118, |
| OID_GEN_TRANSPORT_HEADER_OFFSET = 0x00010119, |
| OID_GEN_MACHINE_NAME = 0x0001021a, |
| OID_GEN_RNDIS_CONFIG_PARAMETER = 0x0001021b, |
| OID_GEN_VLAN_ID = 0x0001021c, |
| |
| /* Optional OIDs */ |
| OID_GEN_MEDIA_CAPABILITIES = 0x00010201, |
| OID_GEN_PHYSICAL_MEDIUM = 0x00010202, |
| |
| /* Required statistics OIDs */ |
| OID_GEN_XMIT_OK = 0x00020101, |
| OID_GEN_RCV_OK = 0x00020102, |
| OID_GEN_XMIT_ERROR = 0x00020103, |
| OID_GEN_RCV_ERROR = 0x00020104, |
| OID_GEN_RCV_NO_BUFFER = 0x00020105, |
| |
| /* Optional statistics OIDs */ |
| OID_GEN_DIRECTED_BYTES_XMIT = 0x00020201, |
| OID_GEN_DIRECTED_FRAMES_XMIT = 0x00020202, |
| OID_GEN_MULTICAST_BYTES_XMIT = 0x00020203, |
| OID_GEN_MULTICAST_FRAMES_XMIT = 0x00020204, |
| OID_GEN_BROADCAST_BYTES_XMIT = 0x00020205, |
| OID_GEN_BROADCAST_FRAMES_XMIT = 0x00020206, |
| OID_GEN_DIRECTED_BYTES_RCV = 0x00020207, |
| OID_GEN_DIRECTED_FRAMES_RCV = 0x00020208, |
| OID_GEN_MULTICAST_BYTES_RCV = 0x00020209, |
| OID_GEN_MULTICAST_FRAMES_RCV = 0x0002020a, |
| OID_GEN_BROADCAST_BYTES_RCV = 0x0002020b, |
| OID_GEN_BROADCAST_FRAMES_RCV = 0x0002020c, |
| OID_GEN_RCV_CRC_ERROR = 0x0002020d, |
| OID_GEN_TRANSMIT_QUEUE_LENGTH = 0x0002020e, |
| OID_GEN_GET_TIME_CAPS = 0x0002020f, |
| OID_GEN_GET_NETCARD_TIME = 0x00020210, |
| OID_GEN_NETCARD_LOAD = 0x00020211, |
| OID_GEN_DEVICE_PROFILE = 0x00020212, |
| OID_GEN_INIT_TIME_MS = 0x00020213, |
| OID_GEN_RESET_COUNTS = 0x00020214, |
| OID_GEN_MEDIA_SENSE_COUNTS = 0x00020215, |
| OID_GEN_FRIENDLY_NAME = 0x00020216, |
| OID_GEN_MINIPORT_INFO = 0x00020217, |
| OID_GEN_RESET_VERIFY_PARAMETERS = 0x00020218, |
| |
| /* IEEE 802.3 (Ethernet) OIDs */ |
| OID_802_3_PERMANENT_ADDRESS = 0x01010101, |
| OID_802_3_CURRENT_ADDRESS = 0x01010102, |
| OID_802_3_MULTICAST_LIST = 0x01010103, |
| OID_802_3_MAXIMUM_LIST_SIZE = 0x01010104, |
| OID_802_3_MAC_OPTIONS = 0x01010105, |
| OID_802_3_RCV_ERROR_ALIGNMENT = 0x01020101, |
| OID_802_3_XMIT_ONE_COLLISION = 0x01020102, |
| OID_802_3_XMIT_MORE_COLLISIONS = 0x01020103, |
| OID_802_3_XMIT_DEFERRED = 0x01020201, |
| OID_802_3_XMIT_MAX_COLLISIONS = 0x01020202, |
| OID_802_3_RCV_OVERRUN = 0x01020203, |
| OID_802_3_XMIT_UNDERRUN = 0x01020204, |
| OID_802_3_XMIT_HEARTBEAT_FAILURE = 0x01020205, |
| OID_802_3_XMIT_TIMES_CRS_LOST = 0x01020206, |
| OID_802_3_XMIT_LATE_COLLISIONS = 0x01020207, |
| }; |
| |
| static const uint32_t oid_supported_list[] = |
| { |
| /* the general stuff */ |
| OID_GEN_SUPPORTED_LIST, |
| OID_GEN_HARDWARE_STATUS, |
| OID_GEN_MEDIA_SUPPORTED, |
| OID_GEN_MEDIA_IN_USE, |
| OID_GEN_MAXIMUM_FRAME_SIZE, |
| OID_GEN_LINK_SPEED, |
| OID_GEN_TRANSMIT_BLOCK_SIZE, |
| OID_GEN_RECEIVE_BLOCK_SIZE, |
| OID_GEN_VENDOR_ID, |
| OID_GEN_VENDOR_DESCRIPTION, |
| OID_GEN_VENDOR_DRIVER_VERSION, |
| OID_GEN_CURRENT_PACKET_FILTER, |
| OID_GEN_MAXIMUM_TOTAL_SIZE, |
| OID_GEN_MEDIA_CONNECT_STATUS, |
| OID_GEN_PHYSICAL_MEDIUM, |
| |
| /* the statistical stuff */ |
| OID_GEN_XMIT_OK, |
| OID_GEN_RCV_OK, |
| OID_GEN_XMIT_ERROR, |
| OID_GEN_RCV_ERROR, |
| OID_GEN_RCV_NO_BUFFER, |
| |
| /* IEEE 802.3 */ |
| /* the general stuff */ |
| OID_802_3_PERMANENT_ADDRESS, |
| OID_802_3_CURRENT_ADDRESS, |
| OID_802_3_MULTICAST_LIST, |
| OID_802_3_MAC_OPTIONS, |
| OID_802_3_MAXIMUM_LIST_SIZE, |
| |
| /* the statistical stuff */ |
| OID_802_3_RCV_ERROR_ALIGNMENT, |
| OID_802_3_XMIT_ONE_COLLISION, |
| OID_802_3_XMIT_MORE_COLLISIONS, |
| }; |
| |
| #define NDIS_MAC_OPTION_COPY_LOOKAHEAD_DATA (1 << 0) |
| #define NDIS_MAC_OPTION_RECEIVE_SERIALIZED (1 << 1) |
| #define NDIS_MAC_OPTION_TRANSFERS_NOT_PEND (1 << 2) |
| #define NDIS_MAC_OPTION_NO_LOOPBACK (1 << 3) |
| #define NDIS_MAC_OPTION_FULL_DUPLEX (1 << 4) |
| #define NDIS_MAC_OPTION_EOTX_INDICATION (1 << 5) |
| #define NDIS_MAC_OPTION_8021P_PRIORITY (1 << 6) |
| |
| struct rndis_response { |
| TAILQ_ENTRY(rndis_response) entries; |
| uint32_t length; |
| uint8_t buf[0]; |
| }; |
| |
| typedef struct USBNetState { |
| USBDevice dev; |
| |
| unsigned int rndis; |
| enum rndis_state rndis_state; |
| uint32_t medium; |
| uint32_t speed; |
| uint32_t media_state; |
| uint16_t filter; |
| uint32_t vendorid; |
| uint8_t mac[6]; |
| |
| unsigned int out_ptr; |
| uint8_t out_buf[2048]; |
| |
| USBPacket *inpkt; |
| unsigned int in_ptr, in_len; |
| uint8_t in_buf[2048]; |
| |
| char usbstring_mac[13]; |
| VLANClientState *vc; |
| TAILQ_HEAD(rndis_resp_head, rndis_response) rndis_resp; |
| } USBNetState; |
| |
| static int ndis_query(USBNetState *s, uint32_t oid, |
| uint8_t *inbuf, unsigned int inlen, uint8_t *outbuf, |
| size_t outlen) |
| { |
| unsigned int i; |
| |
| switch (oid) { |
| /* general oids (table 4-1) */ |
| /* mandatory */ |
| case OID_GEN_SUPPORTED_LIST: |
| for (i = 0; i < ARRAY_SIZE(oid_supported_list); i++) |
| ((le32 *) outbuf)[i] = cpu_to_le32(oid_supported_list[i]); |
| return sizeof(oid_supported_list); |
| |
| /* mandatory */ |
| case OID_GEN_HARDWARE_STATUS: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_MEDIA_SUPPORTED: |
| *((le32 *) outbuf) = cpu_to_le32(s->medium); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_MEDIA_IN_USE: |
| *((le32 *) outbuf) = cpu_to_le32(s->medium); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_MAXIMUM_FRAME_SIZE: |
| *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_LINK_SPEED: |
| *((le32 *) outbuf) = cpu_to_le32(s->speed); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_TRANSMIT_BLOCK_SIZE: |
| *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_RECEIVE_BLOCK_SIZE: |
| *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_VENDOR_ID: |
| *((le32 *) outbuf) = cpu_to_le32(s->vendorid); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_VENDOR_DESCRIPTION: |
| pstrcpy((char *)outbuf, outlen, "QEMU USB RNDIS Net"); |
| return strlen((char *)outbuf) + 1; |
| |
| case OID_GEN_VENDOR_DRIVER_VERSION: |
| *((le32 *) outbuf) = cpu_to_le32(1); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_CURRENT_PACKET_FILTER: |
| *((le32 *) outbuf) = cpu_to_le32(s->filter); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_MAXIMUM_TOTAL_SIZE: |
| *((le32 *) outbuf) = cpu_to_le32(RNDIS_MAX_TOTAL_SIZE); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_MEDIA_CONNECT_STATUS: |
| *((le32 *) outbuf) = cpu_to_le32(s->media_state); |
| return sizeof(le32); |
| |
| case OID_GEN_PHYSICAL_MEDIUM: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| case OID_GEN_MAC_OPTIONS: |
| *((le32 *) outbuf) = cpu_to_le32( |
| NDIS_MAC_OPTION_RECEIVE_SERIALIZED | |
| NDIS_MAC_OPTION_FULL_DUPLEX); |
| return sizeof(le32); |
| |
| /* statistics OIDs (table 4-2) */ |
| /* mandatory */ |
| case OID_GEN_XMIT_OK: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_RCV_OK: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_XMIT_ERROR: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_RCV_ERROR: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_GEN_RCV_NO_BUFFER: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* ieee802.3 OIDs (table 4-3) */ |
| /* mandatory */ |
| case OID_802_3_PERMANENT_ADDRESS: |
| memcpy(outbuf, s->mac, 6); |
| return 6; |
| |
| /* mandatory */ |
| case OID_802_3_CURRENT_ADDRESS: |
| memcpy(outbuf, s->mac, 6); |
| return 6; |
| |
| /* mandatory */ |
| case OID_802_3_MULTICAST_LIST: |
| *((le32 *) outbuf) = cpu_to_le32(0xe0000000); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_802_3_MAXIMUM_LIST_SIZE: |
| *((le32 *) outbuf) = cpu_to_le32(1); |
| return sizeof(le32); |
| |
| case OID_802_3_MAC_OPTIONS: |
| return 0; |
| |
| /* ieee802.3 statistics OIDs (table 4-4) */ |
| /* mandatory */ |
| case OID_802_3_RCV_ERROR_ALIGNMENT: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_802_3_XMIT_ONE_COLLISION: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| /* mandatory */ |
| case OID_802_3_XMIT_MORE_COLLISIONS: |
| *((le32 *) outbuf) = cpu_to_le32(0); |
| return sizeof(le32); |
| |
| default: |
| fprintf(stderr, "usbnet: unknown OID 0x%08x\n", oid); |
| return 0; |
| } |
| return -1; |
| } |
| |
| static int ndis_set(USBNetState *s, uint32_t oid, |
| uint8_t *inbuf, unsigned int inlen) |
| { |
| switch (oid) { |
| case OID_GEN_CURRENT_PACKET_FILTER: |
| s->filter = le32_to_cpup((le32 *) inbuf); |
| if (s->filter) { |
| s->rndis_state = RNDIS_DATA_INITIALIZED; |
| } else { |
| s->rndis_state = RNDIS_INITIALIZED; |
| } |
| return 0; |
| |
| case OID_802_3_MULTICAST_LIST: |
| return 0; |
| } |
| return -1; |
| } |
| |
| static int rndis_get_response(USBNetState *s, uint8_t *buf) |
| { |
| int ret = 0; |
| struct rndis_response *r = s->rndis_resp.tqh_first; |
| |
| if (!r) |
| return ret; |
| |
| TAILQ_REMOVE(&s->rndis_resp, r, entries); |
| ret = r->length; |
| memcpy(buf, r->buf, r->length); |
| qemu_free(r); |
| |
| return ret; |
| } |
| |
| static void *rndis_queue_response(USBNetState *s, unsigned int length) |
| { |
| struct rndis_response *r = |
| qemu_mallocz(sizeof(struct rndis_response) + length); |
| |
| TAILQ_INSERT_TAIL(&s->rndis_resp, r, entries); |
| r->length = length; |
| |
| return &r->buf[0]; |
| } |
| |
| static void rndis_clear_responsequeue(USBNetState *s) |
| { |
| struct rndis_response *r; |
| |
| while ((r = s->rndis_resp.tqh_first)) { |
| TAILQ_REMOVE(&s->rndis_resp, r, entries); |
| qemu_free(r); |
| } |
| } |
| |
| static int rndis_init_response(USBNetState *s, rndis_init_msg_type *buf) |
| { |
| rndis_init_cmplt_type *resp = |
| rndis_queue_response(s, sizeof(rndis_init_cmplt_type)); |
| |
| if (!resp) |
| return USB_RET_STALL; |
| |
| resp->MessageType = cpu_to_le32(RNDIS_INITIALIZE_CMPLT); |
| resp->MessageLength = cpu_to_le32(sizeof(rndis_init_cmplt_type)); |
| resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ |
| resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); |
| resp->MajorVersion = cpu_to_le32(RNDIS_MAJOR_VERSION); |
| resp->MinorVersion = cpu_to_le32(RNDIS_MINOR_VERSION); |
| resp->DeviceFlags = cpu_to_le32(RNDIS_DF_CONNECTIONLESS); |
| resp->Medium = cpu_to_le32(RNDIS_MEDIUM_802_3); |
| resp->MaxPacketsPerTransfer = cpu_to_le32(1); |
| resp->MaxTransferSize = cpu_to_le32(ETH_FRAME_LEN + |
| sizeof(struct rndis_packet_msg_type) + 22); |
| resp->PacketAlignmentFactor = cpu_to_le32(0); |
| resp->AFListOffset = cpu_to_le32(0); |
| resp->AFListSize = cpu_to_le32(0); |
| return 0; |
| } |
| |
| static int rndis_query_response(USBNetState *s, |
| rndis_query_msg_type *buf, unsigned int length) |
| { |
| rndis_query_cmplt_type *resp; |
| /* oid_supported_list is the largest data reply */ |
| uint8_t infobuf[sizeof(oid_supported_list)]; |
| uint32_t bufoffs, buflen; |
| int infobuflen; |
| unsigned int resplen; |
| |
| bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8; |
| buflen = le32_to_cpu(buf->InformationBufferLength); |
| if (bufoffs + buflen > length) |
| return USB_RET_STALL; |
| |
| infobuflen = ndis_query(s, le32_to_cpu(buf->OID), |
| bufoffs + (uint8_t *) buf, buflen, infobuf, |
| sizeof(infobuf)); |
| resplen = sizeof(rndis_query_cmplt_type) + |
| ((infobuflen < 0) ? 0 : infobuflen); |
| resp = rndis_queue_response(s, resplen); |
| if (!resp) |
| return USB_RET_STALL; |
| |
| resp->MessageType = cpu_to_le32(RNDIS_QUERY_CMPLT); |
| resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ |
| resp->MessageLength = cpu_to_le32(resplen); |
| |
| if (infobuflen < 0) { |
| /* OID not supported */ |
| resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED); |
| resp->InformationBufferLength = cpu_to_le32(0); |
| resp->InformationBufferOffset = cpu_to_le32(0); |
| return 0; |
| } |
| |
| resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); |
| resp->InformationBufferOffset = |
| cpu_to_le32(infobuflen ? sizeof(rndis_query_cmplt_type) - 8 : 0); |
| resp->InformationBufferLength = cpu_to_le32(infobuflen); |
| memcpy(resp + 1, infobuf, infobuflen); |
| |
| return 0; |
| } |
| |
| static int rndis_set_response(USBNetState *s, |
| rndis_set_msg_type *buf, unsigned int length) |
| { |
| rndis_set_cmplt_type *resp = |
| rndis_queue_response(s, sizeof(rndis_set_cmplt_type)); |
| uint32_t bufoffs, buflen; |
| int ret; |
| |
| if (!resp) |
| return USB_RET_STALL; |
| |
| bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8; |
| buflen = le32_to_cpu(buf->InformationBufferLength); |
| if (bufoffs + buflen > length) |
| return USB_RET_STALL; |
| |
| ret = ndis_set(s, le32_to_cpu(buf->OID), |
| bufoffs + (uint8_t *) buf, buflen); |
| resp->MessageType = cpu_to_le32(RNDIS_SET_CMPLT); |
| resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ |
| resp->MessageLength = cpu_to_le32(sizeof(rndis_set_cmplt_type)); |
| if (ret < 0) { |
| /* OID not supported */ |
| resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED); |
| return 0; |
| } |
| resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); |
| |
| return 0; |
| } |
| |
| static int rndis_reset_response(USBNetState *s, rndis_reset_msg_type *buf) |
| { |
| rndis_reset_cmplt_type *resp = |
| rndis_queue_response(s, sizeof(rndis_reset_cmplt_type)); |
| |
| if (!resp) |
| return USB_RET_STALL; |
| |
| resp->MessageType = cpu_to_le32(RNDIS_RESET_CMPLT); |
| resp->MessageLength = cpu_to_le32(sizeof(rndis_reset_cmplt_type)); |
| resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); |
| resp->AddressingReset = cpu_to_le32(1); /* reset information */ |
| |
| return 0; |
| } |
| |
| static int rndis_keepalive_response(USBNetState *s, |
| rndis_keepalive_msg_type *buf) |
| { |
| rndis_keepalive_cmplt_type *resp = |
| rndis_queue_response(s, sizeof(rndis_keepalive_cmplt_type)); |
| |
| if (!resp) |
| return USB_RET_STALL; |
| |
| resp->MessageType = cpu_to_le32(RNDIS_KEEPALIVE_CMPLT); |
| resp->MessageLength = cpu_to_le32(sizeof(rndis_keepalive_cmplt_type)); |
| resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ |
| resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); |
| |
| return 0; |
| } |
| |
| static int rndis_parse(USBNetState *s, uint8_t *data, int length) |
| { |
| uint32_t msg_type, msg_length; |
| le32 *tmp = (le32 *) data; |
| |
| msg_type = le32_to_cpup(tmp++); |
| msg_length = le32_to_cpup(tmp++); |
| |
| switch (msg_type) { |
| case RNDIS_INITIALIZE_MSG: |
| s->rndis_state = RNDIS_INITIALIZED; |
| return rndis_init_response(s, (rndis_init_msg_type *) data); |
| |
| case RNDIS_HALT_MSG: |
| s->rndis_state = RNDIS_UNINITIALIZED; |
| return 0; |
| |
| case RNDIS_QUERY_MSG: |
| return rndis_query_response(s, (rndis_query_msg_type *) data, length); |
| |
| case RNDIS_SET_MSG: |
| return rndis_set_response(s, (rndis_set_msg_type *) data, length); |
| |
| case RNDIS_RESET_MSG: |
| rndis_clear_responsequeue(s); |
| s->out_ptr = s->in_ptr = s->in_len = 0; |
| return rndis_reset_response(s, (rndis_reset_msg_type *) data); |
| |
| case RNDIS_KEEPALIVE_MSG: |
| /* For USB: host does this every 5 seconds */ |
| return rndis_keepalive_response(s, (rndis_keepalive_msg_type *) data); |
| } |
| |
| return USB_RET_STALL; |
| } |
| |
| static void usb_net_handle_reset(USBDevice *dev) |
| { |
| } |
| |
| static const char * const usb_net_stringtable[] = { |
| [STRING_MANUFACTURER] = "QEMU", |
| [STRING_PRODUCT] = "RNDIS/QEMU USB Network Device", |
| [STRING_ETHADDR] = "400102030405", |
| [STRING_DATA] = "QEMU USB Net Data Interface", |
| [STRING_CONTROL] = "QEMU USB Net Control Interface", |
| [STRING_RNDIS_CONTROL] = "QEMU USB Net RNDIS Control Interface", |
| [STRING_CDC] = "QEMU USB Net CDC", |
| [STRING_SUBSET] = "QEMU USB Net Subset", |
| [STRING_RNDIS] = "QEMU USB Net RNDIS", |
| [STRING_SERIALNUMBER] = "1", |
| }; |
| |
| static int usb_net_handle_control(USBDevice *dev, int request, int value, |
| int index, int length, uint8_t *data) |
| { |
| USBNetState *s = (USBNetState *) dev; |
| int ret = 0; |
| |
| switch(request) { |
| case DeviceRequest | USB_REQ_GET_STATUS: |
| data[0] = (1 << USB_DEVICE_SELF_POWERED) | |
| (dev->remote_wakeup << USB_DEVICE_REMOTE_WAKEUP); |
| data[1] = 0x00; |
| ret = 2; |
| break; |
| |
| case DeviceOutRequest | USB_REQ_CLEAR_FEATURE: |
| if (value == USB_DEVICE_REMOTE_WAKEUP) { |
| dev->remote_wakeup = 0; |
| } else { |
| goto fail; |
| } |
| ret = 0; |
| break; |
| |
| case DeviceOutRequest | USB_REQ_SET_FEATURE: |
| if (value == USB_DEVICE_REMOTE_WAKEUP) { |
| dev->remote_wakeup = 1; |
| } else { |
| goto fail; |
| } |
| ret = 0; |
| break; |
| |
| case DeviceOutRequest | USB_REQ_SET_ADDRESS: |
| dev->addr = value; |
| ret = 0; |
| break; |
| |
| case ClassInterfaceOutRequest | USB_CDC_SEND_ENCAPSULATED_COMMAND: |
| if (!s->rndis || value || index != 0) |
| goto fail; |
| #ifdef TRAFFIC_DEBUG |
| { |
| unsigned int i; |
| fprintf(stderr, "SEND_ENCAPSULATED_COMMAND:"); |
| for (i = 0; i < length; i++) { |
| if (!(i & 15)) |
| fprintf(stderr, "\n%04x:", i); |
| fprintf(stderr, " %02x", data[i]); |
| } |
| fprintf(stderr, "\n\n"); |
| } |
| #endif |
| ret = rndis_parse(s, data, length); |
| break; |
| |
| case ClassInterfaceRequest | USB_CDC_GET_ENCAPSULATED_RESPONSE: |
| if (!s->rndis || value || index != 0) |
| goto fail; |
| ret = rndis_get_response(s, data); |
| if (!ret) { |
| data[0] = 0; |
| ret = 1; |
| } |
| #ifdef TRAFFIC_DEBUG |
| { |
| unsigned int i; |
| fprintf(stderr, "GET_ENCAPSULATED_RESPONSE:"); |
| for (i = 0; i < ret; i++) { |
| if (!(i & 15)) |
| fprintf(stderr, "\n%04x:", i); |
| fprintf(stderr, " %02x", data[i]); |
| } |
| fprintf(stderr, "\n\n"); |
| } |
| #endif |
| break; |
| |
| case DeviceRequest | USB_REQ_GET_DESCRIPTOR: |
| switch(value >> 8) { |
| case USB_DT_DEVICE: |
| ret = sizeof(qemu_net_dev_descriptor); |
| memcpy(data, qemu_net_dev_descriptor, ret); |
| break; |
| |
| case USB_DT_CONFIG: |
| switch (value & 0xff) { |
| case 0: |
| ret = sizeof(qemu_net_rndis_config_descriptor); |
| memcpy(data, qemu_net_rndis_config_descriptor, ret); |
| break; |
| |
| case 1: |
| ret = sizeof(qemu_net_cdc_config_descriptor); |
| memcpy(data, qemu_net_cdc_config_descriptor, ret); |
| break; |
| |
| default: |
| goto fail; |
| } |
| |
| data[2] = ret & 0xff; |
| data[3] = ret >> 8; |
| 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 STRING_ETHADDR: |
| ret = set_usb_string(data, s->usbstring_mac); |
| break; |
| |
| default: |
| if (usb_net_stringtable[value & 0xff]) { |
| ret = set_usb_string(data, |
| usb_net_stringtable[value & 0xff]); |
| break; |
| } |
| |
| goto fail; |
| } |
| break; |
| |
| default: |
| goto fail; |
| } |
| break; |
| |
| case DeviceRequest | USB_REQ_GET_CONFIGURATION: |
| data[0] = s->rndis ? DEV_RNDIS_CONFIG_VALUE : DEV_CONFIG_VALUE; |
| ret = 1; |
| break; |
| |
| case DeviceOutRequest | USB_REQ_SET_CONFIGURATION: |
| switch (value & 0xff) { |
| case DEV_CONFIG_VALUE: |
| s->rndis = 0; |
| break; |
| |
| case DEV_RNDIS_CONFIG_VALUE: |
| s->rndis = 1; |
| break; |
| |
| default: |
| goto fail; |
| } |
| ret = 0; |
| break; |
| |
| case DeviceRequest | USB_REQ_GET_INTERFACE: |
| case InterfaceRequest | USB_REQ_GET_INTERFACE: |
| data[0] = 0; |
| ret = 1; |
| break; |
| |
| case DeviceOutRequest | USB_REQ_SET_INTERFACE: |
| case InterfaceOutRequest | USB_REQ_SET_INTERFACE: |
| ret = 0; |
| break; |
| |
| default: |
| fail: |
| fprintf(stderr, "usbnet: failed control transaction: " |
| "request 0x%x value 0x%x index 0x%x length 0x%x\n", |
| request, value, index, length); |
| ret = USB_RET_STALL; |
| break; |
| } |
| return ret; |
| } |
| |
| static int usb_net_handle_statusin(USBNetState *s, USBPacket *p) |
| { |
| int ret = 8; |
| |
| if (p->len < 8) |
| return USB_RET_STALL; |
| |
| ((le32 *) p->data)[0] = cpu_to_le32(1); |
| ((le32 *) p->data)[1] = cpu_to_le32(0); |
| if (!s->rndis_resp.tqh_first) |
| ret = USB_RET_NAK; |
| |
| #ifdef TRAFFIC_DEBUG |
| fprintf(stderr, "usbnet: interrupt poll len %u return %d", p->len, ret); |
| { |
| int i; |
| fprintf(stderr, ":"); |
| for (i = 0; i < ret; i++) { |
| if (!(i & 15)) |
| fprintf(stderr, "\n%04x:", i); |
| fprintf(stderr, " %02x", p->data[i]); |
| } |
| fprintf(stderr, "\n\n"); |
| } |
| #endif |
| |
| return ret; |
| } |
| |
| static int usb_net_handle_datain(USBNetState *s, USBPacket *p) |
| { |
| int ret = USB_RET_NAK; |
| |
| if (s->in_ptr > s->in_len) { |
| s->in_ptr = s->in_len = 0; |
| ret = USB_RET_NAK; |
| return ret; |
| } |
| if (!s->in_len) { |
| ret = USB_RET_NAK; |
| return ret; |
| } |
| ret = s->in_len - s->in_ptr; |
| if (ret > p->len) |
| ret = p->len; |
| memcpy(p->data, &s->in_buf[s->in_ptr], ret); |
| s->in_ptr += ret; |
| if (s->in_ptr >= s->in_len && |
| (s->rndis || (s->in_len & (64 - 1)) || !ret)) { |
| /* no short packet necessary */ |
| s->in_ptr = s->in_len = 0; |
| } |
| |
| #ifdef TRAFFIC_DEBUG |
| fprintf(stderr, "usbnet: data in len %u return %d", p->len, ret); |
| { |
| int i; |
| fprintf(stderr, ":"); |
| for (i = 0; i < ret; i++) { |
| if (!(i & 15)) |
| fprintf(stderr, "\n%04x:", i); |
| fprintf(stderr, " %02x", p->data[i]); |
| } |
| fprintf(stderr, "\n\n"); |
| } |
| #endif |
| |
| return ret; |
| } |
| |
| static int usb_net_handle_dataout(USBNetState *s, USBPacket *p) |
| { |
| int ret = p->len; |
| int sz = sizeof(s->out_buf) - s->out_ptr; |
| struct rndis_packet_msg_type *msg = |
| (struct rndis_packet_msg_type *) s->out_buf; |
| uint32_t len; |
| |
| #ifdef TRAFFIC_DEBUG |
| fprintf(stderr, "usbnet: data out len %u\n", p->len); |
| { |
| int i; |
| fprintf(stderr, ":"); |
| for (i = 0; i < p->len; i++) { |
| if (!(i & 15)) |
| fprintf(stderr, "\n%04x:", i); |
| fprintf(stderr, " %02x", p->data[i]); |
| } |
| fprintf(stderr, "\n\n"); |
| } |
| #endif |
| |
| if (sz > ret) |
| sz = ret; |
| memcpy(&s->out_buf[s->out_ptr], p->data, sz); |
| s->out_ptr += sz; |
| |
| if (!s->rndis) { |
| if (ret < 64) { |
| qemu_send_packet(s->vc, s->out_buf, s->out_ptr); |
| s->out_ptr = 0; |
| } |
| return ret; |
| } |
| len = le32_to_cpu(msg->MessageLength); |
| if (s->out_ptr < 8 || s->out_ptr < len) |
| return ret; |
| if (le32_to_cpu(msg->MessageType) == RNDIS_PACKET_MSG) { |
| uint32_t offs = 8 + le32_to_cpu(msg->DataOffset); |
| uint32_t size = le32_to_cpu(msg->DataLength); |
| if (offs + size <= len) |
| qemu_send_packet(s->vc, s->out_buf + offs, size); |
| } |
| s->out_ptr -= len; |
| memmove(s->out_buf, &s->out_buf[len], s->out_ptr); |
| |
| return ret; |
| } |
| |
| static int usb_net_handle_data(USBDevice *dev, USBPacket *p) |
| { |
| USBNetState *s = (USBNetState *) dev; |
| int ret = 0; |
| |
| switch(p->pid) { |
| case USB_TOKEN_IN: |
| switch (p->devep) { |
| case 1: |
| ret = usb_net_handle_statusin(s, p); |
| break; |
| |
| case 2: |
| ret = usb_net_handle_datain(s, p); |
| break; |
| |
| default: |
| goto fail; |
| } |
| break; |
| |
| case USB_TOKEN_OUT: |
| switch (p->devep) { |
| case 2: |
| ret = usb_net_handle_dataout(s, p); |
| break; |
| |
| default: |
| goto fail; |
| } |
| break; |
| |
| default: |
| fail: |
| ret = USB_RET_STALL; |
| break; |
| } |
| if (ret == USB_RET_STALL) |
| fprintf(stderr, "usbnet: failed data transaction: " |
| "pid 0x%x ep 0x%x len 0x%x\n", |
| p->pid, p->devep, p->len); |
| return ret; |
| } |
| |
| static void usbnet_receive(void *opaque, const uint8_t *buf, int size) |
| { |
| USBNetState *s = opaque; |
| struct rndis_packet_msg_type *msg; |
| |
| if (s->rndis) { |
| msg = (struct rndis_packet_msg_type *) s->in_buf; |
| if (!s->rndis_state == RNDIS_DATA_INITIALIZED) |
| return; |
| if (size + sizeof(struct rndis_packet_msg_type) > sizeof(s->in_buf)) |
| return; |
| |
| memset(msg, 0, sizeof(struct rndis_packet_msg_type)); |
| msg->MessageType = cpu_to_le32(RNDIS_PACKET_MSG); |
| msg->MessageLength = cpu_to_le32(size + sizeof(struct rndis_packet_msg_type)); |
| msg->DataOffset = cpu_to_le32(sizeof(struct rndis_packet_msg_type) - 8); |
| msg->DataLength = cpu_to_le32(size); |
| /* msg->OOBDataOffset; |
| * msg->OOBDataLength; |
| * msg->NumOOBDataElements; |
| * msg->PerPacketInfoOffset; |
| * msg->PerPacketInfoLength; |
| * msg->VcHandle; |
| * msg->Reserved; |
| */ |
| memcpy(msg + 1, buf, size); |
| s->in_len = size + sizeof(struct rndis_packet_msg_type); |
| } else { |
| if (size > sizeof(s->in_buf)) |
| return; |
| memcpy(s->in_buf, buf, size); |
| s->in_len = size; |
| } |
| s->in_ptr = 0; |
| } |
| |
| static int usbnet_can_receive(void *opaque) |
| { |
| USBNetState *s = opaque; |
| |
| if (s->rndis && !s->rndis_state == RNDIS_DATA_INITIALIZED) |
| return 1; |
| |
| return !s->in_len; |
| } |
| |
| static void usb_net_handle_destroy(USBDevice *dev) |
| { |
| USBNetState *s = (USBNetState *) dev; |
| |
| /* TODO: remove the nd_table[] entry */ |
| qemu_del_vlan_client(s->vc); |
| rndis_clear_responsequeue(s); |
| qemu_free(s); |
| } |
| |
| USBDevice *usb_net_init(NICInfo *nd) |
| { |
| USBNetState *s; |
| |
| s = qemu_mallocz(sizeof(USBNetState)); |
| s->dev.speed = USB_SPEED_FULL; |
| s->dev.handle_packet = usb_generic_handle_packet; |
| |
| s->dev.handle_reset = usb_net_handle_reset; |
| s->dev.handle_control = usb_net_handle_control; |
| s->dev.handle_data = usb_net_handle_data; |
| s->dev.handle_destroy = usb_net_handle_destroy; |
| |
| s->rndis = 1; |
| s->rndis_state = RNDIS_UNINITIALIZED; |
| s->medium = 0; /* NDIS_MEDIUM_802_3 */ |
| s->speed = 1000000; /* 100MBps, in 100Bps units */ |
| s->media_state = 0; /* NDIS_MEDIA_STATE_CONNECTED */; |
| s->filter = 0; |
| s->vendorid = 0x1234; |
| |
| memcpy(s->mac, nd->macaddr, 6); |
| TAILQ_INIT(&s->rndis_resp); |
| |
| pstrcpy(s->dev.devname, sizeof(s->dev.devname), |
| "QEMU USB Network Interface"); |
| s->vc = qemu_new_vlan_client(nd->vlan, nd->model, nd->name, |
| usbnet_receive, usbnet_can_receive, s); |
| |
| qemu_format_nic_info_str(s->vc, s->mac); |
| |
| snprintf(s->usbstring_mac, sizeof(s->usbstring_mac), |
| "%02x%02x%02x%02x%02x%02x", |
| 0x40, s->mac[1], s->mac[2], |
| s->mac[3], s->mac[4], s->mac[5]); |
| fprintf(stderr, "usbnet: initialized mac %02x:%02x:%02x:%02x:%02x:%02x\n", |
| s->mac[0], s->mac[1], s->mac[2], |
| s->mac[3], s->mac[4], s->mac[5]); |
| |
| return (USBDevice *) s; |
| } |
