Commit 6c9f886ceae5b998dc2b9af2bf77666941689bce
1 parent
e6bf7d70
Add CDC-Ethernet usb NIC (original patch from Thomas Sailer).
git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@4884 c046a42c-6fe2-441c-8c8c-71466251a162
Showing
5 changed files
with
1495 additions
and
2 deletions
Makefile
... | ... | @@ -60,7 +60,8 @@ OBJS+=ssd0303.o ssd0323.o ads7846.o stellaris_input.o twl92230.o |
60 | 60 | OBJS+=tmp105.o lm832x.o |
61 | 61 | OBJS+=scsi-disk.o cdrom.o |
62 | 62 | OBJS+=scsi-generic.o |
63 | -OBJS+=usb.o usb-hub.o usb-linux.o usb-hid.o usb-msd.o usb-wacom.o usb-serial.o | |
63 | +OBJS+=usb.o usb-hub.o usb-linux.o usb-hid.o usb-msd.o usb-wacom.o | |
64 | +OBJS+=usb-serial.o usb-net.o | |
64 | 65 | OBJS+=sd.o ssi-sd.o |
65 | 66 | |
66 | 67 | ifdef CONFIG_BRLAPI | ... | ... |
hw/usb-net.c
0 → 100644
1 | +/* | |
2 | + * QEMU USB Net devices | |
3 | + * | |
4 | + * Copyright (c) 2006 Thomas Sailer | |
5 | + * Copyright (c) 2008 Andrzej Zaborowski | |
6 | + * | |
7 | + * Permission is hereby granted, free of charge, to any person obtaining a copy | |
8 | + * of this software and associated documentation files (the "Software"), to deal | |
9 | + * in the Software without restriction, including without limitation the rights | |
10 | + * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell | |
11 | + * copies of the Software, and to permit persons to whom the Software is | |
12 | + * furnished to do so, subject to the following conditions: | |
13 | + * | |
14 | + * The above copyright notice and this permission notice shall be included in | |
15 | + * all copies or substantial portions of the Software. | |
16 | + * | |
17 | + * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR | |
18 | + * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, | |
19 | + * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL | |
20 | + * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER | |
21 | + * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, | |
22 | + * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN | |
23 | + * THE SOFTWARE. | |
24 | + */ | |
25 | + | |
26 | +#include "qemu-common.h" | |
27 | +#include "usb.h" | |
28 | +#include "net.h" | |
29 | +#include "audio/sys-queue.h" | |
30 | + | |
31 | +/*#define TRAFFIC_DEBUG*/ | |
32 | +/* Thanks to NetChip Technologies for donating this product ID. | |
33 | + * It's for devices with only CDC Ethernet configurations. | |
34 | + */ | |
35 | +#define CDC_VENDOR_NUM 0x0525 /* NetChip */ | |
36 | +#define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */ | |
37 | +/* For hardware that can talk RNDIS and either of the above protocols, | |
38 | + * use this ID ... the windows INF files will know it. | |
39 | + */ | |
40 | +#define RNDIS_VENDOR_NUM 0x0525 /* NetChip */ | |
41 | +#define RNDIS_PRODUCT_NUM 0xa4a2 /* Ethernet/RNDIS Gadget */ | |
42 | + | |
43 | +enum usbstring_idx { | |
44 | + STRING_MANUFACTURER = 1, | |
45 | + STRING_PRODUCT, | |
46 | + STRING_ETHADDR, | |
47 | + STRING_DATA, | |
48 | + STRING_CONTROL, | |
49 | + STRING_RNDIS_CONTROL, | |
50 | + STRING_CDC, | |
51 | + STRING_SUBSET, | |
52 | + STRING_RNDIS, | |
53 | + STRING_SERIALNUMBER, | |
54 | +}; | |
55 | + | |
56 | +#define DEV_CONFIG_VALUE 1 /* CDC or a subset */ | |
57 | +#define DEV_RNDIS_CONFIG_VALUE 2 /* RNDIS; optional */ | |
58 | + | |
59 | +#define USB_CDC_SUBCLASS_ACM 0x02 | |
60 | +#define USB_CDC_SUBCLASS_ETHERNET 0x06 | |
61 | + | |
62 | +#define USB_CDC_PROTO_NONE 0 | |
63 | +#define USB_CDC_ACM_PROTO_VENDOR 0xff | |
64 | + | |
65 | +#define USB_CDC_HEADER_TYPE 0x00 /* header_desc */ | |
66 | +#define USB_CDC_CALL_MANAGEMENT_TYPE 0x01 /* call_mgmt_descriptor */ | |
67 | +#define USB_CDC_ACM_TYPE 0x02 /* acm_descriptor */ | |
68 | +#define USB_CDC_UNION_TYPE 0x06 /* union_desc */ | |
69 | +#define USB_CDC_ETHERNET_TYPE 0x0f /* ether_desc */ | |
70 | + | |
71 | +#define USB_DT_CS_INTERFACE 0x24 | |
72 | +#define USB_DT_CS_ENDPOINT 0x25 | |
73 | + | |
74 | +#define ClassInterfaceRequest \ | |
75 | + ((USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE) << 8) | |
76 | +#define ClassInterfaceOutRequest \ | |
77 | + ((USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE) << 8) | |
78 | + | |
79 | +#define USB_CDC_SEND_ENCAPSULATED_COMMAND 0x00 | |
80 | +#define USB_CDC_GET_ENCAPSULATED_RESPONSE 0x01 | |
81 | +#define USB_CDC_REQ_SET_LINE_CODING 0x20 | |
82 | +#define USB_CDC_REQ_GET_LINE_CODING 0x21 | |
83 | +#define USB_CDC_REQ_SET_CONTROL_LINE_STATE 0x22 | |
84 | +#define USB_CDC_REQ_SEND_BREAK 0x23 | |
85 | +#define USB_CDC_SET_ETHERNET_MULTICAST_FILTERS 0x40 | |
86 | +#define USB_CDC_SET_ETHERNET_PM_PATTERN_FILTER 0x41 | |
87 | +#define USB_CDC_GET_ETHERNET_PM_PATTERN_FILTER 0x42 | |
88 | +#define USB_CDC_SET_ETHERNET_PACKET_FILTER 0x43 | |
89 | +#define USB_CDC_GET_ETHERNET_STATISTIC 0x44 | |
90 | + | |
91 | +#define LOG2_STATUS_INTERVAL_MSEC 5 /* 1 << 5 == 32 msec */ | |
92 | +#define STATUS_BYTECOUNT 16 /* 8 byte header + data */ | |
93 | + | |
94 | +#define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */ | |
95 | + | |
96 | +/* | |
97 | + * mostly the same descriptor as the linux gadget rndis driver | |
98 | + */ | |
99 | +static const uint8_t qemu_net_dev_descriptor[] = { | |
100 | + 0x12, /* u8 bLength; */ | |
101 | + USB_DT_DEVICE, /* u8 bDescriptorType; Device */ | |
102 | + 0x00, 0x02, /* u16 bcdUSB; v2.0 */ | |
103 | + USB_CLASS_COMM, /* u8 bDeviceClass; */ | |
104 | + 0x00, /* u8 bDeviceSubClass; */ | |
105 | + 0x00, /* u8 bDeviceProtocol; [ low/full only ] */ | |
106 | + 0x40, /* u8 bMaxPacketSize0 */ | |
107 | + RNDIS_VENDOR_NUM & 0xff, RNDIS_VENDOR_NUM >> 8, /* u16 idVendor; */ | |
108 | + RNDIS_PRODUCT_NUM & 0xff, RNDIS_PRODUCT_NUM >> 8, /* u16 idProduct; */ | |
109 | + 0x00, 0x00, /* u16 bcdDevice */ | |
110 | + STRING_MANUFACTURER, /* u8 iManufacturer; */ | |
111 | + STRING_PRODUCT, /* u8 iProduct; */ | |
112 | + STRING_SERIALNUMBER, /* u8 iSerialNumber; */ | |
113 | + 0x02, /* u8 bNumConfigurations; */ | |
114 | +}; | |
115 | + | |
116 | +static const uint8_t qemu_net_rndis_config_descriptor[] = { | |
117 | + /* Configuration Descriptor */ | |
118 | + 0x09, /* u8 bLength */ | |
119 | + USB_DT_CONFIG, /* u8 bDescriptorType */ | |
120 | + 0x43, 0x00, /* le16 wTotalLength */ | |
121 | + 0x02, /* u8 bNumInterfaces */ | |
122 | + DEV_RNDIS_CONFIG_VALUE, /* u8 bConfigurationValue */ | |
123 | + STRING_RNDIS, /* u8 iConfiguration */ | |
124 | + 0xc0, /* u8 bmAttributes */ | |
125 | + 0x32, /* u8 bMaxPower */ | |
126 | + /* RNDIS Control Interface */ | |
127 | + 0x09, /* u8 bLength */ | |
128 | + USB_DT_INTERFACE, /* u8 bDescriptorType */ | |
129 | + 0x00, /* u8 bInterfaceNumber */ | |
130 | + 0x00, /* u8 bAlternateSetting */ | |
131 | + 0x01, /* u8 bNumEndpoints */ | |
132 | + USB_CLASS_COMM, /* u8 bInterfaceClass */ | |
133 | + USB_CDC_SUBCLASS_ACM, /* u8 bInterfaceSubClass */ | |
134 | + USB_CDC_ACM_PROTO_VENDOR, /* u8 bInterfaceProtocol */ | |
135 | + STRING_RNDIS_CONTROL, /* u8 iInterface */ | |
136 | + /* Header Descriptor */ | |
137 | + 0x05, /* u8 bLength */ | |
138 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
139 | + USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */ | |
140 | + 0x10, 0x01, /* le16 bcdCDC */ | |
141 | + /* Call Management Descriptor */ | |
142 | + 0x05, /* u8 bLength */ | |
143 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
144 | + USB_CDC_CALL_MANAGEMENT_TYPE, /* u8 bDescriptorSubType */ | |
145 | + 0x00, /* u8 bmCapabilities */ | |
146 | + 0x01, /* u8 bDataInterface */ | |
147 | + /* ACM Descriptor */ | |
148 | + 0x04, /* u8 bLength */ | |
149 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
150 | + USB_CDC_ACM_TYPE, /* u8 bDescriptorSubType */ | |
151 | + 0x00, /* u8 bmCapabilities */ | |
152 | + /* Union Descriptor */ | |
153 | + 0x05, /* u8 bLength */ | |
154 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
155 | + USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */ | |
156 | + 0x00, /* u8 bMasterInterface0 */ | |
157 | + 0x01, /* u8 bSlaveInterface0 */ | |
158 | + /* Status Descriptor */ | |
159 | + 0x07, /* u8 bLength */ | |
160 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
161 | + USB_DIR_IN | 1, /* u8 bEndpointAddress */ | |
162 | + USB_ENDPOINT_XFER_INT, /* u8 bmAttributes */ | |
163 | + STATUS_BYTECOUNT & 0xff, STATUS_BYTECOUNT >> 8, /* le16 wMaxPacketSize */ | |
164 | + 1 << LOG2_STATUS_INTERVAL_MSEC, /* u8 bInterval */ | |
165 | + /* RNDIS Data Interface */ | |
166 | + 0x09, /* u8 bLength */ | |
167 | + USB_DT_INTERFACE, /* u8 bDescriptorType */ | |
168 | + 0x01, /* u8 bInterfaceNumber */ | |
169 | + 0x00, /* u8 bAlternateSetting */ | |
170 | + 0x02, /* u8 bNumEndpoints */ | |
171 | + USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ | |
172 | + 0x00, /* u8 bInterfaceSubClass */ | |
173 | + 0x00, /* u8 bInterfaceProtocol */ | |
174 | + STRING_DATA, /* u8 iInterface */ | |
175 | + /* Source Endpoint */ | |
176 | + 0x07, /* u8 bLength */ | |
177 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
178 | + USB_DIR_IN | 2, /* u8 bEndpointAddress */ | |
179 | + USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ | |
180 | + 0x40, 0x00, /* le16 wMaxPacketSize */ | |
181 | + 0x00, /* u8 bInterval */ | |
182 | + /* Sink Endpoint */ | |
183 | + 0x07, /* u8 bLength */ | |
184 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
185 | + USB_DIR_OUT | 2, /* u8 bEndpointAddress */ | |
186 | + USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ | |
187 | + 0x40, 0x00, /* le16 wMaxPacketSize */ | |
188 | + 0x00 /* u8 bInterval */ | |
189 | +}; | |
190 | + | |
191 | +static const uint8_t qemu_net_cdc_config_descriptor[] = { | |
192 | + /* Configuration Descriptor */ | |
193 | + 0x09, /* u8 bLength */ | |
194 | + USB_DT_CONFIG, /* u8 bDescriptorType */ | |
195 | + 0x50, 0x00, /* le16 wTotalLength */ | |
196 | + 0x02, /* u8 bNumInterfaces */ | |
197 | + DEV_CONFIG_VALUE, /* u8 bConfigurationValue */ | |
198 | + STRING_CDC, /* u8 iConfiguration */ | |
199 | + 0xc0, /* u8 bmAttributes */ | |
200 | + 0x32, /* u8 bMaxPower */ | |
201 | + /* CDC Control Interface */ | |
202 | + 0x09, /* u8 bLength */ | |
203 | + USB_DT_INTERFACE, /* u8 bDescriptorType */ | |
204 | + 0x00, /* u8 bInterfaceNumber */ | |
205 | + 0x00, /* u8 bAlternateSetting */ | |
206 | + 0x01, /* u8 bNumEndpoints */ | |
207 | + USB_CLASS_COMM, /* u8 bInterfaceClass */ | |
208 | + USB_CDC_SUBCLASS_ETHERNET, /* u8 bInterfaceSubClass */ | |
209 | + USB_CDC_PROTO_NONE, /* u8 bInterfaceProtocol */ | |
210 | + STRING_CONTROL, /* u8 iInterface */ | |
211 | + /* Header Descriptor */ | |
212 | + 0x05, /* u8 bLength */ | |
213 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
214 | + USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */ | |
215 | + 0x10, 0x01, /* le16 bcdCDC */ | |
216 | + /* Union Descriptor */ | |
217 | + 0x05, /* u8 bLength */ | |
218 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
219 | + USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */ | |
220 | + 0x00, /* u8 bMasterInterface0 */ | |
221 | + 0x01, /* u8 bSlaveInterface0 */ | |
222 | + /* Ethernet Descriptor */ | |
223 | + 0x0d, /* u8 bLength */ | |
224 | + USB_DT_CS_INTERFACE, /* u8 bDescriptorType */ | |
225 | + USB_CDC_ETHERNET_TYPE, /* u8 bDescriptorSubType */ | |
226 | + STRING_ETHADDR, /* u8 iMACAddress */ | |
227 | + 0x00, 0x00, 0x00, 0x00, /* le32 bmEthernetStatistics */ | |
228 | + ETH_FRAME_LEN & 0xff, ETH_FRAME_LEN >> 8, /* le16 wMaxSegmentSize */ | |
229 | + 0x00, 0x00, /* le16 wNumberMCFilters */ | |
230 | + 0x00, /* u8 bNumberPowerFilters */ | |
231 | + /* Status Descriptor */ | |
232 | + 0x07, /* u8 bLength */ | |
233 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
234 | + USB_DIR_IN | 1, /* u8 bEndpointAddress */ | |
235 | + USB_ENDPOINT_XFER_INT, /* u8 bmAttributes */ | |
236 | + STATUS_BYTECOUNT & 0xff, STATUS_BYTECOUNT >> 8, /* le16 wMaxPacketSize */ | |
237 | + 1 << LOG2_STATUS_INTERVAL_MSEC, /* u8 bInterval */ | |
238 | + /* CDC Data (nop) Interface */ | |
239 | + 0x09, /* u8 bLength */ | |
240 | + USB_DT_INTERFACE, /* u8 bDescriptorType */ | |
241 | + 0x01, /* u8 bInterfaceNumber */ | |
242 | + 0x00, /* u8 bAlternateSetting */ | |
243 | + 0x00, /* u8 bNumEndpoints */ | |
244 | + USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ | |
245 | + 0x00, /* u8 bInterfaceSubClass */ | |
246 | + 0x00, /* u8 bInterfaceProtocol */ | |
247 | + 0x00, /* u8 iInterface */ | |
248 | + /* CDC Data Interface */ | |
249 | + 0x09, /* u8 bLength */ | |
250 | + USB_DT_INTERFACE, /* u8 bDescriptorType */ | |
251 | + 0x01, /* u8 bInterfaceNumber */ | |
252 | + 0x01, /* u8 bAlternateSetting */ | |
253 | + 0x02, /* u8 bNumEndpoints */ | |
254 | + USB_CLASS_CDC_DATA, /* u8 bInterfaceClass */ | |
255 | + 0x00, /* u8 bInterfaceSubClass */ | |
256 | + 0x00, /* u8 bInterfaceProtocol */ | |
257 | + STRING_DATA, /* u8 iInterface */ | |
258 | + /* Source Endpoint */ | |
259 | + 0x07, /* u8 bLength */ | |
260 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
261 | + USB_DIR_IN | 2, /* u8 bEndpointAddress */ | |
262 | + USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ | |
263 | + 0x40, 0x00, /* le16 wMaxPacketSize */ | |
264 | + 0x00, /* u8 bInterval */ | |
265 | + /* Sink Endpoint */ | |
266 | + 0x07, /* u8 bLength */ | |
267 | + USB_DT_ENDPOINT, /* u8 bDescriptorType */ | |
268 | + USB_DIR_OUT | 2, /* u8 bEndpointAddress */ | |
269 | + USB_ENDPOINT_XFER_BULK, /* u8 bmAttributes */ | |
270 | + 0x40, 0x00, /* le16 wMaxPacketSize */ | |
271 | + 0x00 /* u8 bInterval */ | |
272 | +}; | |
273 | + | |
274 | +/* | |
275 | + * RNDIS Definitions - in theory not specific to USB. | |
276 | + */ | |
277 | +#define RNDIS_MAXIMUM_FRAME_SIZE 1518 | |
278 | +#define RNDIS_MAX_TOTAL_SIZE 1558 | |
279 | + | |
280 | +/* Remote NDIS Versions */ | |
281 | +#define RNDIS_MAJOR_VERSION 1 | |
282 | +#define RNDIS_MINOR_VERSION 0 | |
283 | + | |
284 | +/* Status Values */ | |
285 | +#define RNDIS_STATUS_SUCCESS 0x00000000U /* Success */ | |
286 | +#define RNDIS_STATUS_FAILURE 0xc0000001U /* Unspecified error */ | |
287 | +#define RNDIS_STATUS_INVALID_DATA 0xc0010015U /* Invalid data */ | |
288 | +#define RNDIS_STATUS_NOT_SUPPORTED 0xc00000bbU /* Unsupported request */ | |
289 | +#define RNDIS_STATUS_MEDIA_CONNECT 0x4001000bU /* Device connected */ | |
290 | +#define RNDIS_STATUS_MEDIA_DISCONNECT 0x4001000cU /* Device disconnected */ | |
291 | + | |
292 | +/* Message Set for Connectionless (802.3) Devices */ | |
293 | +enum { | |
294 | + RNDIS_PACKET_MSG = 1, | |
295 | + RNDIS_INITIALIZE_MSG = 2, /* Initialize device */ | |
296 | + RNDIS_HALT_MSG = 3, | |
297 | + RNDIS_QUERY_MSG = 4, | |
298 | + RNDIS_SET_MSG = 5, | |
299 | + RNDIS_RESET_MSG = 6, | |
300 | + RNDIS_INDICATE_STATUS_MSG = 7, | |
301 | + RNDIS_KEEPALIVE_MSG = 8, | |
302 | +}; | |
303 | + | |
304 | +/* Message completion */ | |
305 | +enum { | |
306 | + RNDIS_INITIALIZE_CMPLT = 0x80000002U, | |
307 | + RNDIS_QUERY_CMPLT = 0x80000004U, | |
308 | + RNDIS_SET_CMPLT = 0x80000005U, | |
309 | + RNDIS_RESET_CMPLT = 0x80000006U, | |
310 | + RNDIS_KEEPALIVE_CMPLT = 0x80000008U, | |
311 | +}; | |
312 | + | |
313 | +/* Device Flags */ | |
314 | +enum { | |
315 | + RNDIS_DF_CONNECTIONLESS = 1, | |
316 | + RNDIS_DF_CONNECTIONORIENTED = 2, | |
317 | +}; | |
318 | + | |
319 | +#define RNDIS_MEDIUM_802_3 0x00000000U | |
320 | + | |
321 | +/* from drivers/net/sk98lin/h/skgepnmi.h */ | |
322 | +#define OID_PNP_CAPABILITIES 0xfd010100 | |
323 | +#define OID_PNP_SET_POWER 0xfd010101 | |
324 | +#define OID_PNP_QUERY_POWER 0xfd010102 | |
325 | +#define OID_PNP_ADD_WAKE_UP_PATTERN 0xfd010103 | |
326 | +#define OID_PNP_REMOVE_WAKE_UP_PATTERN 0xfd010104 | |
327 | +#define OID_PNP_ENABLE_WAKE_UP 0xfd010106 | |
328 | + | |
329 | +typedef uint32_t le32; | |
330 | + | |
331 | +typedef struct rndis_init_msg_type { | |
332 | + le32 MessageType; | |
333 | + le32 MessageLength; | |
334 | + le32 RequestID; | |
335 | + le32 MajorVersion; | |
336 | + le32 MinorVersion; | |
337 | + le32 MaxTransferSize; | |
338 | +} rndis_init_msg_type; | |
339 | + | |
340 | +typedef struct rndis_init_cmplt_type { | |
341 | + le32 MessageType; | |
342 | + le32 MessageLength; | |
343 | + le32 RequestID; | |
344 | + le32 Status; | |
345 | + le32 MajorVersion; | |
346 | + le32 MinorVersion; | |
347 | + le32 DeviceFlags; | |
348 | + le32 Medium; | |
349 | + le32 MaxPacketsPerTransfer; | |
350 | + le32 MaxTransferSize; | |
351 | + le32 PacketAlignmentFactor; | |
352 | + le32 AFListOffset; | |
353 | + le32 AFListSize; | |
354 | +} rndis_init_cmplt_type; | |
355 | + | |
356 | +typedef struct rndis_halt_msg_type { | |
357 | + le32 MessageType; | |
358 | + le32 MessageLength; | |
359 | + le32 RequestID; | |
360 | +} rndis_halt_msg_type; | |
361 | + | |
362 | +typedef struct rndis_query_msg_type { | |
363 | + le32 MessageType; | |
364 | + le32 MessageLength; | |
365 | + le32 RequestID; | |
366 | + le32 OID; | |
367 | + le32 InformationBufferLength; | |
368 | + le32 InformationBufferOffset; | |
369 | + le32 DeviceVcHandle; | |
370 | +} rndis_query_msg_type; | |
371 | + | |
372 | +typedef struct rndis_query_cmplt_type { | |
373 | + le32 MessageType; | |
374 | + le32 MessageLength; | |
375 | + le32 RequestID; | |
376 | + le32 Status; | |
377 | + le32 InformationBufferLength; | |
378 | + le32 InformationBufferOffset; | |
379 | +} rndis_query_cmplt_type; | |
380 | + | |
381 | +typedef struct rndis_set_msg_type { | |
382 | + le32 MessageType; | |
383 | + le32 MessageLength; | |
384 | + le32 RequestID; | |
385 | + le32 OID; | |
386 | + le32 InformationBufferLength; | |
387 | + le32 InformationBufferOffset; | |
388 | + le32 DeviceVcHandle; | |
389 | +} rndis_set_msg_type; | |
390 | + | |
391 | +typedef struct rndis_set_cmplt_type { | |
392 | + le32 MessageType; | |
393 | + le32 MessageLength; | |
394 | + le32 RequestID; | |
395 | + le32 Status; | |
396 | +} rndis_set_cmplt_type; | |
397 | + | |
398 | +typedef struct rndis_reset_msg_type { | |
399 | + le32 MessageType; | |
400 | + le32 MessageLength; | |
401 | + le32 Reserved; | |
402 | +} rndis_reset_msg_type; | |
403 | + | |
404 | +typedef struct rndis_reset_cmplt_type { | |
405 | + le32 MessageType; | |
406 | + le32 MessageLength; | |
407 | + le32 Status; | |
408 | + le32 AddressingReset; | |
409 | +} rndis_reset_cmplt_type; | |
410 | + | |
411 | +typedef struct rndis_indicate_status_msg_type { | |
412 | + le32 MessageType; | |
413 | + le32 MessageLength; | |
414 | + le32 Status; | |
415 | + le32 StatusBufferLength; | |
416 | + le32 StatusBufferOffset; | |
417 | +} rndis_indicate_status_msg_type; | |
418 | + | |
419 | +typedef struct rndis_keepalive_msg_type { | |
420 | + le32 MessageType; | |
421 | + le32 MessageLength; | |
422 | + le32 RequestID; | |
423 | +} rndis_keepalive_msg_type; | |
424 | + | |
425 | +typedef struct rndis_keepalive_cmplt_type { | |
426 | + le32 MessageType; | |
427 | + le32 MessageLength; | |
428 | + le32 RequestID; | |
429 | + le32 Status; | |
430 | +} rndis_keepalive_cmplt_type; | |
431 | + | |
432 | +struct rndis_packet_msg_type { | |
433 | + le32 MessageType; | |
434 | + le32 MessageLength; | |
435 | + le32 DataOffset; | |
436 | + le32 DataLength; | |
437 | + le32 OOBDataOffset; | |
438 | + le32 OOBDataLength; | |
439 | + le32 NumOOBDataElements; | |
440 | + le32 PerPacketInfoOffset; | |
441 | + le32 PerPacketInfoLength; | |
442 | + le32 VcHandle; | |
443 | + le32 Reserved; | |
444 | +}; | |
445 | + | |
446 | +struct rndis_config_parameter { | |
447 | + le32 ParameterNameOffset; | |
448 | + le32 ParameterNameLength; | |
449 | + le32 ParameterType; | |
450 | + le32 ParameterValueOffset; | |
451 | + le32 ParameterValueLength; | |
452 | +}; | |
453 | + | |
454 | +/* implementation specific */ | |
455 | +enum rndis_state | |
456 | +{ | |
457 | + RNDIS_UNINITIALIZED, | |
458 | + RNDIS_INITIALIZED, | |
459 | + RNDIS_DATA_INITIALIZED, | |
460 | +}; | |
461 | + | |
462 | +/* from ndis.h */ | |
463 | +enum ndis_oid { | |
464 | + /* Required Object IDs (OIDs) */ | |
465 | + OID_GEN_SUPPORTED_LIST = 0x00010101, | |
466 | + OID_GEN_HARDWARE_STATUS = 0x00010102, | |
467 | + OID_GEN_MEDIA_SUPPORTED = 0x00010103, | |
468 | + OID_GEN_MEDIA_IN_USE = 0x00010104, | |
469 | + OID_GEN_MAXIMUM_LOOKAHEAD = 0x00010105, | |
470 | + OID_GEN_MAXIMUM_FRAME_SIZE = 0x00010106, | |
471 | + OID_GEN_LINK_SPEED = 0x00010107, | |
472 | + OID_GEN_TRANSMIT_BUFFER_SPACE = 0x00010108, | |
473 | + OID_GEN_RECEIVE_BUFFER_SPACE = 0x00010109, | |
474 | + OID_GEN_TRANSMIT_BLOCK_SIZE = 0x0001010a, | |
475 | + OID_GEN_RECEIVE_BLOCK_SIZE = 0x0001010b, | |
476 | + OID_GEN_VENDOR_ID = 0x0001010c, | |
477 | + OID_GEN_VENDOR_DESCRIPTION = 0x0001010d, | |
478 | + OID_GEN_CURRENT_PACKET_FILTER = 0x0001010e, | |
479 | + OID_GEN_CURRENT_LOOKAHEAD = 0x0001010f, | |
480 | + OID_GEN_DRIVER_VERSION = 0x00010110, | |
481 | + OID_GEN_MAXIMUM_TOTAL_SIZE = 0x00010111, | |
482 | + OID_GEN_PROTOCOL_OPTIONS = 0x00010112, | |
483 | + OID_GEN_MAC_OPTIONS = 0x00010113, | |
484 | + OID_GEN_MEDIA_CONNECT_STATUS = 0x00010114, | |
485 | + OID_GEN_MAXIMUM_SEND_PACKETS = 0x00010115, | |
486 | + OID_GEN_VENDOR_DRIVER_VERSION = 0x00010116, | |
487 | + OID_GEN_SUPPORTED_GUIDS = 0x00010117, | |
488 | + OID_GEN_NETWORK_LAYER_ADDRESSES = 0x00010118, | |
489 | + OID_GEN_TRANSPORT_HEADER_OFFSET = 0x00010119, | |
490 | + OID_GEN_MACHINE_NAME = 0x0001021a, | |
491 | + OID_GEN_RNDIS_CONFIG_PARAMETER = 0x0001021b, | |
492 | + OID_GEN_VLAN_ID = 0x0001021c, | |
493 | + | |
494 | + /* Optional OIDs */ | |
495 | + OID_GEN_MEDIA_CAPABILITIES = 0x00010201, | |
496 | + OID_GEN_PHYSICAL_MEDIUM = 0x00010202, | |
497 | + | |
498 | + /* Required statistics OIDs */ | |
499 | + OID_GEN_XMIT_OK = 0x00020101, | |
500 | + OID_GEN_RCV_OK = 0x00020102, | |
501 | + OID_GEN_XMIT_ERROR = 0x00020103, | |
502 | + OID_GEN_RCV_ERROR = 0x00020104, | |
503 | + OID_GEN_RCV_NO_BUFFER = 0x00020105, | |
504 | + | |
505 | + /* Optional statistics OIDs */ | |
506 | + OID_GEN_DIRECTED_BYTES_XMIT = 0x00020201, | |
507 | + OID_GEN_DIRECTED_FRAMES_XMIT = 0x00020202, | |
508 | + OID_GEN_MULTICAST_BYTES_XMIT = 0x00020203, | |
509 | + OID_GEN_MULTICAST_FRAMES_XMIT = 0x00020204, | |
510 | + OID_GEN_BROADCAST_BYTES_XMIT = 0x00020205, | |
511 | + OID_GEN_BROADCAST_FRAMES_XMIT = 0x00020206, | |
512 | + OID_GEN_DIRECTED_BYTES_RCV = 0x00020207, | |
513 | + OID_GEN_DIRECTED_FRAMES_RCV = 0x00020208, | |
514 | + OID_GEN_MULTICAST_BYTES_RCV = 0x00020209, | |
515 | + OID_GEN_MULTICAST_FRAMES_RCV = 0x0002020a, | |
516 | + OID_GEN_BROADCAST_BYTES_RCV = 0x0002020b, | |
517 | + OID_GEN_BROADCAST_FRAMES_RCV = 0x0002020c, | |
518 | + OID_GEN_RCV_CRC_ERROR = 0x0002020d, | |
519 | + OID_GEN_TRANSMIT_QUEUE_LENGTH = 0x0002020e, | |
520 | + OID_GEN_GET_TIME_CAPS = 0x0002020f, | |
521 | + OID_GEN_GET_NETCARD_TIME = 0x00020210, | |
522 | + OID_GEN_NETCARD_LOAD = 0x00020211, | |
523 | + OID_GEN_DEVICE_PROFILE = 0x00020212, | |
524 | + OID_GEN_INIT_TIME_MS = 0x00020213, | |
525 | + OID_GEN_RESET_COUNTS = 0x00020214, | |
526 | + OID_GEN_MEDIA_SENSE_COUNTS = 0x00020215, | |
527 | + OID_GEN_FRIENDLY_NAME = 0x00020216, | |
528 | + OID_GEN_MINIPORT_INFO = 0x00020217, | |
529 | + OID_GEN_RESET_VERIFY_PARAMETERS = 0x00020218, | |
530 | + | |
531 | + /* IEEE 802.3 (Ethernet) OIDs */ | |
532 | + OID_802_3_PERMANENT_ADDRESS = 0x01010101, | |
533 | + OID_802_3_CURRENT_ADDRESS = 0x01010102, | |
534 | + OID_802_3_MULTICAST_LIST = 0x01010103, | |
535 | + OID_802_3_MAXIMUM_LIST_SIZE = 0x01010104, | |
536 | + OID_802_3_MAC_OPTIONS = 0x01010105, | |
537 | + OID_802_3_RCV_ERROR_ALIGNMENT = 0x01020101, | |
538 | + OID_802_3_XMIT_ONE_COLLISION = 0x01020102, | |
539 | + OID_802_3_XMIT_MORE_COLLISIONS = 0x01020103, | |
540 | + OID_802_3_XMIT_DEFERRED = 0x01020201, | |
541 | + OID_802_3_XMIT_MAX_COLLISIONS = 0x01020202, | |
542 | + OID_802_3_RCV_OVERRUN = 0x01020203, | |
543 | + OID_802_3_XMIT_UNDERRUN = 0x01020204, | |
544 | + OID_802_3_XMIT_HEARTBEAT_FAILURE = 0x01020205, | |
545 | + OID_802_3_XMIT_TIMES_CRS_LOST = 0x01020206, | |
546 | + OID_802_3_XMIT_LATE_COLLISIONS = 0x01020207, | |
547 | +}; | |
548 | + | |
549 | +static const uint32_t oid_supported_list[] = | |
550 | +{ | |
551 | + /* the general stuff */ | |
552 | + OID_GEN_SUPPORTED_LIST, | |
553 | + OID_GEN_HARDWARE_STATUS, | |
554 | + OID_GEN_MEDIA_SUPPORTED, | |
555 | + OID_GEN_MEDIA_IN_USE, | |
556 | + OID_GEN_MAXIMUM_FRAME_SIZE, | |
557 | + OID_GEN_LINK_SPEED, | |
558 | + OID_GEN_TRANSMIT_BLOCK_SIZE, | |
559 | + OID_GEN_RECEIVE_BLOCK_SIZE, | |
560 | + OID_GEN_VENDOR_ID, | |
561 | + OID_GEN_VENDOR_DESCRIPTION, | |
562 | + OID_GEN_VENDOR_DRIVER_VERSION, | |
563 | + OID_GEN_CURRENT_PACKET_FILTER, | |
564 | + OID_GEN_MAXIMUM_TOTAL_SIZE, | |
565 | + OID_GEN_MEDIA_CONNECT_STATUS, | |
566 | + OID_GEN_PHYSICAL_MEDIUM, | |
567 | + | |
568 | + /* the statistical stuff */ | |
569 | + OID_GEN_XMIT_OK, | |
570 | + OID_GEN_RCV_OK, | |
571 | + OID_GEN_XMIT_ERROR, | |
572 | + OID_GEN_RCV_ERROR, | |
573 | + OID_GEN_RCV_NO_BUFFER, | |
574 | + | |
575 | + /* IEEE 802.3 */ | |
576 | + /* the general stuff */ | |
577 | + OID_802_3_PERMANENT_ADDRESS, | |
578 | + OID_802_3_CURRENT_ADDRESS, | |
579 | + OID_802_3_MULTICAST_LIST, | |
580 | + OID_802_3_MAC_OPTIONS, | |
581 | + OID_802_3_MAXIMUM_LIST_SIZE, | |
582 | + | |
583 | + /* the statistical stuff */ | |
584 | + OID_802_3_RCV_ERROR_ALIGNMENT, | |
585 | + OID_802_3_XMIT_ONE_COLLISION, | |
586 | + OID_802_3_XMIT_MORE_COLLISIONS, | |
587 | +}; | |
588 | + | |
589 | +#define NDIS_MAC_OPTION_COPY_LOOKAHEAD_DATA (1 << 0) | |
590 | +#define NDIS_MAC_OPTION_RECEIVE_SERIALIZED (1 << 1) | |
591 | +#define NDIS_MAC_OPTION_TRANSFERS_NOT_PEND (1 << 2) | |
592 | +#define NDIS_MAC_OPTION_NO_LOOPBACK (1 << 3) | |
593 | +#define NDIS_MAC_OPTION_FULL_DUPLEX (1 << 4) | |
594 | +#define NDIS_MAC_OPTION_EOTX_INDICATION (1 << 5) | |
595 | +#define NDIS_MAC_OPTION_8021P_PRIORITY (1 << 6) | |
596 | + | |
597 | +struct rndis_response { | |
598 | + TAILQ_ENTRY(rndis_response) entries; | |
599 | + uint32_t length; | |
600 | + uint8_t buf[0]; | |
601 | +}; | |
602 | + | |
603 | +typedef struct USBNetState { | |
604 | + USBDevice dev; | |
605 | + | |
606 | + unsigned int rndis; | |
607 | + enum rndis_state rndis_state; | |
608 | + uint32_t medium; | |
609 | + uint32_t speed; | |
610 | + uint32_t media_state; | |
611 | + uint16_t filter; | |
612 | + uint32_t vendorid; | |
613 | + uint8_t mac[6]; | |
614 | + | |
615 | + unsigned int out_ptr; | |
616 | + uint8_t out_buf[2048]; | |
617 | + | |
618 | + USBPacket *inpkt; | |
619 | + unsigned int in_ptr, in_len; | |
620 | + uint8_t in_buf[2048]; | |
621 | + | |
622 | + char usbstring_mac[13]; | |
623 | + VLANClientState *vc; | |
624 | + TAILQ_HEAD(rndis_resp_head, rndis_response) rndis_resp; | |
625 | +} USBNetState; | |
626 | + | |
627 | +static int ndis_query(USBNetState *s, uint32_t oid, | |
628 | + uint8_t *inbuf, unsigned int inlen, uint8_t *outbuf) | |
629 | +{ | |
630 | + unsigned int i, count; | |
631 | + | |
632 | + switch (oid) { | |
633 | + /* general oids (table 4-1) */ | |
634 | + /* mandatory */ | |
635 | + case OID_GEN_SUPPORTED_LIST: | |
636 | + count = sizeof(oid_supported_list) / sizeof(uint32_t); | |
637 | + for (i = 0; i < count; i++) | |
638 | + ((le32 *) outbuf)[i] = cpu_to_le32(oid_supported_list[i]); | |
639 | + return sizeof(oid_supported_list); | |
640 | + | |
641 | + /* mandatory */ | |
642 | + case OID_GEN_HARDWARE_STATUS: | |
643 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
644 | + return sizeof(le32); | |
645 | + | |
646 | + /* mandatory */ | |
647 | + case OID_GEN_MEDIA_SUPPORTED: | |
648 | + *((le32 *) outbuf) = cpu_to_le32(s->medium); | |
649 | + return sizeof(le32); | |
650 | + | |
651 | + /* mandatory */ | |
652 | + case OID_GEN_MEDIA_IN_USE: | |
653 | + *((le32 *) outbuf) = cpu_to_le32(s->medium); | |
654 | + return sizeof(le32); | |
655 | + | |
656 | + /* mandatory */ | |
657 | + case OID_GEN_MAXIMUM_FRAME_SIZE: | |
658 | + *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); | |
659 | + return sizeof(le32); | |
660 | + | |
661 | + /* mandatory */ | |
662 | + case OID_GEN_LINK_SPEED: | |
663 | + *((le32 *) outbuf) = cpu_to_le32(s->speed); | |
664 | + return sizeof(le32); | |
665 | + | |
666 | + /* mandatory */ | |
667 | + case OID_GEN_TRANSMIT_BLOCK_SIZE: | |
668 | + *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); | |
669 | + return sizeof(le32); | |
670 | + | |
671 | + /* mandatory */ | |
672 | + case OID_GEN_RECEIVE_BLOCK_SIZE: | |
673 | + *((le32 *) outbuf) = cpu_to_le32(ETH_FRAME_LEN); | |
674 | + return sizeof(le32); | |
675 | + | |
676 | + /* mandatory */ | |
677 | + case OID_GEN_VENDOR_ID: | |
678 | + *((le32 *) outbuf) = cpu_to_le32(s->vendorid); | |
679 | + return sizeof(le32); | |
680 | + | |
681 | + /* mandatory */ | |
682 | + case OID_GEN_VENDOR_DESCRIPTION: | |
683 | + strcpy(outbuf, "QEMU USB RNDIS Net"); | |
684 | + return strlen(outbuf) + 1; | |
685 | + | |
686 | + case OID_GEN_VENDOR_DRIVER_VERSION: | |
687 | + *((le32 *) outbuf) = cpu_to_le32(1); | |
688 | + return sizeof(le32); | |
689 | + | |
690 | + /* mandatory */ | |
691 | + case OID_GEN_CURRENT_PACKET_FILTER: | |
692 | + *((le32 *) outbuf) = cpu_to_le32(s->filter); | |
693 | + return sizeof(le32); | |
694 | + | |
695 | + /* mandatory */ | |
696 | + case OID_GEN_MAXIMUM_TOTAL_SIZE: | |
697 | + *((le32 *) outbuf) = cpu_to_le32(RNDIS_MAX_TOTAL_SIZE); | |
698 | + return sizeof(le32); | |
699 | + | |
700 | + /* mandatory */ | |
701 | + case OID_GEN_MEDIA_CONNECT_STATUS: | |
702 | + *((le32 *) outbuf) = cpu_to_le32(s->media_state); | |
703 | + return sizeof(le32); | |
704 | + | |
705 | + case OID_GEN_PHYSICAL_MEDIUM: | |
706 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
707 | + return sizeof(le32); | |
708 | + | |
709 | + case OID_GEN_MAC_OPTIONS: | |
710 | + *((le32 *) outbuf) = cpu_to_le32( | |
711 | + NDIS_MAC_OPTION_RECEIVE_SERIALIZED | | |
712 | + NDIS_MAC_OPTION_FULL_DUPLEX); | |
713 | + return sizeof(le32); | |
714 | + | |
715 | + /* statistics OIDs (table 4-2) */ | |
716 | + /* mandatory */ | |
717 | + case OID_GEN_XMIT_OK: | |
718 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
719 | + return sizeof(le32); | |
720 | + | |
721 | + /* mandatory */ | |
722 | + case OID_GEN_RCV_OK: | |
723 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
724 | + return sizeof(le32); | |
725 | + | |
726 | + /* mandatory */ | |
727 | + case OID_GEN_XMIT_ERROR: | |
728 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
729 | + return sizeof(le32); | |
730 | + | |
731 | + /* mandatory */ | |
732 | + case OID_GEN_RCV_ERROR: | |
733 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
734 | + return sizeof(le32); | |
735 | + | |
736 | + /* mandatory */ | |
737 | + case OID_GEN_RCV_NO_BUFFER: | |
738 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
739 | + return sizeof(le32); | |
740 | + | |
741 | + /* ieee802.3 OIDs (table 4-3) */ | |
742 | + /* mandatory */ | |
743 | + case OID_802_3_PERMANENT_ADDRESS: | |
744 | + memcpy(outbuf, s->mac, 6); | |
745 | + return 6; | |
746 | + | |
747 | + /* mandatory */ | |
748 | + case OID_802_3_CURRENT_ADDRESS: | |
749 | + memcpy(outbuf, s->mac, 6); | |
750 | + return 6; | |
751 | + | |
752 | + /* mandatory */ | |
753 | + case OID_802_3_MULTICAST_LIST: | |
754 | + *((le32 *) outbuf) = cpu_to_le32(0xe0000000); | |
755 | + return sizeof(le32); | |
756 | + | |
757 | + /* mandatory */ | |
758 | + case OID_802_3_MAXIMUM_LIST_SIZE: | |
759 | + *((le32 *) outbuf) = cpu_to_le32(1); | |
760 | + return sizeof(le32); | |
761 | + | |
762 | + case OID_802_3_MAC_OPTIONS: | |
763 | + return 0; | |
764 | + | |
765 | + /* ieee802.3 statistics OIDs (table 4-4) */ | |
766 | + /* mandatory */ | |
767 | + case OID_802_3_RCV_ERROR_ALIGNMENT: | |
768 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
769 | + return sizeof(le32); | |
770 | + | |
771 | + /* mandatory */ | |
772 | + case OID_802_3_XMIT_ONE_COLLISION: | |
773 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
774 | + return sizeof(le32); | |
775 | + | |
776 | + /* mandatory */ | |
777 | + case OID_802_3_XMIT_MORE_COLLISIONS: | |
778 | + *((le32 *) outbuf) = cpu_to_le32(0); | |
779 | + return sizeof(le32); | |
780 | + | |
781 | + default: | |
782 | + fprintf(stderr, "usbnet: unknown OID 0x%08x\n", oid); | |
783 | + return 0; | |
784 | + } | |
785 | + return -1; | |
786 | +} | |
787 | + | |
788 | +static int ndis_set(USBNetState *s, uint32_t oid, | |
789 | + uint8_t *inbuf, unsigned int inlen) | |
790 | +{ | |
791 | + switch (oid) { | |
792 | + case OID_GEN_CURRENT_PACKET_FILTER: | |
793 | + s->filter = le32_to_cpup((le32 *) inbuf); | |
794 | + if (s->filter) { | |
795 | + s->rndis_state = RNDIS_DATA_INITIALIZED; | |
796 | + } else { | |
797 | + s->rndis_state = RNDIS_INITIALIZED; | |
798 | + } | |
799 | + return 0; | |
800 | + | |
801 | + case OID_802_3_MULTICAST_LIST: | |
802 | + return 0; | |
803 | + } | |
804 | + return -1; | |
805 | +} | |
806 | + | |
807 | +static int rndis_get_response(USBNetState *s, uint8_t *buf) | |
808 | +{ | |
809 | + int ret = 0; | |
810 | + struct rndis_response *r = s->rndis_resp.tqh_first; | |
811 | + | |
812 | + if (!r) | |
813 | + return ret; | |
814 | + | |
815 | + TAILQ_REMOVE(&s->rndis_resp, r, entries); | |
816 | + ret = r->length; | |
817 | + memcpy(buf, r->buf, r->length); | |
818 | + qemu_free(r); | |
819 | + | |
820 | + return ret; | |
821 | +} | |
822 | + | |
823 | +static void *rndis_queue_response(USBNetState *s, unsigned int length) | |
824 | +{ | |
825 | + struct rndis_response *r = | |
826 | + qemu_mallocz(sizeof(struct rndis_response) + length); | |
827 | + | |
828 | + TAILQ_INSERT_TAIL(&s->rndis_resp, r, entries); | |
829 | + r->length = length; | |
830 | + | |
831 | + return &r->buf[0]; | |
832 | +} | |
833 | + | |
834 | +static void rndis_clear_responsequeue(USBNetState *s) | |
835 | +{ | |
836 | + struct rndis_response *r; | |
837 | + | |
838 | + while ((r = s->rndis_resp.tqh_first)) { | |
839 | + TAILQ_REMOVE(&s->rndis_resp, r, entries); | |
840 | + qemu_free(r); | |
841 | + } | |
842 | +} | |
843 | + | |
844 | +static int rndis_init_response(USBNetState *s, rndis_init_msg_type *buf) | |
845 | +{ | |
846 | + rndis_init_cmplt_type *resp = | |
847 | + rndis_queue_response(s, sizeof(rndis_init_cmplt_type)); | |
848 | + | |
849 | + if (!resp) | |
850 | + return USB_RET_STALL; | |
851 | + | |
852 | + resp->MessageType = cpu_to_le32(RNDIS_INITIALIZE_CMPLT); | |
853 | + resp->MessageLength = cpu_to_le32(sizeof(rndis_init_cmplt_type)); | |
854 | + resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ | |
855 | + resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); | |
856 | + resp->MajorVersion = cpu_to_le32(RNDIS_MAJOR_VERSION); | |
857 | + resp->MinorVersion = cpu_to_le32(RNDIS_MINOR_VERSION); | |
858 | + resp->DeviceFlags = cpu_to_le32(RNDIS_DF_CONNECTIONLESS); | |
859 | + resp->Medium = cpu_to_le32(RNDIS_MEDIUM_802_3); | |
860 | + resp->MaxPacketsPerTransfer = cpu_to_le32(1); | |
861 | + resp->MaxTransferSize = cpu_to_le32(ETH_FRAME_LEN + | |
862 | + sizeof(struct rndis_packet_msg_type) + 22); | |
863 | + resp->PacketAlignmentFactor = cpu_to_le32(0); | |
864 | + resp->AFListOffset = cpu_to_le32(0); | |
865 | + resp->AFListSize = cpu_to_le32(0); | |
866 | + return 0; | |
867 | +} | |
868 | + | |
869 | +static int rndis_query_response(USBNetState *s, | |
870 | + rndis_query_msg_type *buf, unsigned int length) | |
871 | +{ | |
872 | + rndis_query_cmplt_type *resp; | |
873 | + /* oid_supported_list is the largest data reply */ | |
874 | + uint8_t infobuf[sizeof(oid_supported_list)]; | |
875 | + uint32_t bufoffs, buflen; | |
876 | + int infobuflen; | |
877 | + unsigned int resplen; | |
878 | + | |
879 | + bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8; | |
880 | + buflen = le32_to_cpu(buf->InformationBufferLength); | |
881 | + if (bufoffs + buflen > length) | |
882 | + return USB_RET_STALL; | |
883 | + | |
884 | + infobuflen = ndis_query(s, le32_to_cpu(buf->OID), | |
885 | + bufoffs + (uint8_t *) buf, buflen, infobuf); | |
886 | + resplen = sizeof(rndis_query_cmplt_type) + | |
887 | + ((infobuflen < 0) ? 0 : infobuflen); | |
888 | + resp = rndis_queue_response(s, resplen); | |
889 | + if (!resp) | |
890 | + return USB_RET_STALL; | |
891 | + | |
892 | + resp->MessageType = cpu_to_le32(RNDIS_QUERY_CMPLT); | |
893 | + resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ | |
894 | + resp->MessageLength = cpu_to_le32(resplen); | |
895 | + | |
896 | + if (infobuflen < 0) { | |
897 | + /* OID not supported */ | |
898 | + resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED); | |
899 | + resp->InformationBufferLength = cpu_to_le32(0); | |
900 | + resp->InformationBufferOffset = cpu_to_le32(0); | |
901 | + return 0; | |
902 | + } | |
903 | + | |
904 | + resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); | |
905 | + resp->InformationBufferOffset = | |
906 | + cpu_to_le32(infobuflen ? sizeof(rndis_query_cmplt_type) - 8 : 0); | |
907 | + resp->InformationBufferLength = cpu_to_le32(infobuflen); | |
908 | + memcpy(resp + 1, infobuf, infobuflen); | |
909 | + | |
910 | + return 0; | |
911 | +} | |
912 | + | |
913 | +static int rndis_set_response(USBNetState *s, | |
914 | + rndis_set_msg_type *buf, unsigned int length) | |
915 | +{ | |
916 | + rndis_set_cmplt_type *resp = | |
917 | + rndis_queue_response(s, sizeof(rndis_set_cmplt_type)); | |
918 | + uint32_t bufoffs, buflen; | |
919 | + int ret; | |
920 | + | |
921 | + if (!resp) | |
922 | + return USB_RET_STALL; | |
923 | + | |
924 | + bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8; | |
925 | + buflen = le32_to_cpu(buf->InformationBufferLength); | |
926 | + if (bufoffs + buflen > length) | |
927 | + return USB_RET_STALL; | |
928 | + | |
929 | + ret = ndis_set(s, le32_to_cpu(buf->OID), | |
930 | + bufoffs + (uint8_t *) buf, buflen); | |
931 | + resp->MessageType = cpu_to_le32(RNDIS_SET_CMPLT); | |
932 | + resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ | |
933 | + resp->MessageLength = cpu_to_le32(sizeof(rndis_set_cmplt_type)); | |
934 | + if (ret < 0) { | |
935 | + /* OID not supported */ | |
936 | + resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED); | |
937 | + return 0; | |
938 | + } | |
939 | + resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); | |
940 | + | |
941 | + return 0; | |
942 | +} | |
943 | + | |
944 | +static int rndis_reset_response(USBNetState *s, rndis_reset_msg_type *buf) | |
945 | +{ | |
946 | + rndis_reset_cmplt_type *resp = | |
947 | + rndis_queue_response(s, sizeof(rndis_reset_cmplt_type)); | |
948 | + | |
949 | + if (!resp) | |
950 | + return USB_RET_STALL; | |
951 | + | |
952 | + resp->MessageType = cpu_to_le32(RNDIS_RESET_CMPLT); | |
953 | + resp->MessageLength = cpu_to_le32(sizeof(rndis_reset_cmplt_type)); | |
954 | + resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); | |
955 | + resp->AddressingReset = cpu_to_le32(1); /* reset information */ | |
956 | + | |
957 | + return 0; | |
958 | +} | |
959 | + | |
960 | +static int rndis_keepalive_response(USBNetState *s, | |
961 | + rndis_keepalive_msg_type *buf) | |
962 | +{ | |
963 | + rndis_keepalive_cmplt_type *resp = | |
964 | + rndis_queue_response(s, sizeof(rndis_keepalive_cmplt_type)); | |
965 | + | |
966 | + if (!resp) | |
967 | + return USB_RET_STALL; | |
968 | + | |
969 | + resp->MessageType = cpu_to_le32(RNDIS_KEEPALIVE_CMPLT); | |
970 | + resp->MessageLength = cpu_to_le32(sizeof(rndis_keepalive_cmplt_type)); | |
971 | + resp->RequestID = buf->RequestID; /* Still LE in msg buffer */ | |
972 | + resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS); | |
973 | + | |
974 | + return 0; | |
975 | +} | |
976 | + | |
977 | +static int rndis_parse(USBNetState *s, uint8_t *data, int length) | |
978 | +{ | |
979 | + uint32_t msg_type, msg_length; | |
980 | + le32 *tmp = (le32 *) data; | |
981 | + | |
982 | + msg_type = le32_to_cpup(tmp++); | |
983 | + msg_length = le32_to_cpup(tmp++); | |
984 | + | |
985 | + switch (msg_type) { | |
986 | + case RNDIS_INITIALIZE_MSG: | |
987 | + s->rndis_state = RNDIS_INITIALIZED; | |
988 | + return rndis_init_response(s, (rndis_init_msg_type *) data); | |
989 | + | |
990 | + case RNDIS_HALT_MSG: | |
991 | + s->rndis_state = RNDIS_UNINITIALIZED; | |
992 | + return 0; | |
993 | + | |
994 | + case RNDIS_QUERY_MSG: | |
995 | + return rndis_query_response(s, (rndis_query_msg_type *) data, length); | |
996 | + | |
997 | + case RNDIS_SET_MSG: | |
998 | + return rndis_set_response(s, (rndis_set_msg_type *) data, length); | |
999 | + | |
1000 | + case RNDIS_RESET_MSG: | |
1001 | + rndis_clear_responsequeue(s); | |
1002 | + s->out_ptr = s->in_ptr = s->in_len = 0; | |
1003 | + return rndis_reset_response(s, (rndis_reset_msg_type *) data); | |
1004 | + | |
1005 | + case RNDIS_KEEPALIVE_MSG: | |
1006 | + /* For USB: host does this every 5 seconds */ | |
1007 | + return rndis_keepalive_response(s, (rndis_keepalive_msg_type *) data); | |
1008 | + } | |
1009 | + | |
1010 | + return USB_RET_STALL; | |
1011 | +} | |
1012 | + | |
1013 | +static void usb_net_handle_reset(USBDevice *dev) | |
1014 | +{ | |
1015 | +} | |
1016 | + | |
1017 | +static char *usb_net_stringtable[] = { | |
1018 | + [STRING_MANUFACTURER] = "QEMU", | |
1019 | + [STRING_PRODUCT] = "RNDIS/QEMU USB Network Device", | |
1020 | + [STRING_ETHADDR] = "400102030405", | |
1021 | + [STRING_DATA] = "QEMU USB Net Data Interface", | |
1022 | + [STRING_CONTROL] = "QEMU USB Net Control Interface", | |
1023 | + [STRING_RNDIS_CONTROL] = "QEMU USB Net RNDIS Control Interface", | |
1024 | + [STRING_CDC] = "QEMU USB Net CDC", | |
1025 | + [STRING_SUBSET] = "QEMU USB Net Subset", | |
1026 | + [STRING_RNDIS] = "QEMU USB Net RNDIS", | |
1027 | + [STRING_SERIALNUMBER] = "1", | |
1028 | +}; | |
1029 | + | |
1030 | +static int usb_net_handle_control(USBDevice *dev, int request, int value, | |
1031 | + int index, int length, uint8_t *data) | |
1032 | +{ | |
1033 | + USBNetState *s = (USBNetState *) dev; | |
1034 | + int ret = 0; | |
1035 | + | |
1036 | + switch(request) { | |
1037 | + case DeviceRequest | USB_REQ_GET_STATUS: | |
1038 | + data[0] = (1 << USB_DEVICE_SELF_POWERED) | | |
1039 | + (dev->remote_wakeup << USB_DEVICE_REMOTE_WAKEUP); | |
1040 | + data[1] = 0x00; | |
1041 | + ret = 2; | |
1042 | + break; | |
1043 | + | |
1044 | + case DeviceOutRequest | USB_REQ_CLEAR_FEATURE: | |
1045 | + if (value == USB_DEVICE_REMOTE_WAKEUP) { | |
1046 | + dev->remote_wakeup = 0; | |
1047 | + } else { | |
1048 | + goto fail; | |
1049 | + } | |
1050 | + ret = 0; | |
1051 | + break; | |
1052 | + | |
1053 | + case DeviceOutRequest | USB_REQ_SET_FEATURE: | |
1054 | + if (value == USB_DEVICE_REMOTE_WAKEUP) { | |
1055 | + dev->remote_wakeup = 1; | |
1056 | + } else { | |
1057 | + goto fail; | |
1058 | + } | |
1059 | + ret = 0; | |
1060 | + break; | |
1061 | + | |
1062 | + case DeviceOutRequest | USB_REQ_SET_ADDRESS: | |
1063 | + dev->addr = value; | |
1064 | + ret = 0; | |
1065 | + break; | |
1066 | + | |
1067 | + case ClassInterfaceOutRequest | USB_CDC_SEND_ENCAPSULATED_COMMAND: | |
1068 | + if (!s->rndis || value || index != 0) | |
1069 | + goto fail; | |
1070 | +#if TRAFFIC_DEBUG | |
1071 | + { | |
1072 | + unsigned int i; | |
1073 | + fprintf(stderr, "SEND_ENCAPSULATED_COMMAND:"); | |
1074 | + for (i = 0; i < length; i++) { | |
1075 | + if (!(i & 15)) | |
1076 | + fprintf(stderr, "\n%04x:", i); | |
1077 | + fprintf(stderr, " %02x", data[i]); | |
1078 | + } | |
1079 | + fprintf(stderr, "\n\n"); | |
1080 | + } | |
1081 | +#endif | |
1082 | + ret = rndis_parse(s, data, length); | |
1083 | + break; | |
1084 | + | |
1085 | + case ClassInterfaceRequest | USB_CDC_GET_ENCAPSULATED_RESPONSE: | |
1086 | + if (!s->rndis || value || index != 0) | |
1087 | + goto fail; | |
1088 | + ret = rndis_get_response(s, data); | |
1089 | + if (!ret) { | |
1090 | + data[0] = 0; | |
1091 | + ret = 1; | |
1092 | + } | |
1093 | +#if TRAFFIC_DEBUG | |
1094 | + { | |
1095 | + unsigned int i; | |
1096 | + fprintf(stderr, "GET_ENCAPSULATED_RESPONSE:"); | |
1097 | + for (i = 0; i < ret; i++) { | |
1098 | + if (!(i & 15)) | |
1099 | + fprintf(stderr, "\n%04x:", i); | |
1100 | + fprintf(stderr, " %02x", data[i]); | |
1101 | + } | |
1102 | + fprintf(stderr, "\n\n"); | |
1103 | + } | |
1104 | +#endif | |
1105 | + break; | |
1106 | + | |
1107 | + case DeviceRequest | USB_REQ_GET_DESCRIPTOR: | |
1108 | + switch(value >> 8) { | |
1109 | + case USB_DT_DEVICE: | |
1110 | + ret = sizeof(qemu_net_dev_descriptor); | |
1111 | + memcpy(data, qemu_net_dev_descriptor, ret); | |
1112 | + break; | |
1113 | + | |
1114 | + case USB_DT_CONFIG: | |
1115 | + switch (value & 0xff) { | |
1116 | + case 0: | |
1117 | + ret = sizeof(qemu_net_rndis_config_descriptor); | |
1118 | + memcpy(data, qemu_net_rndis_config_descriptor, ret); | |
1119 | + break; | |
1120 | + | |
1121 | + case 1: | |
1122 | + ret = sizeof(qemu_net_cdc_config_descriptor); | |
1123 | + memcpy(data, qemu_net_cdc_config_descriptor, ret); | |
1124 | + break; | |
1125 | + | |
1126 | + default: | |
1127 | + goto fail; | |
1128 | + } | |
1129 | + | |
1130 | + data[2] = ret & 0xff; | |
1131 | + data[3] = ret >> 8; | |
1132 | + break; | |
1133 | + | |
1134 | + case USB_DT_STRING: | |
1135 | + switch (value & 0xff) { | |
1136 | + case 0: | |
1137 | + /* language ids */ | |
1138 | + data[0] = 4; | |
1139 | + data[1] = 3; | |
1140 | + data[2] = 0x09; | |
1141 | + data[3] = 0x04; | |
1142 | + ret = 4; | |
1143 | + break; | |
1144 | + | |
1145 | + case STRING_ETHADDR: | |
1146 | + ret = set_usb_string(data, s->usbstring_mac); | |
1147 | + break; | |
1148 | + | |
1149 | + default: | |
1150 | + if (usb_net_stringtable[value & 0xff]) { | |
1151 | + ret = set_usb_string(data, | |
1152 | + usb_net_stringtable[value & 0xff]); | |
1153 | + break; | |
1154 | + } | |
1155 | + | |
1156 | + goto fail; | |
1157 | + } | |
1158 | + break; | |
1159 | + | |
1160 | + default: | |
1161 | + goto fail; | |
1162 | + } | |
1163 | + break; | |
1164 | + | |
1165 | + case DeviceRequest | USB_REQ_GET_CONFIGURATION: | |
1166 | + data[0] = s->rndis ? DEV_RNDIS_CONFIG_VALUE : DEV_CONFIG_VALUE; | |
1167 | + ret = 1; | |
1168 | + break; | |
1169 | + | |
1170 | + case DeviceOutRequest | USB_REQ_SET_CONFIGURATION: | |
1171 | + switch (value & 0xff) { | |
1172 | + case DEV_CONFIG_VALUE: | |
1173 | + s->rndis = 0; | |
1174 | + break; | |
1175 | + | |
1176 | + case DEV_RNDIS_CONFIG_VALUE: | |
1177 | + s->rndis = 1; | |
1178 | + break; | |
1179 | + | |
1180 | + default: | |
1181 | + goto fail; | |
1182 | + } | |
1183 | + ret = 0; | |
1184 | + break; | |
1185 | + | |
1186 | + case DeviceRequest | USB_REQ_GET_INTERFACE: | |
1187 | + case InterfaceRequest | USB_REQ_GET_INTERFACE: | |
1188 | + data[0] = 0; | |
1189 | + ret = 1; | |
1190 | + break; | |
1191 | + | |
1192 | + case DeviceOutRequest | USB_REQ_SET_INTERFACE: | |
1193 | + case InterfaceOutRequest | USB_REQ_SET_INTERFACE: | |
1194 | + ret = 0; | |
1195 | + break; | |
1196 | + | |
1197 | + default: | |
1198 | + fail: | |
1199 | + fprintf(stderr, "usbnet: failed control transaction: " | |
1200 | + "request 0x%x value 0x%x index 0x%x length 0x%x\n", | |
1201 | + request, value, index, length); | |
1202 | + ret = USB_RET_STALL; | |
1203 | + break; | |
1204 | + } | |
1205 | + return ret; | |
1206 | +} | |
1207 | + | |
1208 | +static int usb_net_handle_statusin(USBNetState *s, USBPacket *p) | |
1209 | +{ | |
1210 | + int ret = 8; | |
1211 | + | |
1212 | + if (p->len < 8) | |
1213 | + return USB_RET_STALL; | |
1214 | + | |
1215 | + ((le32 *) p->data)[0] = cpu_to_le32(1); | |
1216 | + ((le32 *) p->data)[1] = cpu_to_le32(0); | |
1217 | + if (!s->rndis_resp.tqh_first) | |
1218 | + ret = USB_RET_NAK; | |
1219 | + | |
1220 | +#if DEBUG | |
1221 | + fprintf(stderr, "usbnet: interrupt poll len %u return %d", p->len, ret); | |
1222 | + { | |
1223 | + int i; | |
1224 | + fprintf(stderr, ":"); | |
1225 | + for (i = 0; i < ret; i++) { | |
1226 | + if (!(i & 15)) | |
1227 | + fprintf(stderr, "\n%04x:", i); | |
1228 | + fprintf(stderr, " %02x", p->data[i]); | |
1229 | + } | |
1230 | + fprintf(stderr, "\n\n"); | |
1231 | + } | |
1232 | +#endif | |
1233 | + | |
1234 | + return ret; | |
1235 | +} | |
1236 | + | |
1237 | +static int usb_net_handle_datain(USBNetState *s, USBPacket *p) | |
1238 | +{ | |
1239 | + int ret = USB_RET_NAK; | |
1240 | + | |
1241 | + if (s->in_ptr > s->in_len) { | |
1242 | + s->in_ptr = s->in_len = 0; | |
1243 | + ret = USB_RET_NAK; | |
1244 | + return ret; | |
1245 | + } | |
1246 | + if (!s->in_len) { | |
1247 | + ret = USB_RET_NAK; | |
1248 | + return ret; | |
1249 | + } | |
1250 | + ret = s->in_len - s->in_ptr; | |
1251 | + if (ret > p->len) | |
1252 | + ret = p->len; | |
1253 | + memcpy(p->data, &s->in_buf[s->in_ptr], ret); | |
1254 | + s->in_ptr += ret; | |
1255 | + if (s->in_ptr >= s->in_len && | |
1256 | + (s->rndis || (s->in_len & (64 - 1)) || !ret)) { | |
1257 | + /* no short packet necessary */ | |
1258 | + s->in_ptr = s->in_len = 0; | |
1259 | + } | |
1260 | + | |
1261 | +#if TRAFFIC_DEBUG | |
1262 | + fprintf(stderr, "usbnet: data in len %u return %d", p->len, ret); | |
1263 | + { | |
1264 | + int i; | |
1265 | + fprintf(stderr, ":"); | |
1266 | + for (i = 0; i < ret; i++) { | |
1267 | + if (!(i & 15)) | |
1268 | + fprintf(stderr, "\n%04x:", i); | |
1269 | + fprintf(stderr, " %02x", p->data[i]); | |
1270 | + } | |
1271 | + fprintf(stderr, "\n\n"); | |
1272 | + } | |
1273 | +#endif | |
1274 | + | |
1275 | + return ret; | |
1276 | +} | |
1277 | + | |
1278 | +static int usb_net_handle_dataout(USBNetState *s, USBPacket *p) | |
1279 | +{ | |
1280 | + int ret = p->len; | |
1281 | + int sz = sizeof(s->out_buf) - s->out_ptr; | |
1282 | + struct rndis_packet_msg_type *msg = | |
1283 | + (struct rndis_packet_msg_type *) s->out_buf; | |
1284 | + uint32_t len; | |
1285 | + | |
1286 | +#if TRAFFIC_DEBUG | |
1287 | + fprintf(stderr, "usbnet: data out len %u\n", p->len); | |
1288 | + { | |
1289 | + int i; | |
1290 | + fprintf(stderr, ":"); | |
1291 | + for (i = 0; i < p->len; i++) { | |
1292 | + if (!(i & 15)) | |
1293 | + fprintf(stderr, "\n%04x:", i); | |
1294 | + fprintf(stderr, " %02x", p->data[i]); | |
1295 | + } | |
1296 | + fprintf(stderr, "\n\n"); | |
1297 | + } | |
1298 | +#endif | |
1299 | + | |
1300 | + if (sz > ret) | |
1301 | + sz = ret; | |
1302 | + memcpy(&s->out_buf[s->out_ptr], p->data, sz); | |
1303 | + s->out_ptr += sz; | |
1304 | + | |
1305 | + if (!s->rndis) { | |
1306 | + if (ret < 64) { | |
1307 | + qemu_send_packet(s->vc, s->out_buf, s->out_ptr); | |
1308 | + s->out_ptr = 0; | |
1309 | + } | |
1310 | + return ret; | |
1311 | + } | |
1312 | + len = le32_to_cpu(msg->MessageLength); | |
1313 | + if (s->out_ptr < 8 || s->out_ptr < len) | |
1314 | + return ret; | |
1315 | + if (le32_to_cpu(msg->MessageType) == RNDIS_PACKET_MSG) { | |
1316 | + uint32_t offs = 8 + le32_to_cpu(msg->DataOffset); | |
1317 | + uint32_t size = le32_to_cpu(msg->DataLength); | |
1318 | + if (offs + size <= len) | |
1319 | + qemu_send_packet(s->vc, s->out_buf + offs, size); | |
1320 | + } | |
1321 | + s->out_ptr -= len; | |
1322 | + memmove(s->out_buf, &s->out_buf[len], s->out_ptr); | |
1323 | + | |
1324 | + return ret; | |
1325 | +} | |
1326 | + | |
1327 | +static int usb_net_handle_data(USBDevice *dev, USBPacket *p) | |
1328 | +{ | |
1329 | + USBNetState *s = (USBNetState *) dev; | |
1330 | + int ret = 0; | |
1331 | + | |
1332 | + switch(p->pid) { | |
1333 | + case USB_TOKEN_IN: | |
1334 | + switch (p->devep) { | |
1335 | + case 1: | |
1336 | + ret = usb_net_handle_statusin(s, p); | |
1337 | + break; | |
1338 | + | |
1339 | + case 2: | |
1340 | + ret = usb_net_handle_datain(s, p); | |
1341 | + break; | |
1342 | + | |
1343 | + default: | |
1344 | + goto fail; | |
1345 | + } | |
1346 | + break; | |
1347 | + | |
1348 | + case USB_TOKEN_OUT: | |
1349 | + switch (p->devep) { | |
1350 | + case 2: | |
1351 | + ret = usb_net_handle_dataout(s, p); | |
1352 | + break; | |
1353 | + | |
1354 | + default: | |
1355 | + goto fail; | |
1356 | + } | |
1357 | + break; | |
1358 | + | |
1359 | + default: | |
1360 | + fail: | |
1361 | + ret = USB_RET_STALL; | |
1362 | + break; | |
1363 | + } | |
1364 | + if (ret == USB_RET_STALL) | |
1365 | + fprintf(stderr, "usbnet: failed data transaction: " | |
1366 | + "pid 0x%x ep 0x%x len 0x%x\n", | |
1367 | + p->pid, p->devep, p->len); | |
1368 | + return ret; | |
1369 | +} | |
1370 | + | |
1371 | +static void usbnet_receive(void *opaque, const uint8_t *buf, int size) | |
1372 | +{ | |
1373 | + USBNetState *s = opaque; | |
1374 | + struct rndis_packet_msg_type *msg; | |
1375 | + | |
1376 | + if (s->rndis) { | |
1377 | + msg = (struct rndis_packet_msg_type *) s->in_buf; | |
1378 | + if (!s->rndis_state == RNDIS_DATA_INITIALIZED) | |
1379 | + return; | |
1380 | + if (size + sizeof(struct rndis_packet_msg_type) > sizeof(s->in_buf)) | |
1381 | + return; | |
1382 | + | |
1383 | + memset(msg, 0, sizeof(struct rndis_packet_msg_type)); | |
1384 | + msg->MessageType = cpu_to_le32(RNDIS_PACKET_MSG); | |
1385 | + msg->MessageLength = cpu_to_le32(size + sizeof(struct rndis_packet_msg_type)); | |
1386 | + msg->DataOffset = cpu_to_le32(sizeof(struct rndis_packet_msg_type) - 8); | |
1387 | + msg->DataLength = cpu_to_le32(size); | |
1388 | + /* msg->OOBDataOffset; | |
1389 | + * msg->OOBDataLength; | |
1390 | + * msg->NumOOBDataElements; | |
1391 | + * msg->PerPacketInfoOffset; | |
1392 | + * msg->PerPacketInfoLength; | |
1393 | + * msg->VcHandle; | |
1394 | + * msg->Reserved; | |
1395 | + */ | |
1396 | + memcpy(msg + 1, buf, size); | |
1397 | + s->in_len = size + sizeof(struct rndis_packet_msg_type); | |
1398 | + } else { | |
1399 | + if (size > sizeof(s->in_buf)) | |
1400 | + return; | |
1401 | + memcpy(s->in_buf, buf, size); | |
1402 | + s->in_len = size; | |
1403 | + } | |
1404 | + s->in_ptr = 0; | |
1405 | +} | |
1406 | + | |
1407 | +static int usbnet_can_receive(void *opaque) | |
1408 | +{ | |
1409 | + USBNetState *s = opaque; | |
1410 | + | |
1411 | + if (s->rndis && !s->rndis_state == RNDIS_DATA_INITIALIZED) | |
1412 | + return 1; | |
1413 | + | |
1414 | + return !s->in_len; | |
1415 | +} | |
1416 | + | |
1417 | +static void usb_net_handle_destroy(USBDevice *dev) | |
1418 | +{ | |
1419 | + USBNetState *s = (USBNetState *) dev; | |
1420 | + | |
1421 | + /* FIXME: delete the VLAN client and the nic */ | |
1422 | + rndis_clear_responsequeue(s); | |
1423 | + qemu_free(s); | |
1424 | +} | |
1425 | + | |
1426 | +USBDevice *usb_net_init(NICInfo *nd) | |
1427 | +{ | |
1428 | + USBNetState *s; | |
1429 | + | |
1430 | + s = qemu_mallocz(sizeof(USBNetState)); | |
1431 | + if (!s) | |
1432 | + return NULL; | |
1433 | + s->dev.speed = USB_SPEED_FULL; | |
1434 | + s->dev.handle_packet = usb_generic_handle_packet; | |
1435 | + | |
1436 | + s->dev.handle_reset = usb_net_handle_reset; | |
1437 | + s->dev.handle_control = usb_net_handle_control; | |
1438 | + s->dev.handle_data = usb_net_handle_data; | |
1439 | + s->dev.handle_destroy = usb_net_handle_destroy; | |
1440 | + | |
1441 | + s->rndis = 1; | |
1442 | + s->rndis_state = RNDIS_UNINITIALIZED; | |
1443 | + s->medium = 0; /* NDIS_MEDIUM_802_3 */ | |
1444 | + s->speed = 1000000; /* 100MBps, in 100Bps units */ | |
1445 | + s->media_state = 0; /* NDIS_MEDIA_STATE_CONNECTED */; | |
1446 | + s->filter = 0; | |
1447 | + s->vendorid = 0x1234; | |
1448 | + | |
1449 | + memcpy(s->mac, nd->macaddr, 6); | |
1450 | + TAILQ_INIT(&s->rndis_resp); | |
1451 | + | |
1452 | + pstrcpy(s->dev.devname, sizeof(s->dev.devname), | |
1453 | + "QEMU USB Network Interface"); | |
1454 | + s->vc = qemu_new_vlan_client(nd->vlan, | |
1455 | + usbnet_receive, usbnet_can_receive, s); | |
1456 | + | |
1457 | + snprintf(s->usbstring_mac, sizeof(s->usbstring_mac), | |
1458 | + "%02x%02x%02x%02x%02x%02x", | |
1459 | + 0x40, s->mac[1], s->mac[2], | |
1460 | + s->mac[3], s->mac[4], s->mac[5]); | |
1461 | + snprintf(s->vc->info_str, sizeof(s->vc->info_str), | |
1462 | + "usbnet macaddr=%02x:%02x:%02x:%02x:%02x:%02x", | |
1463 | + s->mac[0], s->mac[1], s->mac[2], | |
1464 | + s->mac[3], s->mac[4], s->mac[5]); | |
1465 | + fprintf(stderr, "usbnet: initialized mac %02x:%02x:%02x:%02x:%02x:%02x\n", | |
1466 | + s->mac[0], s->mac[1], s->mac[2], | |
1467 | + s->mac[3], s->mac[4], s->mac[5]); | |
1468 | + | |
1469 | + return (USBDevice *) s; | |
1470 | +} | ... | ... |
hw/usb.h
... | ... | @@ -219,6 +219,9 @@ USBDevice *usb_keyboard_init(void); |
219 | 219 | /* usb-msd.c */ |
220 | 220 | USBDevice *usb_msd_init(const char *filename); |
221 | 221 | |
222 | +/* usb-net.c */ | |
223 | +USBDevice *usb_net_init(NICInfo *nd); | |
224 | + | |
222 | 225 | /* usb-wacom.c */ |
223 | 226 | USBDevice *usb_wacom_init(void); |
224 | 227 | ... | ... |
qemu-doc.texi
... | ... | @@ -567,6 +567,9 @@ available devices. |
567 | 567 | Braille device. This will use BrlAPI to display the braille output on a real |
568 | 568 | or fake device. |
569 | 569 | |
570 | +@item net:nic_num | |
571 | +Network adapter that supports CDC ethernet and RNDIS protocols. | |
572 | + | |
570 | 573 | @end table |
571 | 574 | |
572 | 575 | @end table |
... | ... | @@ -584,7 +587,7 @@ Qemu can emulate several different models of network card. |
584 | 587 | Valid values for @var{type} are |
585 | 588 | @code{i82551}, @code{i82557b}, @code{i82559er}, |
586 | 589 | @code{ne2k_pci}, @code{ne2k_isa}, @code{pcnet}, @code{rtl8139}, |
587 | -@code{e1000}, @code{smc91c111}, @code{lance} and @code{mcf_fec}. | |
590 | +@code{e1000}, @code{smc91c111}, @code{lance}, @code{mcf_fec} and @code{usb}. | |
588 | 591 | Not all devices are supported on all targets. Use -net nic,model=? |
589 | 592 | for a list of available devices for your target. |
590 | 593 | |
... | ... | @@ -1707,6 +1710,16 @@ serial converter, faking a Matrix Orbital LCD Display (USB ID 0403:FA00). |
1707 | 1710 | @item braille |
1708 | 1711 | Braille device. This will use BrlAPI to display the braille output on a real |
1709 | 1712 | or fake device. |
1713 | +@item net:@var{nic_num} | |
1714 | +Network adapter that supports CDC ethernet and RNDIS protocols. This must be | |
1715 | +used together with the @code{-net nic,model=usb,...} option (see description), | |
1716 | +where @var{nic_num} specifies the index of the @code{-net nic,...} option | |
1717 | +describing the interface (zero-based). | |
1718 | +For instance, user-mode networking can be used by specifying | |
1719 | +@example | |
1720 | +qemu -net user,vlan=1 -net nic,model=usb,vlan=1 -usbdevice net:0 [...OPTIONS...] | |
1721 | +@end example | |
1722 | +Currently this cannot be used in machines that support PCI NICs. | |
1710 | 1723 | @end table |
1711 | 1724 | |
1712 | 1725 | @node host_usb_devices | ... | ... |
vl.c
... | ... | @@ -5475,6 +5475,12 @@ static int usb_device_add(const char *devname) |
5475 | 5475 | } else if (!strcmp(devname, "braille")) { |
5476 | 5476 | dev = usb_baum_init(); |
5477 | 5477 | #endif |
5478 | + } else if (strstart(devname, "net:", &p)) { | |
5479 | + int nicidx = strtoul(p, NULL, 0); | |
5480 | + | |
5481 | + if (nicidx >= nb_nics || strcmp(nd_table[nicidx].model, "usb")) | |
5482 | + return -1; | |
5483 | + dev = usb_net_init(&nd_table[nicidx]); | |
5478 | 5484 | } else { |
5479 | 5485 | return -1; |
5480 | 5486 | } | ... | ... |