dev-network.c 43 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429
  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. #include "qemu/osdep.h"
  26. #include "qapi/error.h"
  27. #include "hw/qdev-properties.h"
  28. #include "hw/usb.h"
  29. #include "migration/vmstate.h"
  30. #include "desc.h"
  31. #include "net/net.h"
  32. #include "qemu/error-report.h"
  33. #include "qemu/queue.h"
  34. #include "qemu/config-file.h"
  35. #include "sysemu/sysemu.h"
  36. #include "qemu/iov.h"
  37. #include "qemu/module.h"
  38. #include "qemu/cutils.h"
  39. #include "qom/object.h"
  40. /*#define TRAFFIC_DEBUG*/
  41. /* Thanks to NetChip Technologies for donating this product ID.
  42. * It's for devices with only CDC Ethernet configurations.
  43. */
  44. #define CDC_VENDOR_NUM 0x0525 /* NetChip */
  45. #define CDC_PRODUCT_NUM 0xa4a1 /* Linux-USB Ethernet Gadget */
  46. /* For hardware that can talk RNDIS and either of the above protocols,
  47. * use this ID ... the windows INF files will know it.
  48. */
  49. #define RNDIS_VENDOR_NUM 0x0525 /* NetChip */
  50. #define RNDIS_PRODUCT_NUM 0xa4a2 /* Ethernet/RNDIS Gadget */
  51. enum usbstring_idx {
  52. STRING_MANUFACTURER = 1,
  53. STRING_PRODUCT,
  54. STRING_ETHADDR,
  55. STRING_DATA,
  56. STRING_CONTROL,
  57. STRING_RNDIS_CONTROL,
  58. STRING_CDC,
  59. STRING_SUBSET,
  60. STRING_RNDIS,
  61. STRING_SERIALNUMBER,
  62. };
  63. #define DEV_CONFIG_VALUE 1 /* CDC or a subset */
  64. #define DEV_RNDIS_CONFIG_VALUE 2 /* RNDIS; optional */
  65. #define USB_CDC_SUBCLASS_ACM 0x02
  66. #define USB_CDC_SUBCLASS_ETHERNET 0x06
  67. #define USB_CDC_PROTO_NONE 0
  68. #define USB_CDC_ACM_PROTO_VENDOR 0xff
  69. #define USB_CDC_HEADER_TYPE 0x00 /* header_desc */
  70. #define USB_CDC_CALL_MANAGEMENT_TYPE 0x01 /* call_mgmt_descriptor */
  71. #define USB_CDC_ACM_TYPE 0x02 /* acm_descriptor */
  72. #define USB_CDC_UNION_TYPE 0x06 /* union_desc */
  73. #define USB_CDC_ETHERNET_TYPE 0x0f /* ether_desc */
  74. #define USB_CDC_SEND_ENCAPSULATED_COMMAND 0x00
  75. #define USB_CDC_GET_ENCAPSULATED_RESPONSE 0x01
  76. #define USB_CDC_REQ_SET_LINE_CODING 0x20
  77. #define USB_CDC_REQ_GET_LINE_CODING 0x21
  78. #define USB_CDC_REQ_SET_CONTROL_LINE_STATE 0x22
  79. #define USB_CDC_REQ_SEND_BREAK 0x23
  80. #define USB_CDC_SET_ETHERNET_MULTICAST_FILTERS 0x40
  81. #define USB_CDC_SET_ETHERNET_PM_PATTERN_FILTER 0x41
  82. #define USB_CDC_GET_ETHERNET_PM_PATTERN_FILTER 0x42
  83. #define USB_CDC_SET_ETHERNET_PACKET_FILTER 0x43
  84. #define USB_CDC_GET_ETHERNET_STATISTIC 0x44
  85. #define LOG2_STATUS_INTERVAL_MSEC 5 /* 1 << 5 == 32 msec */
  86. #define STATUS_BYTECOUNT 16 /* 8 byte header + data */
  87. #define ETH_FRAME_LEN 1514 /* Max. octets in frame sans FCS */
  88. static const USBDescStrings usb_net_stringtable = {
  89. [STRING_MANUFACTURER] = "QEMU",
  90. [STRING_PRODUCT] = "RNDIS/QEMU USB Network Device",
  91. [STRING_ETHADDR] = "400102030405",
  92. [STRING_DATA] = "QEMU USB Net Data Interface",
  93. [STRING_CONTROL] = "QEMU USB Net Control Interface",
  94. [STRING_RNDIS_CONTROL] = "QEMU USB Net RNDIS Control Interface",
  95. [STRING_CDC] = "QEMU USB Net CDC",
  96. [STRING_SUBSET] = "QEMU USB Net Subset",
  97. [STRING_RNDIS] = "QEMU USB Net RNDIS",
  98. [STRING_SERIALNUMBER] = "1",
  99. };
  100. static const USBDescIface desc_iface_rndis[] = {
  101. {
  102. /* RNDIS Control Interface */
  103. .bInterfaceNumber = 0,
  104. .bNumEndpoints = 1,
  105. .bInterfaceClass = USB_CLASS_COMM,
  106. .bInterfaceSubClass = USB_CDC_SUBCLASS_ACM,
  107. .bInterfaceProtocol = USB_CDC_ACM_PROTO_VENDOR,
  108. .iInterface = STRING_RNDIS_CONTROL,
  109. .ndesc = 4,
  110. .descs = (USBDescOther[]) {
  111. {
  112. /* Header Descriptor */
  113. .data = (uint8_t[]) {
  114. 0x05, /* u8 bLength */
  115. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  116. USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */
  117. 0x10, 0x01, /* le16 bcdCDC */
  118. },
  119. },{
  120. /* Call Management Descriptor */
  121. .data = (uint8_t[]) {
  122. 0x05, /* u8 bLength */
  123. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  124. USB_CDC_CALL_MANAGEMENT_TYPE, /* u8 bDescriptorSubType */
  125. 0x00, /* u8 bmCapabilities */
  126. 0x01, /* u8 bDataInterface */
  127. },
  128. },{
  129. /* ACM Descriptor */
  130. .data = (uint8_t[]) {
  131. 0x04, /* u8 bLength */
  132. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  133. USB_CDC_ACM_TYPE, /* u8 bDescriptorSubType */
  134. 0x00, /* u8 bmCapabilities */
  135. },
  136. },{
  137. /* Union Descriptor */
  138. .data = (uint8_t[]) {
  139. 0x05, /* u8 bLength */
  140. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  141. USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */
  142. 0x00, /* u8 bMasterInterface0 */
  143. 0x01, /* u8 bSlaveInterface0 */
  144. },
  145. },
  146. },
  147. .eps = (USBDescEndpoint[]) {
  148. {
  149. .bEndpointAddress = USB_DIR_IN | 0x01,
  150. .bmAttributes = USB_ENDPOINT_XFER_INT,
  151. .wMaxPacketSize = STATUS_BYTECOUNT,
  152. .bInterval = 1 << LOG2_STATUS_INTERVAL_MSEC,
  153. },
  154. }
  155. },{
  156. /* RNDIS Data Interface */
  157. .bInterfaceNumber = 1,
  158. .bNumEndpoints = 2,
  159. .bInterfaceClass = USB_CLASS_CDC_DATA,
  160. .iInterface = STRING_DATA,
  161. .eps = (USBDescEndpoint[]) {
  162. {
  163. .bEndpointAddress = USB_DIR_IN | 0x02,
  164. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  165. .wMaxPacketSize = 0x40,
  166. },{
  167. .bEndpointAddress = USB_DIR_OUT | 0x02,
  168. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  169. .wMaxPacketSize = 0x40,
  170. }
  171. }
  172. }
  173. };
  174. static const USBDescIface desc_iface_cdc[] = {
  175. {
  176. /* CDC Control Interface */
  177. .bInterfaceNumber = 0,
  178. .bNumEndpoints = 1,
  179. .bInterfaceClass = USB_CLASS_COMM,
  180. .bInterfaceSubClass = USB_CDC_SUBCLASS_ETHERNET,
  181. .bInterfaceProtocol = USB_CDC_PROTO_NONE,
  182. .iInterface = STRING_CONTROL,
  183. .ndesc = 3,
  184. .descs = (USBDescOther[]) {
  185. {
  186. /* Header Descriptor */
  187. .data = (uint8_t[]) {
  188. 0x05, /* u8 bLength */
  189. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  190. USB_CDC_HEADER_TYPE, /* u8 bDescriptorSubType */
  191. 0x10, 0x01, /* le16 bcdCDC */
  192. },
  193. },{
  194. /* Union Descriptor */
  195. .data = (uint8_t[]) {
  196. 0x05, /* u8 bLength */
  197. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  198. USB_CDC_UNION_TYPE, /* u8 bDescriptorSubType */
  199. 0x00, /* u8 bMasterInterface0 */
  200. 0x01, /* u8 bSlaveInterface0 */
  201. },
  202. },{
  203. /* Ethernet Descriptor */
  204. .data = (uint8_t[]) {
  205. 0x0d, /* u8 bLength */
  206. USB_DT_CS_INTERFACE, /* u8 bDescriptorType */
  207. USB_CDC_ETHERNET_TYPE, /* u8 bDescriptorSubType */
  208. STRING_ETHADDR, /* u8 iMACAddress */
  209. 0x00, 0x00, 0x00, 0x00, /* le32 bmEthernetStatistics */
  210. ETH_FRAME_LEN & 0xff,
  211. ETH_FRAME_LEN >> 8, /* le16 wMaxSegmentSize */
  212. 0x00, 0x00, /* le16 wNumberMCFilters */
  213. 0x00, /* u8 bNumberPowerFilters */
  214. },
  215. },
  216. },
  217. .eps = (USBDescEndpoint[]) {
  218. {
  219. .bEndpointAddress = USB_DIR_IN | 0x01,
  220. .bmAttributes = USB_ENDPOINT_XFER_INT,
  221. .wMaxPacketSize = STATUS_BYTECOUNT,
  222. .bInterval = 1 << LOG2_STATUS_INTERVAL_MSEC,
  223. },
  224. }
  225. },{
  226. /* CDC Data Interface (off) */
  227. .bInterfaceNumber = 1,
  228. .bAlternateSetting = 0,
  229. .bNumEndpoints = 0,
  230. .bInterfaceClass = USB_CLASS_CDC_DATA,
  231. },{
  232. /* CDC Data Interface */
  233. .bInterfaceNumber = 1,
  234. .bAlternateSetting = 1,
  235. .bNumEndpoints = 2,
  236. .bInterfaceClass = USB_CLASS_CDC_DATA,
  237. .iInterface = STRING_DATA,
  238. .eps = (USBDescEndpoint[]) {
  239. {
  240. .bEndpointAddress = USB_DIR_IN | 0x02,
  241. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  242. .wMaxPacketSize = 0x40,
  243. },{
  244. .bEndpointAddress = USB_DIR_OUT | 0x02,
  245. .bmAttributes = USB_ENDPOINT_XFER_BULK,
  246. .wMaxPacketSize = 0x40,
  247. }
  248. }
  249. }
  250. };
  251. static const USBDescDevice desc_device_net = {
  252. .bcdUSB = 0x0200,
  253. .bDeviceClass = USB_CLASS_COMM,
  254. .bMaxPacketSize0 = 0x40,
  255. .bNumConfigurations = 2,
  256. .confs = (USBDescConfig[]) {
  257. {
  258. .bNumInterfaces = 2,
  259. .bConfigurationValue = DEV_RNDIS_CONFIG_VALUE,
  260. .iConfiguration = STRING_RNDIS,
  261. .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
  262. .bMaxPower = 0x32,
  263. .nif = ARRAY_SIZE(desc_iface_rndis),
  264. .ifs = desc_iface_rndis,
  265. },{
  266. .bNumInterfaces = 2,
  267. .bConfigurationValue = DEV_CONFIG_VALUE,
  268. .iConfiguration = STRING_CDC,
  269. .bmAttributes = USB_CFG_ATT_ONE | USB_CFG_ATT_SELFPOWER,
  270. .bMaxPower = 0x32,
  271. .nif = ARRAY_SIZE(desc_iface_cdc),
  272. .ifs = desc_iface_cdc,
  273. }
  274. },
  275. };
  276. static const USBDesc desc_net = {
  277. .id = {
  278. .idVendor = RNDIS_VENDOR_NUM,
  279. .idProduct = RNDIS_PRODUCT_NUM,
  280. .bcdDevice = 0,
  281. .iManufacturer = STRING_MANUFACTURER,
  282. .iProduct = STRING_PRODUCT,
  283. .iSerialNumber = STRING_SERIALNUMBER,
  284. },
  285. .full = &desc_device_net,
  286. .str = usb_net_stringtable,
  287. };
  288. /*
  289. * RNDIS Definitions - in theory not specific to USB.
  290. */
  291. #define RNDIS_MAXIMUM_FRAME_SIZE 1518
  292. #define RNDIS_MAX_TOTAL_SIZE 1558
  293. /* Remote NDIS Versions */
  294. #define RNDIS_MAJOR_VERSION 1
  295. #define RNDIS_MINOR_VERSION 0
  296. /* Status Values */
  297. #define RNDIS_STATUS_SUCCESS 0x00000000U /* Success */
  298. #define RNDIS_STATUS_FAILURE 0xc0000001U /* Unspecified error */
  299. #define RNDIS_STATUS_INVALID_DATA 0xc0010015U /* Invalid data */
  300. #define RNDIS_STATUS_NOT_SUPPORTED 0xc00000bbU /* Unsupported request */
  301. #define RNDIS_STATUS_MEDIA_CONNECT 0x4001000bU /* Device connected */
  302. #define RNDIS_STATUS_MEDIA_DISCONNECT 0x4001000cU /* Device disconnected */
  303. /* Message Set for Connectionless (802.3) Devices */
  304. enum {
  305. RNDIS_PACKET_MSG = 1,
  306. RNDIS_INITIALIZE_MSG = 2, /* Initialize device */
  307. RNDIS_HALT_MSG = 3,
  308. RNDIS_QUERY_MSG = 4,
  309. RNDIS_SET_MSG = 5,
  310. RNDIS_RESET_MSG = 6,
  311. RNDIS_INDICATE_STATUS_MSG = 7,
  312. RNDIS_KEEPALIVE_MSG = 8,
  313. };
  314. /* Message completion */
  315. enum {
  316. RNDIS_INITIALIZE_CMPLT = 0x80000002U,
  317. RNDIS_QUERY_CMPLT = 0x80000004U,
  318. RNDIS_SET_CMPLT = 0x80000005U,
  319. RNDIS_RESET_CMPLT = 0x80000006U,
  320. RNDIS_KEEPALIVE_CMPLT = 0x80000008U,
  321. };
  322. /* Device Flags */
  323. enum {
  324. RNDIS_DF_CONNECTIONLESS = 1,
  325. RNDIS_DF_CONNECTIONORIENTED = 2,
  326. };
  327. #define RNDIS_MEDIUM_802_3 0x00000000U
  328. /* from drivers/net/sk98lin/h/skgepnmi.h */
  329. #define OID_PNP_CAPABILITIES 0xfd010100
  330. #define OID_PNP_SET_POWER 0xfd010101
  331. #define OID_PNP_QUERY_POWER 0xfd010102
  332. #define OID_PNP_ADD_WAKE_UP_PATTERN 0xfd010103
  333. #define OID_PNP_REMOVE_WAKE_UP_PATTERN 0xfd010104
  334. #define OID_PNP_ENABLE_WAKE_UP 0xfd010106
  335. typedef uint32_t le32;
  336. typedef struct rndis_init_msg_type {
  337. le32 MessageType;
  338. le32 MessageLength;
  339. le32 RequestID;
  340. le32 MajorVersion;
  341. le32 MinorVersion;
  342. le32 MaxTransferSize;
  343. } rndis_init_msg_type;
  344. typedef struct rndis_init_cmplt_type {
  345. le32 MessageType;
  346. le32 MessageLength;
  347. le32 RequestID;
  348. le32 Status;
  349. le32 MajorVersion;
  350. le32 MinorVersion;
  351. le32 DeviceFlags;
  352. le32 Medium;
  353. le32 MaxPacketsPerTransfer;
  354. le32 MaxTransferSize;
  355. le32 PacketAlignmentFactor;
  356. le32 AFListOffset;
  357. le32 AFListSize;
  358. } rndis_init_cmplt_type;
  359. typedef struct rndis_halt_msg_type {
  360. le32 MessageType;
  361. le32 MessageLength;
  362. le32 RequestID;
  363. } rndis_halt_msg_type;
  364. typedef struct rndis_query_msg_type {
  365. le32 MessageType;
  366. le32 MessageLength;
  367. le32 RequestID;
  368. le32 OID;
  369. le32 InformationBufferLength;
  370. le32 InformationBufferOffset;
  371. le32 DeviceVcHandle;
  372. } rndis_query_msg_type;
  373. typedef struct rndis_query_cmplt_type {
  374. le32 MessageType;
  375. le32 MessageLength;
  376. le32 RequestID;
  377. le32 Status;
  378. le32 InformationBufferLength;
  379. le32 InformationBufferOffset;
  380. } rndis_query_cmplt_type;
  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. typedef struct rndis_set_cmplt_type {
  391. le32 MessageType;
  392. le32 MessageLength;
  393. le32 RequestID;
  394. le32 Status;
  395. } rndis_set_cmplt_type;
  396. typedef struct rndis_reset_msg_type {
  397. le32 MessageType;
  398. le32 MessageLength;
  399. le32 Reserved;
  400. } rndis_reset_msg_type;
  401. typedef struct rndis_reset_cmplt_type {
  402. le32 MessageType;
  403. le32 MessageLength;
  404. le32 Status;
  405. le32 AddressingReset;
  406. } rndis_reset_cmplt_type;
  407. typedef struct rndis_indicate_status_msg_type {
  408. le32 MessageType;
  409. le32 MessageLength;
  410. le32 Status;
  411. le32 StatusBufferLength;
  412. le32 StatusBufferOffset;
  413. } rndis_indicate_status_msg_type;
  414. typedef struct rndis_keepalive_msg_type {
  415. le32 MessageType;
  416. le32 MessageLength;
  417. le32 RequestID;
  418. } rndis_keepalive_msg_type;
  419. typedef struct rndis_keepalive_cmplt_type {
  420. le32 MessageType;
  421. le32 MessageLength;
  422. le32 RequestID;
  423. le32 Status;
  424. } rndis_keepalive_cmplt_type;
  425. struct rndis_packet_msg_type {
  426. le32 MessageType;
  427. le32 MessageLength;
  428. le32 DataOffset;
  429. le32 DataLength;
  430. le32 OOBDataOffset;
  431. le32 OOBDataLength;
  432. le32 NumOOBDataElements;
  433. le32 PerPacketInfoOffset;
  434. le32 PerPacketInfoLength;
  435. le32 VcHandle;
  436. le32 Reserved;
  437. };
  438. struct rndis_config_parameter {
  439. le32 ParameterNameOffset;
  440. le32 ParameterNameLength;
  441. le32 ParameterType;
  442. le32 ParameterValueOffset;
  443. le32 ParameterValueLength;
  444. };
  445. /* implementation specific */
  446. enum rndis_state
  447. {
  448. RNDIS_UNINITIALIZED,
  449. RNDIS_INITIALIZED,
  450. RNDIS_DATA_INITIALIZED,
  451. };
  452. /* from ndis.h */
  453. enum ndis_oid {
  454. /* Required Object IDs (OIDs) */
  455. OID_GEN_SUPPORTED_LIST = 0x00010101,
  456. OID_GEN_HARDWARE_STATUS = 0x00010102,
  457. OID_GEN_MEDIA_SUPPORTED = 0x00010103,
  458. OID_GEN_MEDIA_IN_USE = 0x00010104,
  459. OID_GEN_MAXIMUM_LOOKAHEAD = 0x00010105,
  460. OID_GEN_MAXIMUM_FRAME_SIZE = 0x00010106,
  461. OID_GEN_LINK_SPEED = 0x00010107,
  462. OID_GEN_TRANSMIT_BUFFER_SPACE = 0x00010108,
  463. OID_GEN_RECEIVE_BUFFER_SPACE = 0x00010109,
  464. OID_GEN_TRANSMIT_BLOCK_SIZE = 0x0001010a,
  465. OID_GEN_RECEIVE_BLOCK_SIZE = 0x0001010b,
  466. OID_GEN_VENDOR_ID = 0x0001010c,
  467. OID_GEN_VENDOR_DESCRIPTION = 0x0001010d,
  468. OID_GEN_CURRENT_PACKET_FILTER = 0x0001010e,
  469. OID_GEN_CURRENT_LOOKAHEAD = 0x0001010f,
  470. OID_GEN_DRIVER_VERSION = 0x00010110,
  471. OID_GEN_MAXIMUM_TOTAL_SIZE = 0x00010111,
  472. OID_GEN_PROTOCOL_OPTIONS = 0x00010112,
  473. OID_GEN_MAC_OPTIONS = 0x00010113,
  474. OID_GEN_MEDIA_CONNECT_STATUS = 0x00010114,
  475. OID_GEN_MAXIMUM_SEND_PACKETS = 0x00010115,
  476. OID_GEN_VENDOR_DRIVER_VERSION = 0x00010116,
  477. OID_GEN_SUPPORTED_GUIDS = 0x00010117,
  478. OID_GEN_NETWORK_LAYER_ADDRESSES = 0x00010118,
  479. OID_GEN_TRANSPORT_HEADER_OFFSET = 0x00010119,
  480. OID_GEN_MACHINE_NAME = 0x0001021a,
  481. OID_GEN_RNDIS_CONFIG_PARAMETER = 0x0001021b,
  482. OID_GEN_VLAN_ID = 0x0001021c,
  483. /* Optional OIDs */
  484. OID_GEN_MEDIA_CAPABILITIES = 0x00010201,
  485. OID_GEN_PHYSICAL_MEDIUM = 0x00010202,
  486. /* Required statistics OIDs */
  487. OID_GEN_XMIT_OK = 0x00020101,
  488. OID_GEN_RCV_OK = 0x00020102,
  489. OID_GEN_XMIT_ERROR = 0x00020103,
  490. OID_GEN_RCV_ERROR = 0x00020104,
  491. OID_GEN_RCV_NO_BUFFER = 0x00020105,
  492. /* Optional statistics OIDs */
  493. OID_GEN_DIRECTED_BYTES_XMIT = 0x00020201,
  494. OID_GEN_DIRECTED_FRAMES_XMIT = 0x00020202,
  495. OID_GEN_MULTICAST_BYTES_XMIT = 0x00020203,
  496. OID_GEN_MULTICAST_FRAMES_XMIT = 0x00020204,
  497. OID_GEN_BROADCAST_BYTES_XMIT = 0x00020205,
  498. OID_GEN_BROADCAST_FRAMES_XMIT = 0x00020206,
  499. OID_GEN_DIRECTED_BYTES_RCV = 0x00020207,
  500. OID_GEN_DIRECTED_FRAMES_RCV = 0x00020208,
  501. OID_GEN_MULTICAST_BYTES_RCV = 0x00020209,
  502. OID_GEN_MULTICAST_FRAMES_RCV = 0x0002020a,
  503. OID_GEN_BROADCAST_BYTES_RCV = 0x0002020b,
  504. OID_GEN_BROADCAST_FRAMES_RCV = 0x0002020c,
  505. OID_GEN_RCV_CRC_ERROR = 0x0002020d,
  506. OID_GEN_TRANSMIT_QUEUE_LENGTH = 0x0002020e,
  507. OID_GEN_GET_TIME_CAPS = 0x0002020f,
  508. OID_GEN_GET_NETCARD_TIME = 0x00020210,
  509. OID_GEN_NETCARD_LOAD = 0x00020211,
  510. OID_GEN_DEVICE_PROFILE = 0x00020212,
  511. OID_GEN_INIT_TIME_MS = 0x00020213,
  512. OID_GEN_RESET_COUNTS = 0x00020214,
  513. OID_GEN_MEDIA_SENSE_COUNTS = 0x00020215,
  514. OID_GEN_FRIENDLY_NAME = 0x00020216,
  515. OID_GEN_MINIPORT_INFO = 0x00020217,
  516. OID_GEN_RESET_VERIFY_PARAMETERS = 0x00020218,
  517. /* IEEE 802.3 (Ethernet) OIDs */
  518. OID_802_3_PERMANENT_ADDRESS = 0x01010101,
  519. OID_802_3_CURRENT_ADDRESS = 0x01010102,
  520. OID_802_3_MULTICAST_LIST = 0x01010103,
  521. OID_802_3_MAXIMUM_LIST_SIZE = 0x01010104,
  522. OID_802_3_MAC_OPTIONS = 0x01010105,
  523. OID_802_3_RCV_ERROR_ALIGNMENT = 0x01020101,
  524. OID_802_3_XMIT_ONE_COLLISION = 0x01020102,
  525. OID_802_3_XMIT_MORE_COLLISIONS = 0x01020103,
  526. OID_802_3_XMIT_DEFERRED = 0x01020201,
  527. OID_802_3_XMIT_MAX_COLLISIONS = 0x01020202,
  528. OID_802_3_RCV_OVERRUN = 0x01020203,
  529. OID_802_3_XMIT_UNDERRUN = 0x01020204,
  530. OID_802_3_XMIT_HEARTBEAT_FAILURE = 0x01020205,
  531. OID_802_3_XMIT_TIMES_CRS_LOST = 0x01020206,
  532. OID_802_3_XMIT_LATE_COLLISIONS = 0x01020207,
  533. };
  534. static const uint32_t oid_supported_list[] =
  535. {
  536. /* the general stuff */
  537. OID_GEN_SUPPORTED_LIST,
  538. OID_GEN_HARDWARE_STATUS,
  539. OID_GEN_MEDIA_SUPPORTED,
  540. OID_GEN_MEDIA_IN_USE,
  541. OID_GEN_MAXIMUM_FRAME_SIZE,
  542. OID_GEN_LINK_SPEED,
  543. OID_GEN_TRANSMIT_BLOCK_SIZE,
  544. OID_GEN_RECEIVE_BLOCK_SIZE,
  545. OID_GEN_VENDOR_ID,
  546. OID_GEN_VENDOR_DESCRIPTION,
  547. OID_GEN_VENDOR_DRIVER_VERSION,
  548. OID_GEN_CURRENT_PACKET_FILTER,
  549. OID_GEN_MAXIMUM_TOTAL_SIZE,
  550. OID_GEN_MEDIA_CONNECT_STATUS,
  551. OID_GEN_PHYSICAL_MEDIUM,
  552. /* the statistical stuff */
  553. OID_GEN_XMIT_OK,
  554. OID_GEN_RCV_OK,
  555. OID_GEN_XMIT_ERROR,
  556. OID_GEN_RCV_ERROR,
  557. OID_GEN_RCV_NO_BUFFER,
  558. /* IEEE 802.3 */
  559. /* the general stuff */
  560. OID_802_3_PERMANENT_ADDRESS,
  561. OID_802_3_CURRENT_ADDRESS,
  562. OID_802_3_MULTICAST_LIST,
  563. OID_802_3_MAC_OPTIONS,
  564. OID_802_3_MAXIMUM_LIST_SIZE,
  565. /* the statistical stuff */
  566. OID_802_3_RCV_ERROR_ALIGNMENT,
  567. OID_802_3_XMIT_ONE_COLLISION,
  568. OID_802_3_XMIT_MORE_COLLISIONS,
  569. };
  570. #define NDIS_MAC_OPTION_COPY_LOOKAHEAD_DATA (1 << 0)
  571. #define NDIS_MAC_OPTION_RECEIVE_SERIALIZED (1 << 1)
  572. #define NDIS_MAC_OPTION_TRANSFERS_NOT_PEND (1 << 2)
  573. #define NDIS_MAC_OPTION_NO_LOOPBACK (1 << 3)
  574. #define NDIS_MAC_OPTION_FULL_DUPLEX (1 << 4)
  575. #define NDIS_MAC_OPTION_EOTX_INDICATION (1 << 5)
  576. #define NDIS_MAC_OPTION_8021P_PRIORITY (1 << 6)
  577. struct rndis_response {
  578. QTAILQ_ENTRY(rndis_response) entries;
  579. uint32_t length;
  580. uint8_t buf[];
  581. };
  582. struct USBNetState {
  583. USBDevice dev;
  584. enum rndis_state rndis_state;
  585. uint32_t medium;
  586. uint32_t speed;
  587. uint32_t media_state;
  588. uint16_t filter;
  589. uint32_t vendorid;
  590. unsigned int out_ptr;
  591. uint8_t out_buf[2048];
  592. unsigned int in_ptr, in_len;
  593. uint8_t in_buf[2048];
  594. USBEndpoint *intr;
  595. char usbstring_mac[13];
  596. NICState *nic;
  597. NICConf conf;
  598. QTAILQ_HEAD(, rndis_response) rndis_resp;
  599. };
  600. #define TYPE_USB_NET "usb-net"
  601. OBJECT_DECLARE_SIMPLE_TYPE(USBNetState, USB_NET)
  602. static int is_rndis(USBNetState *s)
  603. {
  604. return s->dev.config ?
  605. s->dev.config->bConfigurationValue == DEV_RNDIS_CONFIG_VALUE : 0;
  606. }
  607. static int ndis_query(USBNetState *s, uint32_t oid,
  608. uint8_t *inbuf, unsigned int inlen, uint8_t *outbuf,
  609. size_t outlen)
  610. {
  611. unsigned int i;
  612. switch (oid) {
  613. /* general oids (table 4-1) */
  614. /* mandatory */
  615. case OID_GEN_SUPPORTED_LIST:
  616. for (i = 0; i < ARRAY_SIZE(oid_supported_list); i++) {
  617. stl_le_p(outbuf + (i * sizeof(le32)), oid_supported_list[i]);
  618. }
  619. return sizeof(oid_supported_list);
  620. /* mandatory */
  621. case OID_GEN_HARDWARE_STATUS:
  622. stl_le_p(outbuf, 0);
  623. return sizeof(le32);
  624. /* mandatory */
  625. case OID_GEN_MEDIA_SUPPORTED:
  626. stl_le_p(outbuf, s->medium);
  627. return sizeof(le32);
  628. /* mandatory */
  629. case OID_GEN_MEDIA_IN_USE:
  630. stl_le_p(outbuf, s->medium);
  631. return sizeof(le32);
  632. /* mandatory */
  633. case OID_GEN_MAXIMUM_FRAME_SIZE:
  634. stl_le_p(outbuf, ETH_FRAME_LEN);
  635. return sizeof(le32);
  636. /* mandatory */
  637. case OID_GEN_LINK_SPEED:
  638. stl_le_p(outbuf, s->speed);
  639. return sizeof(le32);
  640. /* mandatory */
  641. case OID_GEN_TRANSMIT_BLOCK_SIZE:
  642. stl_le_p(outbuf, ETH_FRAME_LEN);
  643. return sizeof(le32);
  644. /* mandatory */
  645. case OID_GEN_RECEIVE_BLOCK_SIZE:
  646. stl_le_p(outbuf, ETH_FRAME_LEN);
  647. return sizeof(le32);
  648. /* mandatory */
  649. case OID_GEN_VENDOR_ID:
  650. stl_le_p(outbuf, s->vendorid);
  651. return sizeof(le32);
  652. /* mandatory */
  653. case OID_GEN_VENDOR_DESCRIPTION:
  654. pstrcpy((char *)outbuf, outlen, "QEMU USB RNDIS Net");
  655. return strlen((char *)outbuf) + 1;
  656. case OID_GEN_VENDOR_DRIVER_VERSION:
  657. stl_le_p(outbuf, 1);
  658. return sizeof(le32);
  659. /* mandatory */
  660. case OID_GEN_CURRENT_PACKET_FILTER:
  661. stl_le_p(outbuf, s->filter);
  662. return sizeof(le32);
  663. /* mandatory */
  664. case OID_GEN_MAXIMUM_TOTAL_SIZE:
  665. stl_le_p(outbuf, RNDIS_MAX_TOTAL_SIZE);
  666. return sizeof(le32);
  667. /* mandatory */
  668. case OID_GEN_MEDIA_CONNECT_STATUS:
  669. stl_le_p(outbuf, s->media_state);
  670. return sizeof(le32);
  671. case OID_GEN_PHYSICAL_MEDIUM:
  672. stl_le_p(outbuf, 0);
  673. return sizeof(le32);
  674. case OID_GEN_MAC_OPTIONS:
  675. stl_le_p(outbuf, NDIS_MAC_OPTION_RECEIVE_SERIALIZED |
  676. NDIS_MAC_OPTION_FULL_DUPLEX);
  677. return sizeof(le32);
  678. /* statistics OIDs (table 4-2) */
  679. /* mandatory */
  680. case OID_GEN_XMIT_OK:
  681. stl_le_p(outbuf, 0);
  682. return sizeof(le32);
  683. /* mandatory */
  684. case OID_GEN_RCV_OK:
  685. stl_le_p(outbuf, 0);
  686. return sizeof(le32);
  687. /* mandatory */
  688. case OID_GEN_XMIT_ERROR:
  689. stl_le_p(outbuf, 0);
  690. return sizeof(le32);
  691. /* mandatory */
  692. case OID_GEN_RCV_ERROR:
  693. stl_le_p(outbuf, 0);
  694. return sizeof(le32);
  695. /* mandatory */
  696. case OID_GEN_RCV_NO_BUFFER:
  697. stl_le_p(outbuf, 0);
  698. return sizeof(le32);
  699. /* ieee802.3 OIDs (table 4-3) */
  700. /* mandatory */
  701. case OID_802_3_PERMANENT_ADDRESS:
  702. memcpy(outbuf, s->conf.macaddr.a, 6);
  703. return 6;
  704. /* mandatory */
  705. case OID_802_3_CURRENT_ADDRESS:
  706. memcpy(outbuf, s->conf.macaddr.a, 6);
  707. return 6;
  708. /* mandatory */
  709. case OID_802_3_MULTICAST_LIST:
  710. stl_le_p(outbuf, 0xe0000000);
  711. return sizeof(le32);
  712. /* mandatory */
  713. case OID_802_3_MAXIMUM_LIST_SIZE:
  714. stl_le_p(outbuf, 1);
  715. return sizeof(le32);
  716. case OID_802_3_MAC_OPTIONS:
  717. return 0;
  718. /* ieee802.3 statistics OIDs (table 4-4) */
  719. /* mandatory */
  720. case OID_802_3_RCV_ERROR_ALIGNMENT:
  721. stl_le_p(outbuf, 0);
  722. return sizeof(le32);
  723. /* mandatory */
  724. case OID_802_3_XMIT_ONE_COLLISION:
  725. stl_le_p(outbuf, 0);
  726. return sizeof(le32);
  727. /* mandatory */
  728. case OID_802_3_XMIT_MORE_COLLISIONS:
  729. stl_le_p(outbuf, 0);
  730. return sizeof(le32);
  731. default:
  732. fprintf(stderr, "usbnet: unknown OID 0x%08x\n", oid);
  733. return 0;
  734. }
  735. return -1;
  736. }
  737. static int ndis_set(USBNetState *s, uint32_t oid,
  738. uint8_t *inbuf, unsigned int inlen)
  739. {
  740. switch (oid) {
  741. case OID_GEN_CURRENT_PACKET_FILTER:
  742. s->filter = ldl_le_p(inbuf);
  743. if (s->filter) {
  744. s->rndis_state = RNDIS_DATA_INITIALIZED;
  745. } else {
  746. s->rndis_state = RNDIS_INITIALIZED;
  747. }
  748. return 0;
  749. case OID_802_3_MULTICAST_LIST:
  750. return 0;
  751. }
  752. return -1;
  753. }
  754. static int rndis_get_response(USBNetState *s, uint8_t *buf)
  755. {
  756. int ret = 0;
  757. struct rndis_response *r = s->rndis_resp.tqh_first;
  758. if (!r)
  759. return ret;
  760. QTAILQ_REMOVE(&s->rndis_resp, r, entries);
  761. ret = r->length;
  762. memcpy(buf, r->buf, r->length);
  763. g_free(r);
  764. return ret;
  765. }
  766. static void *rndis_queue_response(USBNetState *s, unsigned int length)
  767. {
  768. struct rndis_response *r =
  769. g_malloc0(sizeof(struct rndis_response) + length);
  770. if (QTAILQ_EMPTY(&s->rndis_resp)) {
  771. usb_wakeup(s->intr, 0);
  772. }
  773. QTAILQ_INSERT_TAIL(&s->rndis_resp, r, entries);
  774. r->length = length;
  775. return &r->buf[0];
  776. }
  777. static void rndis_clear_responsequeue(USBNetState *s)
  778. {
  779. struct rndis_response *r;
  780. while ((r = s->rndis_resp.tqh_first)) {
  781. QTAILQ_REMOVE(&s->rndis_resp, r, entries);
  782. g_free(r);
  783. }
  784. }
  785. static int rndis_init_response(USBNetState *s, rndis_init_msg_type *buf)
  786. {
  787. rndis_init_cmplt_type *resp =
  788. rndis_queue_response(s, sizeof(rndis_init_cmplt_type));
  789. if (!resp)
  790. return USB_RET_STALL;
  791. resp->MessageType = cpu_to_le32(RNDIS_INITIALIZE_CMPLT);
  792. resp->MessageLength = cpu_to_le32(sizeof(rndis_init_cmplt_type));
  793. resp->RequestID = buf->RequestID; /* Still LE in msg buffer */
  794. resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS);
  795. resp->MajorVersion = cpu_to_le32(RNDIS_MAJOR_VERSION);
  796. resp->MinorVersion = cpu_to_le32(RNDIS_MINOR_VERSION);
  797. resp->DeviceFlags = cpu_to_le32(RNDIS_DF_CONNECTIONLESS);
  798. resp->Medium = cpu_to_le32(RNDIS_MEDIUM_802_3);
  799. resp->MaxPacketsPerTransfer = cpu_to_le32(1);
  800. resp->MaxTransferSize = cpu_to_le32(ETH_FRAME_LEN +
  801. sizeof(struct rndis_packet_msg_type) + 22);
  802. resp->PacketAlignmentFactor = cpu_to_le32(0);
  803. resp->AFListOffset = cpu_to_le32(0);
  804. resp->AFListSize = cpu_to_le32(0);
  805. return 0;
  806. }
  807. static int rndis_query_response(USBNetState *s,
  808. rndis_query_msg_type *buf, unsigned int length)
  809. {
  810. rndis_query_cmplt_type *resp;
  811. /* oid_supported_list is the largest data reply */
  812. uint8_t infobuf[sizeof(oid_supported_list)];
  813. uint32_t bufoffs, buflen;
  814. int infobuflen;
  815. unsigned int resplen;
  816. bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8;
  817. buflen = le32_to_cpu(buf->InformationBufferLength);
  818. if (buflen > length || bufoffs >= length || bufoffs + buflen > length) {
  819. return USB_RET_STALL;
  820. }
  821. infobuflen = ndis_query(s, le32_to_cpu(buf->OID),
  822. bufoffs + (uint8_t *) buf, buflen, infobuf,
  823. sizeof(infobuf));
  824. resplen = sizeof(rndis_query_cmplt_type) +
  825. ((infobuflen < 0) ? 0 : infobuflen);
  826. resp = rndis_queue_response(s, resplen);
  827. if (!resp)
  828. return USB_RET_STALL;
  829. resp->MessageType = cpu_to_le32(RNDIS_QUERY_CMPLT);
  830. resp->RequestID = buf->RequestID; /* Still LE in msg buffer */
  831. resp->MessageLength = cpu_to_le32(resplen);
  832. if (infobuflen < 0) {
  833. /* OID not supported */
  834. resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED);
  835. resp->InformationBufferLength = cpu_to_le32(0);
  836. resp->InformationBufferOffset = cpu_to_le32(0);
  837. return 0;
  838. }
  839. resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS);
  840. resp->InformationBufferOffset =
  841. cpu_to_le32(infobuflen ? sizeof(rndis_query_cmplt_type) - 8 : 0);
  842. resp->InformationBufferLength = cpu_to_le32(infobuflen);
  843. memcpy(resp + 1, infobuf, infobuflen);
  844. return 0;
  845. }
  846. static int rndis_set_response(USBNetState *s,
  847. rndis_set_msg_type *buf, unsigned int length)
  848. {
  849. rndis_set_cmplt_type *resp =
  850. rndis_queue_response(s, sizeof(rndis_set_cmplt_type));
  851. uint32_t bufoffs, buflen;
  852. int ret;
  853. if (!resp)
  854. return USB_RET_STALL;
  855. bufoffs = le32_to_cpu(buf->InformationBufferOffset) + 8;
  856. buflen = le32_to_cpu(buf->InformationBufferLength);
  857. if (buflen > length || bufoffs >= length || bufoffs + buflen > length) {
  858. return USB_RET_STALL;
  859. }
  860. ret = ndis_set(s, le32_to_cpu(buf->OID),
  861. bufoffs + (uint8_t *) buf, buflen);
  862. resp->MessageType = cpu_to_le32(RNDIS_SET_CMPLT);
  863. resp->RequestID = buf->RequestID; /* Still LE in msg buffer */
  864. resp->MessageLength = cpu_to_le32(sizeof(rndis_set_cmplt_type));
  865. if (ret < 0) {
  866. /* OID not supported */
  867. resp->Status = cpu_to_le32(RNDIS_STATUS_NOT_SUPPORTED);
  868. return 0;
  869. }
  870. resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS);
  871. return 0;
  872. }
  873. static int rndis_reset_response(USBNetState *s, rndis_reset_msg_type *buf)
  874. {
  875. rndis_reset_cmplt_type *resp =
  876. rndis_queue_response(s, sizeof(rndis_reset_cmplt_type));
  877. if (!resp)
  878. return USB_RET_STALL;
  879. resp->MessageType = cpu_to_le32(RNDIS_RESET_CMPLT);
  880. resp->MessageLength = cpu_to_le32(sizeof(rndis_reset_cmplt_type));
  881. resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS);
  882. resp->AddressingReset = cpu_to_le32(1); /* reset information */
  883. return 0;
  884. }
  885. static int rndis_keepalive_response(USBNetState *s,
  886. rndis_keepalive_msg_type *buf)
  887. {
  888. rndis_keepalive_cmplt_type *resp =
  889. rndis_queue_response(s, sizeof(rndis_keepalive_cmplt_type));
  890. if (!resp)
  891. return USB_RET_STALL;
  892. resp->MessageType = cpu_to_le32(RNDIS_KEEPALIVE_CMPLT);
  893. resp->MessageLength = cpu_to_le32(sizeof(rndis_keepalive_cmplt_type));
  894. resp->RequestID = buf->RequestID; /* Still LE in msg buffer */
  895. resp->Status = cpu_to_le32(RNDIS_STATUS_SUCCESS);
  896. return 0;
  897. }
  898. /* Prepare to receive the next packet */
  899. static void usb_net_reset_in_buf(USBNetState *s)
  900. {
  901. s->in_ptr = s->in_len = 0;
  902. qemu_flush_queued_packets(qemu_get_queue(s->nic));
  903. }
  904. static int rndis_parse(USBNetState *s, uint8_t *data, int length)
  905. {
  906. uint32_t msg_type = ldl_le_p(data);
  907. switch (msg_type) {
  908. case RNDIS_INITIALIZE_MSG:
  909. s->rndis_state = RNDIS_INITIALIZED;
  910. return rndis_init_response(s, (rndis_init_msg_type *) data);
  911. case RNDIS_HALT_MSG:
  912. s->rndis_state = RNDIS_UNINITIALIZED;
  913. return 0;
  914. case RNDIS_QUERY_MSG:
  915. return rndis_query_response(s, (rndis_query_msg_type *) data, length);
  916. case RNDIS_SET_MSG:
  917. return rndis_set_response(s, (rndis_set_msg_type *) data, length);
  918. case RNDIS_RESET_MSG:
  919. rndis_clear_responsequeue(s);
  920. s->out_ptr = 0;
  921. usb_net_reset_in_buf(s);
  922. return rndis_reset_response(s, (rndis_reset_msg_type *) data);
  923. case RNDIS_KEEPALIVE_MSG:
  924. /* For USB: host does this every 5 seconds */
  925. return rndis_keepalive_response(s, (rndis_keepalive_msg_type *) data);
  926. }
  927. return USB_RET_STALL;
  928. }
  929. static void usb_net_handle_reset(USBDevice *dev)
  930. {
  931. }
  932. static void usb_net_handle_control(USBDevice *dev, USBPacket *p,
  933. int request, int value, int index, int length, uint8_t *data)
  934. {
  935. USBNetState *s = (USBNetState *) dev;
  936. int ret;
  937. ret = usb_desc_handle_control(dev, p, request, value, index, length, data);
  938. if (ret >= 0) {
  939. return;
  940. }
  941. switch(request) {
  942. case ClassInterfaceOutRequest | USB_CDC_SEND_ENCAPSULATED_COMMAND:
  943. if (!is_rndis(s) || value || index != 0) {
  944. goto fail;
  945. }
  946. #ifdef TRAFFIC_DEBUG
  947. {
  948. unsigned int i;
  949. fprintf(stderr, "SEND_ENCAPSULATED_COMMAND:");
  950. for (i = 0; i < length; i++) {
  951. if (!(i & 15))
  952. fprintf(stderr, "\n%04x:", i);
  953. fprintf(stderr, " %02x", data[i]);
  954. }
  955. fprintf(stderr, "\n\n");
  956. }
  957. #endif
  958. ret = rndis_parse(s, data, length);
  959. if (ret < 0) {
  960. p->status = ret;
  961. }
  962. break;
  963. case ClassInterfaceRequest | USB_CDC_GET_ENCAPSULATED_RESPONSE:
  964. if (!is_rndis(s) || value || index != 0) {
  965. goto fail;
  966. }
  967. p->actual_length = rndis_get_response(s, data);
  968. if (p->actual_length == 0) {
  969. data[0] = 0;
  970. p->actual_length = 1;
  971. }
  972. #ifdef TRAFFIC_DEBUG
  973. {
  974. unsigned int i;
  975. fprintf(stderr, "GET_ENCAPSULATED_RESPONSE:");
  976. for (i = 0; i < p->actual_length; i++) {
  977. if (!(i & 15))
  978. fprintf(stderr, "\n%04x:", i);
  979. fprintf(stderr, " %02x", data[i]);
  980. }
  981. fprintf(stderr, "\n\n");
  982. }
  983. #endif
  984. break;
  985. default:
  986. fail:
  987. fprintf(stderr, "usbnet: failed control transaction: "
  988. "request 0x%x value 0x%x index 0x%x length 0x%x\n",
  989. request, value, index, length);
  990. p->status = USB_RET_STALL;
  991. break;
  992. }
  993. }
  994. static void usb_net_handle_statusin(USBNetState *s, USBPacket *p)
  995. {
  996. le32 buf[2];
  997. if (p->iov.size < 8) {
  998. p->status = USB_RET_STALL;
  999. return;
  1000. }
  1001. buf[0] = cpu_to_le32(1);
  1002. buf[1] = cpu_to_le32(0);
  1003. usb_packet_copy(p, buf, 8);
  1004. if (!s->rndis_resp.tqh_first) {
  1005. p->status = USB_RET_NAK;
  1006. }
  1007. #ifdef TRAFFIC_DEBUG
  1008. fprintf(stderr, "usbnet: interrupt poll len %zu return %d",
  1009. p->iov.size, p->status);
  1010. iov_hexdump(p->iov.iov, p->iov.niov, stderr, "usbnet", p->status);
  1011. #endif
  1012. }
  1013. static void usb_net_handle_datain(USBNetState *s, USBPacket *p)
  1014. {
  1015. int len;
  1016. if (s->in_ptr > s->in_len) {
  1017. usb_net_reset_in_buf(s);
  1018. p->status = USB_RET_NAK;
  1019. return;
  1020. }
  1021. if (!s->in_len) {
  1022. p->status = USB_RET_NAK;
  1023. return;
  1024. }
  1025. len = s->in_len - s->in_ptr;
  1026. if (len > p->iov.size) {
  1027. len = p->iov.size;
  1028. }
  1029. usb_packet_copy(p, &s->in_buf[s->in_ptr], len);
  1030. s->in_ptr += len;
  1031. if (s->in_ptr >= s->in_len &&
  1032. (is_rndis(s) || (s->in_len & (64 - 1)) || !len)) {
  1033. /* no short packet necessary */
  1034. usb_net_reset_in_buf(s);
  1035. }
  1036. #ifdef TRAFFIC_DEBUG
  1037. fprintf(stderr, "usbnet: data in len %zu return %d", p->iov.size, len);
  1038. iov_hexdump(p->iov.iov, p->iov.niov, stderr, "usbnet", len);
  1039. #endif
  1040. }
  1041. static void usb_net_handle_dataout(USBNetState *s, USBPacket *p)
  1042. {
  1043. int sz = sizeof(s->out_buf) - s->out_ptr;
  1044. struct rndis_packet_msg_type *msg =
  1045. (struct rndis_packet_msg_type *) s->out_buf;
  1046. uint32_t len;
  1047. #ifdef TRAFFIC_DEBUG
  1048. fprintf(stderr, "usbnet: data out len %zu\n", p->iov.size);
  1049. iov_hexdump(p->iov.iov, p->iov.niov, stderr, "usbnet", p->iov.size);
  1050. #endif
  1051. if (sz > p->iov.size) {
  1052. sz = p->iov.size;
  1053. }
  1054. usb_packet_copy(p, &s->out_buf[s->out_ptr], sz);
  1055. s->out_ptr += sz;
  1056. if (!is_rndis(s)) {
  1057. if (p->iov.size < 64) {
  1058. qemu_send_packet(qemu_get_queue(s->nic), s->out_buf, s->out_ptr);
  1059. s->out_ptr = 0;
  1060. }
  1061. return;
  1062. }
  1063. len = le32_to_cpu(msg->MessageLength);
  1064. if (s->out_ptr < 8 || s->out_ptr < len) {
  1065. return;
  1066. }
  1067. if (le32_to_cpu(msg->MessageType) == RNDIS_PACKET_MSG) {
  1068. uint32_t offs = 8 + le32_to_cpu(msg->DataOffset);
  1069. uint32_t size = le32_to_cpu(msg->DataLength);
  1070. if (offs < len && size < len && offs + size <= len) {
  1071. qemu_send_packet(qemu_get_queue(s->nic), s->out_buf + offs, size);
  1072. }
  1073. }
  1074. s->out_ptr -= len;
  1075. memmove(s->out_buf, &s->out_buf[len], s->out_ptr);
  1076. }
  1077. static void usb_net_handle_data(USBDevice *dev, USBPacket *p)
  1078. {
  1079. USBNetState *s = (USBNetState *) dev;
  1080. switch(p->pid) {
  1081. case USB_TOKEN_IN:
  1082. switch (p->ep->nr) {
  1083. case 1:
  1084. usb_net_handle_statusin(s, p);
  1085. break;
  1086. case 2:
  1087. usb_net_handle_datain(s, p);
  1088. break;
  1089. default:
  1090. goto fail;
  1091. }
  1092. break;
  1093. case USB_TOKEN_OUT:
  1094. switch (p->ep->nr) {
  1095. case 2:
  1096. usb_net_handle_dataout(s, p);
  1097. break;
  1098. default:
  1099. goto fail;
  1100. }
  1101. break;
  1102. default:
  1103. fail:
  1104. p->status = USB_RET_STALL;
  1105. break;
  1106. }
  1107. if (p->status == USB_RET_STALL) {
  1108. fprintf(stderr, "usbnet: failed data transaction: "
  1109. "pid 0x%x ep 0x%x len 0x%zx\n",
  1110. p->pid, p->ep->nr, p->iov.size);
  1111. }
  1112. }
  1113. static ssize_t usbnet_receive(NetClientState *nc, const uint8_t *buf, size_t size)
  1114. {
  1115. USBNetState *s = qemu_get_nic_opaque(nc);
  1116. uint8_t *in_buf = s->in_buf;
  1117. size_t total_size = size;
  1118. if (!s->dev.config) {
  1119. return -1;
  1120. }
  1121. if (is_rndis(s)) {
  1122. if (s->rndis_state != RNDIS_DATA_INITIALIZED) {
  1123. return -1;
  1124. }
  1125. total_size += sizeof(struct rndis_packet_msg_type);
  1126. }
  1127. if (total_size > sizeof(s->in_buf)) {
  1128. return -1;
  1129. }
  1130. /* Only accept packet if input buffer is empty */
  1131. if (s->in_len > 0) {
  1132. return 0;
  1133. }
  1134. if (is_rndis(s)) {
  1135. struct rndis_packet_msg_type *msg;
  1136. msg = (struct rndis_packet_msg_type *)in_buf;
  1137. memset(msg, 0, sizeof(struct rndis_packet_msg_type));
  1138. msg->MessageType = cpu_to_le32(RNDIS_PACKET_MSG);
  1139. msg->MessageLength = cpu_to_le32(size + sizeof(*msg));
  1140. msg->DataOffset = cpu_to_le32(sizeof(*msg) - 8);
  1141. msg->DataLength = cpu_to_le32(size);
  1142. /* msg->OOBDataOffset;
  1143. * msg->OOBDataLength;
  1144. * msg->NumOOBDataElements;
  1145. * msg->PerPacketInfoOffset;
  1146. * msg->PerPacketInfoLength;
  1147. * msg->VcHandle;
  1148. * msg->Reserved;
  1149. */
  1150. in_buf += sizeof(*msg);
  1151. }
  1152. memcpy(in_buf, buf, size);
  1153. s->in_len = total_size;
  1154. s->in_ptr = 0;
  1155. return size;
  1156. }
  1157. static void usbnet_cleanup(NetClientState *nc)
  1158. {
  1159. USBNetState *s = qemu_get_nic_opaque(nc);
  1160. s->nic = NULL;
  1161. }
  1162. static void usb_net_unrealize(USBDevice *dev)
  1163. {
  1164. USBNetState *s = (USBNetState *) dev;
  1165. /* TODO: remove the nd_table[] entry */
  1166. rndis_clear_responsequeue(s);
  1167. qemu_del_nic(s->nic);
  1168. }
  1169. static NetClientInfo net_usbnet_info = {
  1170. .type = NET_CLIENT_DRIVER_NIC,
  1171. .size = sizeof(NICState),
  1172. .receive = usbnet_receive,
  1173. .cleanup = usbnet_cleanup,
  1174. };
  1175. static void usb_net_realize(USBDevice *dev, Error **errp)
  1176. {
  1177. USBNetState *s = USB_NET(dev);
  1178. usb_desc_create_serial(dev);
  1179. usb_desc_init(dev);
  1180. s->rndis_state = RNDIS_UNINITIALIZED;
  1181. QTAILQ_INIT(&s->rndis_resp);
  1182. s->medium = 0; /* NDIS_MEDIUM_802_3 */
  1183. s->speed = 1000000; /* 100MBps, in 100Bps units */
  1184. s->media_state = 0; /* NDIS_MEDIA_STATE_CONNECTED */;
  1185. s->filter = 0;
  1186. s->vendorid = 0x1234;
  1187. s->intr = usb_ep_get(dev, USB_TOKEN_IN, 1);
  1188. qemu_macaddr_default_if_unset(&s->conf.macaddr);
  1189. s->nic = qemu_new_nic(&net_usbnet_info, &s->conf,
  1190. object_get_typename(OBJECT(s)), s->dev.qdev.id, s);
  1191. qemu_format_nic_info_str(qemu_get_queue(s->nic), s->conf.macaddr.a);
  1192. snprintf(s->usbstring_mac, sizeof(s->usbstring_mac),
  1193. "%02x%02x%02x%02x%02x%02x",
  1194. 0x40,
  1195. s->conf.macaddr.a[1],
  1196. s->conf.macaddr.a[2],
  1197. s->conf.macaddr.a[3],
  1198. s->conf.macaddr.a[4],
  1199. s->conf.macaddr.a[5]);
  1200. usb_desc_set_string(dev, STRING_ETHADDR, s->usbstring_mac);
  1201. }
  1202. static void usb_net_instance_init(Object *obj)
  1203. {
  1204. USBDevice *dev = USB_DEVICE(obj);
  1205. USBNetState *s = USB_NET(dev);
  1206. device_add_bootindex_property(obj, &s->conf.bootindex,
  1207. "bootindex", "/ethernet-phy@0",
  1208. &dev->qdev);
  1209. }
  1210. static const VMStateDescription vmstate_usb_net = {
  1211. .name = "usb-net",
  1212. .unmigratable = 1,
  1213. };
  1214. static Property net_properties[] = {
  1215. DEFINE_NIC_PROPERTIES(USBNetState, conf),
  1216. DEFINE_PROP_END_OF_LIST(),
  1217. };
  1218. static void usb_net_class_initfn(ObjectClass *klass, void *data)
  1219. {
  1220. DeviceClass *dc = DEVICE_CLASS(klass);
  1221. USBDeviceClass *uc = USB_DEVICE_CLASS(klass);
  1222. uc->realize = usb_net_realize;
  1223. uc->product_desc = "QEMU USB Network Interface";
  1224. uc->usb_desc = &desc_net;
  1225. uc->handle_reset = usb_net_handle_reset;
  1226. uc->handle_control = usb_net_handle_control;
  1227. uc->handle_data = usb_net_handle_data;
  1228. uc->unrealize = usb_net_unrealize;
  1229. set_bit(DEVICE_CATEGORY_NETWORK, dc->categories);
  1230. dc->fw_name = "network";
  1231. dc->vmsd = &vmstate_usb_net;
  1232. device_class_set_props(dc, net_properties);
  1233. }
  1234. static const TypeInfo net_info = {
  1235. .name = TYPE_USB_NET,
  1236. .parent = TYPE_USB_DEVICE,
  1237. .instance_size = sizeof(USBNetState),
  1238. .class_init = usb_net_class_initfn,
  1239. .instance_init = usb_net_instance_init,
  1240. };
  1241. static void usb_net_register_types(void)
  1242. {
  1243. type_register_static(&net_info);
  1244. }
  1245. type_init(usb_net_register_types)