rndis.c 41 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2012-12-24 heyuanjie87 first version
  9. * 2013-04-13 aozima update ethernet driver.
  10. * 2013-04-26 aozima align the desc to 4byte.
  11. * 2013-05-08 aozima pad a dummy when send MAX_PKT_SIZE.
  12. * 2013-05-09 aozima add delay linkup feature.
  13. * 2013-07-09 aozima support respone chain list.
  14. * 2013-07-18 aozima re-initial respone chain list when RNDIS restart.
  15. * 2017-11-25 ZYH fix it and add OS descriptor
  16. * 2019-06-10 ZYH fix hot plug and delay linkup
  17. */
  18. #include <rtdevice.h>
  19. #ifdef RT_USB_DEVICE_RNDIS
  20. #include "cdc.h"
  21. #include "rndis.h"
  22. #include "ndis.h"
  23. /* define RNDIS_DELAY_LINK_UP by menuconfig for delay linkup */
  24. #define DBG_LEVEL DBG_WARNING
  25. #define DBG_SECTION_NAME "RNDIS"
  26. #include <rtdbg.h>
  27. #define RNDIS_INTF_STR_INDEX 12
  28. /* RT-Thread LWIP ethernet interface */
  29. #include <netif/ethernetif.h>
  30. struct rt_rndis_response
  31. {
  32. struct rt_list_node list;
  33. const void * buffer;
  34. };
  35. #define MAX_ADDR_LEN 6
  36. struct rt_rndis_eth
  37. {
  38. /* inherit from ethernet device */
  39. struct eth_device parent;
  40. struct ufunction *func;
  41. /* interface address info */
  42. rt_uint8_t host_addr[MAX_ADDR_LEN];
  43. rt_uint8_t dev_addr[MAX_ADDR_LEN];
  44. #ifdef RNDIS_DELAY_LINK_UP
  45. struct rt_timer timer;
  46. #endif /* RNDIS_DELAY_LINK_UP */
  47. ALIGN(4)
  48. rt_uint8_t rx_pool[512];
  49. ALIGN(4)
  50. rt_uint8_t tx_pool[512];
  51. rt_uint32_t cmd_pool[2];
  52. ALIGN(4)
  53. char rx_buffer[sizeof(struct rndis_packet_msg) + USB_ETH_MTU + 14];
  54. rt_size_t rx_offset;
  55. rt_size_t rx_length;
  56. rt_bool_t rx_flag;
  57. rt_bool_t rx_frist;
  58. ALIGN(4)
  59. char tx_buffer[sizeof(struct rndis_packet_msg) + USB_ETH_MTU + 14];
  60. struct rt_semaphore tx_buffer_free;
  61. struct rt_list_node response_list;
  62. rt_bool_t need_notify;
  63. struct cdc_eps eps;
  64. };
  65. typedef struct rt_rndis_eth * rt_rndis_eth_t;
  66. static rt_uint32_t oid_packet_filter = 0x0000000;
  67. ALIGN(4)
  68. static struct udevice_descriptor _dev_desc =
  69. {
  70. USB_DESC_LENGTH_DEVICE, /* bLength */
  71. USB_DESC_TYPE_DEVICE, /* type */
  72. USB_BCD_VERSION, /* bcdUSB */
  73. 0xEF, /* bDeviceClass */
  74. 0x04, /* bDeviceSubClass */
  75. 0x01, /* bDeviceProtocol */
  76. USB_CDC_BUFSIZE, /* bMaxPacketSize0 */
  77. _VENDOR_ID, /* idVendor */
  78. _PRODUCT_ID, /* idProduct */
  79. USB_BCD_DEVICE, /* bcdDevice */
  80. USB_STRING_MANU_INDEX, /* iManufacturer */
  81. USB_STRING_PRODUCT_INDEX, /* iProduct */
  82. USB_STRING_SERIAL_INDEX, /* iSerialNumber */
  83. USB_DYNAMIC /* bNumConfigurations */
  84. };
  85. /* communcation interface descriptor */
  86. ALIGN(4)
  87. const static struct ucdc_comm_descriptor _comm_desc =
  88. {
  89. #ifdef RT_USB_DEVICE_COMPOSITE
  90. /* Interface Association Descriptor */
  91. {
  92. USB_DESC_LENGTH_IAD,
  93. USB_DESC_TYPE_IAD,
  94. USB_DYNAMIC,
  95. 0x02,
  96. USB_CDC_CLASS_COMM,
  97. USB_CDC_SUBCLASS_ACM,
  98. USB_CDC_PROTOCOL_VENDOR,
  99. 0x00,
  100. },
  101. #endif
  102. /* Interface Descriptor */
  103. {
  104. USB_DESC_LENGTH_INTERFACE,
  105. USB_DESC_TYPE_INTERFACE,
  106. USB_DYNAMIC,
  107. 0x00,
  108. 0x01,
  109. USB_CDC_CLASS_COMM,
  110. USB_CDC_SUBCLASS_ACM,
  111. USB_CDC_PROTOCOL_VENDOR,
  112. #ifdef RT_USB_DEVICE_COMPOSITE
  113. RNDIS_INTF_STR_INDEX,
  114. #else
  115. 0x00,
  116. #endif
  117. },
  118. /* Header Functional Descriptor */
  119. {
  120. 0x05,
  121. USB_CDC_CS_INTERFACE,
  122. USB_CDC_SCS_HEADER,
  123. 0x0110,
  124. },
  125. /* Call Management Functional Descriptor */
  126. {
  127. 0x05,
  128. USB_CDC_CS_INTERFACE,
  129. USB_CDC_SCS_CALL_MGMT,
  130. 0x00,
  131. USB_DYNAMIC,
  132. },
  133. /* Abstract Control Management Functional Descriptor */
  134. {
  135. 0x04,
  136. USB_CDC_CS_INTERFACE,
  137. USB_CDC_SCS_ACM,
  138. 0x02,
  139. },
  140. /* Union Functional Descriptor */
  141. {
  142. 0x05,
  143. USB_CDC_CS_INTERFACE,
  144. USB_CDC_SCS_UNION,
  145. USB_DYNAMIC,
  146. USB_DYNAMIC,
  147. },
  148. /* Endpoint Descriptor */
  149. {
  150. USB_DESC_LENGTH_ENDPOINT,
  151. USB_DESC_TYPE_ENDPOINT,
  152. USB_DIR_IN | USB_DYNAMIC,
  153. USB_EP_ATTR_INT,
  154. 0x08,
  155. 0x0A,
  156. },
  157. };
  158. /* data interface descriptor */
  159. ALIGN(4)
  160. const static struct ucdc_data_descriptor _data_desc =
  161. {
  162. /* interface descriptor */
  163. {
  164. USB_DESC_LENGTH_INTERFACE,
  165. USB_DESC_TYPE_INTERFACE,
  166. USB_DYNAMIC,
  167. 0x00,
  168. 0x02,
  169. USB_CDC_CLASS_DATA,
  170. 0x00,
  171. 0x00,
  172. 0x00,
  173. },
  174. /* endpoint, bulk out */
  175. {
  176. USB_DESC_LENGTH_ENDPOINT,
  177. USB_DESC_TYPE_ENDPOINT,
  178. USB_DIR_OUT | USB_DYNAMIC,
  179. USB_EP_ATTR_BULK,
  180. USB_DYNAMIC,
  181. 0x00,
  182. },
  183. /* endpoint, bulk in */
  184. {
  185. USB_DESC_LENGTH_ENDPOINT,
  186. USB_DESC_TYPE_ENDPOINT,
  187. USB_DYNAMIC | USB_DIR_IN,
  188. USB_EP_ATTR_BULK,
  189. USB_DYNAMIC,
  190. 0x00,
  191. },
  192. };
  193. ALIGN(4)
  194. const static char* _ustring[] =
  195. {
  196. "Language", /* LANGID */
  197. "RT-Thread Team.", /* MANU */
  198. "RT-Thread RNDIS device", /* PRODUCT */
  199. "1.1.0", /* SERIAL */
  200. "Configuration", /* CONFIG */
  201. "Interface", /* INTERFACE */
  202. USB_STRING_OS
  203. };
  204. ALIGN(4)
  205. struct usb_os_function_comp_id_descriptor rndis_func_comp_id_desc =
  206. {
  207. .bFirstInterfaceNumber = USB_DYNAMIC,
  208. .reserved1 = 0x01,
  209. .compatibleID = {'R', 'N', 'D', 'I', 'S', 0x00, 0x00, 0x00},
  210. .subCompatibleID = {'5', '1', '6', '2', '0', '0', '1', 0x00},
  211. .reserved2 = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00}
  212. };
  213. //FS and HS needed
  214. ALIGN(4)
  215. static struct usb_qualifier_descriptor dev_qualifier =
  216. {
  217. sizeof(dev_qualifier), //bLength
  218. USB_DESC_TYPE_DEVICEQUALIFIER, //bDescriptorType
  219. 0x0200, //bcdUSB
  220. USB_CLASS_CDC, //bDeviceClass
  221. USB_CDC_SUBCLASS_ACM, //bDeviceSubClass
  222. USB_CDC_PROTOCOL_VENDOR, //bDeviceProtocol
  223. 64, //bMaxPacketSize0
  224. 0x01, //bNumConfigurations
  225. 0,
  226. };
  227. /* supported OIDs */
  228. ALIGN(4)
  229. const static rt_uint32_t oid_supported_list[] =
  230. {
  231. /* General OIDs */
  232. OID_GEN_SUPPORTED_LIST,
  233. OID_GEN_HARDWARE_STATUS,
  234. OID_GEN_MEDIA_SUPPORTED,
  235. OID_GEN_MEDIA_IN_USE,
  236. OID_GEN_MAXIMUM_FRAME_SIZE,
  237. OID_GEN_LINK_SPEED,
  238. OID_GEN_TRANSMIT_BLOCK_SIZE,
  239. OID_GEN_RECEIVE_BLOCK_SIZE,
  240. OID_GEN_VENDOR_ID,
  241. OID_GEN_VENDOR_DESCRIPTION,
  242. OID_GEN_VENDOR_DRIVER_VERSION,
  243. OID_GEN_CURRENT_PACKET_FILTER,
  244. OID_GEN_MAXIMUM_TOTAL_SIZE,
  245. OID_GEN_MEDIA_CONNECT_STATUS,
  246. OID_GEN_PHYSICAL_MEDIUM,
  247. /* General Statistic OIDs */
  248. OID_GEN_XMIT_OK,
  249. OID_GEN_RCV_OK,
  250. OID_GEN_XMIT_ERROR,
  251. OID_GEN_RCV_ERROR,
  252. OID_GEN_RCV_NO_BUFFER,
  253. /* Please configure us */
  254. OID_GEN_RNDIS_CONFIG_PARAMETER,
  255. /* 802.3 OIDs */
  256. OID_802_3_PERMANENT_ADDRESS,
  257. OID_802_3_CURRENT_ADDRESS,
  258. OID_802_3_MULTICAST_LIST,
  259. OID_802_3_MAXIMUM_LIST_SIZE,
  260. /* 802.3 Statistic OIDs */
  261. OID_802_3_RCV_ERROR_ALIGNMENT,
  262. OID_802_3_XMIT_ONE_COLLISION,
  263. OID_802_3_XMIT_MORE_COLLISIONS,
  264. OID_802_3_MAC_OPTIONS,
  265. };
  266. static rt_uint8_t rndis_message_buffer[RNDIS_MESSAGE_BUFFER_SIZE];
  267. static void _rndis_response_available(ufunction_t func)
  268. {
  269. rt_rndis_eth_t device = (rt_rndis_eth_t)func->user_data;
  270. rt_uint32_t * data;
  271. if(device->need_notify == RT_TRUE)
  272. {
  273. device->need_notify = RT_FALSE;
  274. data = (rt_uint32_t *)device->eps.ep_cmd->buffer;
  275. data[0] = RESPONSE_AVAILABLE;
  276. data[1] = 0;
  277. device->eps.ep_cmd->request.buffer = device->eps.ep_cmd->buffer;
  278. device->eps.ep_cmd->request.size = 8;
  279. device->eps.ep_cmd->request.req_type = UIO_REQUEST_WRITE;
  280. rt_usbd_io_request(func->device, device->eps.ep_cmd, &device->eps.ep_cmd->request);
  281. }
  282. }
  283. static rt_err_t _rndis_init_response(ufunction_t func, rndis_init_msg_t msg)
  284. {
  285. rndis_init_cmplt_t resp;
  286. struct rt_rndis_response * response;
  287. response = rt_malloc(sizeof(struct rt_rndis_response));
  288. resp = rt_malloc(sizeof(struct rndis_init_cmplt));
  289. if( (response == RT_NULL) || (resp == RT_NULL) )
  290. {
  291. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  292. if(response != RT_NULL)
  293. rt_free(response);
  294. if(resp != RT_NULL)
  295. rt_free(resp);
  296. return -RT_ENOMEM;
  297. }
  298. resp->RequestId = msg->RequestId;
  299. resp->MessageType = REMOTE_NDIS_INITIALIZE_CMPLT;
  300. resp->MessageLength = sizeof(struct rndis_init_cmplt);
  301. resp->MajorVersion = RNDIS_MAJOR_VERSION;
  302. resp->MinorVersion = RNDIS_MAJOR_VERSION;
  303. resp->Status = RNDIS_STATUS_SUCCESS;
  304. resp->DeviceFlags = RNDIS_DF_CONNECTIONLESS;
  305. resp->Medium = RNDIS_MEDIUM_802_3;
  306. resp->MaxPacketsPerTransfer = 1;
  307. resp->MaxTransferSize = USB_ETH_MTU + 58; /* Space for 1280 IP buffer, Ethernet Header,
  308. RNDIS messages */
  309. resp->PacketAlignmentFactor = 3;
  310. resp->AfListOffset = 0;
  311. resp->AfListSize = 0;
  312. response->buffer = resp;
  313. {
  314. rt_base_t level = rt_hw_interrupt_disable();
  315. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  316. rt_hw_interrupt_enable(level);
  317. }
  318. return RT_EOK;
  319. }
  320. static rndis_query_cmplt_t _create_resp(rt_size_t size)
  321. {
  322. rndis_query_cmplt_t resp;
  323. resp = rt_malloc(sizeof(struct rndis_query_cmplt) + size);
  324. if(resp == RT_NULL)
  325. {
  326. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  327. return RT_NULL;
  328. }
  329. resp->InformationBufferLength = size;
  330. return resp;
  331. }
  332. static void _copy_resp(rndis_query_cmplt_t resp, const void * buffer)
  333. {
  334. char * resp_buffer = (char *)resp + sizeof(struct rndis_query_cmplt);
  335. rt_memcpy(resp_buffer, buffer, resp->InformationBufferLength);
  336. }
  337. static void _set_resp(rndis_query_cmplt_t resp, rt_uint32_t value)
  338. {
  339. rt_uint32_t * response = (rt_uint32_t *)((char *)resp + sizeof(struct rndis_query_cmplt));
  340. *response = value;
  341. }
  342. static rt_err_t _rndis_query_response(ufunction_t func,rndis_query_msg_t msg)
  343. {
  344. rndis_query_cmplt_t resp = RT_NULL;
  345. struct rt_rndis_response * response;
  346. rt_err_t ret = RT_EOK;
  347. switch (msg->Oid)
  348. {
  349. /*
  350. * general OIDs
  351. */
  352. case OID_GEN_SUPPORTED_LIST:
  353. resp = _create_resp(sizeof(oid_supported_list));
  354. if(resp == RT_NULL) break;
  355. _copy_resp(resp, oid_supported_list);
  356. break;
  357. case OID_GEN_PHYSICAL_MEDIUM:
  358. resp = _create_resp(4);
  359. if(resp == RT_NULL) break;
  360. _set_resp(resp, NDIS_MEDIUM_802_3);
  361. break;
  362. case OID_GEN_MAXIMUM_FRAME_SIZE:
  363. case OID_GEN_TRANSMIT_BLOCK_SIZE:
  364. case OID_GEN_RECEIVE_BLOCK_SIZE:
  365. resp = _create_resp(4);
  366. if(resp == RT_NULL) break;
  367. _set_resp(resp, USB_ETH_MTU);
  368. break;
  369. case OID_GEN_MAXIMUM_TOTAL_SIZE:
  370. resp = _create_resp(4);
  371. if(resp == RT_NULL) break;
  372. _set_resp(resp, USB_ETH_MTU + RNDIS_MESSAGE_BUFFER_SIZE);
  373. break;
  374. case OID_GEN_LINK_SPEED:
  375. resp = _create_resp(4);
  376. if(resp == RT_NULL) break;
  377. _set_resp(resp, (func->device->dcd->device_is_hs ? (480UL * 1000 *1000) : (12UL * 1000 * 1000)) / 100);
  378. break;
  379. case OID_GEN_MEDIA_CONNECT_STATUS:
  380. /* link_status */
  381. resp = _create_resp(4);
  382. if(resp == RT_NULL) break;
  383. #ifdef RNDIS_DELAY_LINK_UP
  384. if(((rt_rndis_eth_t)func->user_data)->parent.link_status)
  385. {
  386. _set_resp(resp, NDIS_MEDIA_STATE_CONNECTED);
  387. }
  388. else
  389. {
  390. _set_resp(resp, NDIS_MEDIA_STATE_DISCONNECTED);
  391. }
  392. #else
  393. _set_resp(resp, NDIS_MEDIA_STATE_CONNECTED);
  394. #endif /* RNDIS_DELAY_LINK_UP */
  395. break;
  396. case OID_GEN_VENDOR_ID:
  397. resp = _create_resp(4);
  398. if(resp == RT_NULL) break;
  399. _set_resp(resp, 0x12345678); /* only for test */
  400. break;
  401. case OID_GEN_VENDOR_DESCRIPTION:
  402. {
  403. const char vendor_desc[] = "RT-Thread RNDIS";
  404. resp = _create_resp(sizeof(vendor_desc));
  405. if(resp == RT_NULL) break;
  406. _copy_resp(resp, vendor_desc);
  407. }
  408. break;
  409. case OID_GEN_VENDOR_DRIVER_VERSION:
  410. resp = _create_resp(4);
  411. if(resp == RT_NULL) break;
  412. _set_resp(resp, 0x0000200);
  413. break;
  414. /* statistics OIDs */
  415. case OID_GEN_XMIT_OK:
  416. case OID_GEN_RCV_OK:
  417. resp = _create_resp(4);
  418. if(resp == RT_NULL) break;
  419. _set_resp(resp, 1);
  420. break;
  421. case OID_GEN_XMIT_ERROR:
  422. case OID_GEN_RCV_ERROR:
  423. case OID_GEN_RCV_NO_BUFFER:
  424. resp = _create_resp(4);
  425. if(resp == RT_NULL) break;
  426. _set_resp(resp, 0);
  427. break;
  428. /*
  429. * ieee802.3 OIDs
  430. */
  431. case OID_802_3_MAXIMUM_LIST_SIZE:
  432. resp = _create_resp(4);
  433. if(resp == RT_NULL) break;
  434. _set_resp(resp, 1);
  435. break;
  436. case OID_802_3_PERMANENT_ADDRESS:
  437. case OID_802_3_CURRENT_ADDRESS:
  438. resp = _create_resp(sizeof(((rt_rndis_eth_t)func->user_data)->host_addr));
  439. if(resp == RT_NULL) break;
  440. _copy_resp(resp, ((rt_rndis_eth_t)func->user_data)->host_addr);
  441. break;
  442. case OID_802_3_MULTICAST_LIST:
  443. resp = _create_resp(4);
  444. if(resp == RT_NULL) break;
  445. _set_resp(resp, 0xE000000);
  446. break;
  447. case OID_802_3_MAC_OPTIONS:
  448. resp = _create_resp(4);
  449. if(resp == RT_NULL) break;
  450. _set_resp(resp, 0);
  451. break;
  452. default:
  453. LOG_W("Not support OID %X", msg->Oid);
  454. ret = -RT_ERROR;
  455. break;
  456. }
  457. response = rt_malloc(sizeof(struct rt_rndis_response));
  458. if( (response == RT_NULL) || (resp == RT_NULL) )
  459. {
  460. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  461. if(response != RT_NULL)
  462. rt_free(response);
  463. if(resp != RT_NULL)
  464. rt_free(resp);
  465. return -RT_ENOMEM;
  466. }
  467. resp->RequestId = msg->RequestId;
  468. resp->MessageType = REMOTE_NDIS_QUERY_CMPLT;
  469. resp->InformationBufferOffset = 16;
  470. resp->Status = RNDIS_STATUS_SUCCESS;
  471. resp->MessageLength = sizeof(struct rndis_query_cmplt) + resp->InformationBufferLength;
  472. response->buffer = resp;
  473. {
  474. rt_base_t level = rt_hw_interrupt_disable();
  475. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  476. rt_hw_interrupt_enable(level);
  477. }
  478. return ret;
  479. }
  480. static rt_err_t _rndis_set_response(ufunction_t func,rndis_set_msg_t msg)
  481. {
  482. rndis_set_cmplt_t resp;
  483. struct rt_rndis_response * response;
  484. response = rt_malloc(sizeof(struct rt_rndis_response));
  485. resp = rt_malloc(sizeof(struct rndis_set_cmplt));
  486. if( (response == RT_NULL) || (resp == RT_NULL) )
  487. {
  488. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  489. if(response != RT_NULL)
  490. rt_free(response);
  491. if(resp != RT_NULL)
  492. rt_free(resp);
  493. return -RT_ENOMEM;
  494. }
  495. resp->RequestId = msg->RequestId;
  496. resp->MessageType = REMOTE_NDIS_SET_CMPLT;
  497. resp->MessageLength = sizeof(struct rndis_set_cmplt);
  498. switch (msg->Oid)
  499. {
  500. case OID_GEN_CURRENT_PACKET_FILTER:
  501. oid_packet_filter = *((rt_uint32_t *)((rt_uint8_t *)&(msg->RequestId) + \
  502. msg->InformationBufferOffset));
  503. /* TODO: make complier happy */
  504. oid_packet_filter = oid_packet_filter;
  505. LOG_D("OID_GEN_CURRENT_PACKET_FILTER");
  506. #ifdef RNDIS_DELAY_LINK_UP
  507. /* link up. */
  508. rt_timer_start(&((rt_rndis_eth_t)func->user_data)->timer);
  509. #else
  510. eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_TRUE);
  511. #endif /* RNDIS_DELAY_LINK_UP */
  512. break;
  513. case OID_802_3_MULTICAST_LIST:
  514. break;
  515. default:
  516. LOG_W("Unknow rndis set 0x%02X", msg->Oid);
  517. resp->Status = RNDIS_STATUS_FAILURE;
  518. return RT_EOK;
  519. }
  520. resp->Status = RNDIS_STATUS_SUCCESS;
  521. response->buffer = resp;
  522. {
  523. rt_base_t level = rt_hw_interrupt_disable();
  524. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  525. rt_hw_interrupt_enable(level);
  526. }
  527. return RT_EOK;
  528. }
  529. static rt_err_t _rndis_reset_response(ufunction_t func,rndis_set_msg_t msg)
  530. {
  531. struct rndis_reset_cmplt * resp;
  532. struct rt_rndis_response * response;
  533. response = rt_malloc(sizeof(struct rt_rndis_response));
  534. resp = rt_malloc(sizeof(struct rndis_reset_cmplt));
  535. if( (response == RT_NULL) || (resp == RT_NULL) )
  536. {
  537. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  538. if(response != RT_NULL)
  539. rt_free(response);
  540. if(resp != RT_NULL)
  541. rt_free(resp);
  542. return -RT_ENOMEM;
  543. }
  544. /* reset packet filter */
  545. oid_packet_filter = 0x0000000;
  546. /* link down eth */
  547. eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
  548. /* reset eth rx tx */
  549. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
  550. ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
  551. resp->MessageType = REMOTE_NDIS_RESET_CMPLT;
  552. resp->MessageLength = sizeof(struct rndis_reset_cmplt);
  553. resp->Status = RNDIS_STATUS_SUCCESS;
  554. resp->AddressingReset = 1;
  555. response->buffer = resp;
  556. {
  557. rt_base_t level = rt_hw_interrupt_disable();
  558. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  559. rt_hw_interrupt_enable(level);
  560. }
  561. return RT_EOK;
  562. }
  563. static rt_err_t _rndis_keepalive_response(ufunction_t func,rndis_keepalive_msg_t msg)
  564. {
  565. rndis_keepalive_cmplt_t resp;
  566. struct rt_rndis_response * response;
  567. response = rt_malloc(sizeof(struct rt_rndis_response));
  568. resp = rt_malloc(sizeof(struct rndis_keepalive_cmplt));
  569. if( (response == RT_NULL) || (resp == RT_NULL) )
  570. {
  571. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  572. if(response != RT_NULL)
  573. rt_free(response);
  574. if(resp != RT_NULL)
  575. rt_free(resp);
  576. return -RT_ENOMEM;
  577. }
  578. resp->MessageType = REMOTE_NDIS_KEEPALIVE_CMPLT;
  579. resp->MessageLength = sizeof(struct rndis_keepalive_cmplt);
  580. resp->Status = RNDIS_STATUS_SUCCESS;
  581. response->buffer = resp;
  582. {
  583. rt_base_t level = rt_hw_interrupt_disable();
  584. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  585. rt_hw_interrupt_enable(level);
  586. }
  587. return RT_EOK;
  588. }
  589. static rt_err_t _rndis_msg_parser(ufunction_t func, rt_uint8_t *msg)
  590. {
  591. rt_err_t ret = -RT_ERROR;
  592. switch (((rndis_gen_msg_t) msg)->MessageType)
  593. {
  594. case REMOTE_NDIS_INITIALIZE_MSG:
  595. LOG_D("REMOTE_NDIS_INITIALIZE_MSG");
  596. ret = _rndis_init_response(func, (rndis_init_msg_t) msg);
  597. break;
  598. case REMOTE_NDIS_HALT_MSG:
  599. LOG_D("REMOTE_NDIS_HALT_MSG");
  600. /* link down. */
  601. eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
  602. /* reset eth rx tx */
  603. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
  604. ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
  605. break;
  606. case REMOTE_NDIS_QUERY_MSG:
  607. LOG_D("REMOTE_NDIS_QUERY_MSG");
  608. ret = _rndis_query_response(func,(rndis_query_msg_t) msg);
  609. break;
  610. case REMOTE_NDIS_SET_MSG:
  611. LOG_D("REMOTE_NDIS_SET_MSG");
  612. ret = _rndis_set_response(func,(rndis_set_msg_t) msg);
  613. break;
  614. case REMOTE_NDIS_RESET_MSG:
  615. LOG_D("REMOTE_NDIS_RESET_MSG");
  616. ret = _rndis_reset_response(func,(rndis_set_msg_t) msg);
  617. break;
  618. case REMOTE_NDIS_KEEPALIVE_MSG:
  619. LOG_D("REMOTE_NDIS_KEEPALIVE_MSG");
  620. ret = _rndis_keepalive_response(func,(rndis_keepalive_msg_t) msg);
  621. break;
  622. default:
  623. LOG_W("not support RNDIS msg %X", ((rndis_gen_msg_t) msg)->MessageType);
  624. ret = -RT_ERROR;
  625. break;
  626. }
  627. if (ret == RT_EOK)
  628. _rndis_response_available(func);
  629. return ret;
  630. }
  631. static ufunction_t function = RT_NULL;
  632. static rt_err_t send_encapsulated_command_done(udevice_t device, rt_size_t size)
  633. {
  634. if(function != RT_NULL)
  635. {
  636. dcd_ep0_send_status(device->dcd);
  637. _rndis_msg_parser(function, rndis_message_buffer);
  638. function = RT_NULL;
  639. }
  640. return RT_EOK;
  641. }
  642. //#error here have bug ep 0x82 send failed
  643. static rt_err_t _rndis_send_encapsulated_command(ufunction_t func, ureq_t setup)
  644. {
  645. RT_ASSERT(setup->wLength <= sizeof(rndis_message_buffer));
  646. function = func;
  647. rt_usbd_ep0_read(func->device,rndis_message_buffer,setup->wLength,send_encapsulated_command_done);
  648. return RT_EOK;
  649. }
  650. static rt_err_t _rndis_get_encapsulated_response(ufunction_t func, ureq_t setup)
  651. {
  652. rndis_gen_msg_t msg;
  653. struct rt_rndis_response * response;
  654. if(rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
  655. {
  656. LOG_D("response_list is empty!");
  657. ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
  658. return RT_EOK;
  659. }
  660. response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
  661. msg = (rndis_gen_msg_t)response->buffer;
  662. rt_usbd_ep0_write(func->device, (void*)msg, msg->MessageLength);
  663. {
  664. rt_base_t level = rt_hw_interrupt_disable();
  665. rt_list_remove(&response->list);
  666. rt_hw_interrupt_enable(level);
  667. }
  668. rt_free((void *)response->buffer);
  669. rt_free(response);
  670. if(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
  671. {
  672. rt_uint32_t * data;
  673. LOG_I("auto append next response!");
  674. data = (rt_uint32_t *)((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->buffer;
  675. data[0] = RESPONSE_AVAILABLE;
  676. data[1] = 0;
  677. ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.buffer = ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->buffer;
  678. ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.size = 8;
  679. ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request.req_type = UIO_REQUEST_WRITE;
  680. rt_usbd_io_request(func->device, ((rt_rndis_eth_t)func->user_data)->eps.ep_cmd, &((rt_rndis_eth_t)func->user_data)->eps.ep_cmd->request);
  681. }
  682. else
  683. {
  684. ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
  685. }
  686. return RT_EOK;
  687. }
  688. /**
  689. * This function will handle rndis interface request.
  690. *
  691. * @param device the usb device object.
  692. * @param setup the setup request.
  693. *
  694. * @return RT_EOK on successful.
  695. */
  696. static rt_err_t _interface_handler(ufunction_t func, ureq_t setup)
  697. {
  698. RT_ASSERT(func != RT_NULL);
  699. RT_ASSERT(setup != RT_NULL);
  700. switch(setup->bRequest)
  701. {
  702. case CDC_SEND_ENCAPSULATED_COMMAND:
  703. _rndis_send_encapsulated_command(func, setup);
  704. break;
  705. case CDC_GET_ENCAPSULATED_RESPONSE:
  706. _rndis_get_encapsulated_response(func, setup);
  707. break;
  708. default:
  709. LOG_W("unkown setup->request 0x%02X !", setup->bRequest);
  710. break;
  711. }
  712. return RT_EOK;
  713. }
  714. /**
  715. * This function will handle rndis bulk in endpoint request.
  716. *
  717. * @param device the usb device object.
  718. * @param size request size.
  719. *
  720. * @return RT_EOK.
  721. */
  722. static rt_err_t _ep_in_handler(ufunction_t func, rt_size_t size)
  723. {
  724. rt_sem_release(&((rt_rndis_eth_t)func->user_data)->tx_buffer_free);
  725. return RT_EOK;
  726. }
  727. /**
  728. * This function will handle RNDIS bulk out endpoint request.
  729. *
  730. * @param device the usb device object.
  731. * @param size request size.
  732. *
  733. * @return RT_EOK.
  734. */
  735. static rt_err_t _ep_out_handler(ufunction_t func, rt_size_t size)
  736. {
  737. cdc_eps_t eps;
  738. char* data = RT_NULL;
  739. eps = (cdc_eps_t)&((rt_rndis_eth_t)func->user_data)->eps;
  740. data = (char*)eps->ep_out->buffer;
  741. if(((rt_rndis_eth_t)func->user_data)->rx_frist == RT_TRUE)
  742. {
  743. rndis_packet_msg_t msg = (rndis_packet_msg_t)data;
  744. ((rt_rndis_eth_t)func->user_data)->rx_length = msg->DataLength;
  745. ((rt_rndis_eth_t)func->user_data)->rx_offset = 0;
  746. if (size >= 44)
  747. {
  748. data += sizeof(struct rndis_packet_msg);
  749. size -= sizeof(struct rndis_packet_msg);
  750. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_FALSE;
  751. rt_memcpy(&((rt_rndis_eth_t)func->user_data)->rx_buffer[((rt_rndis_eth_t)func->user_data)->rx_offset], data, size);
  752. ((rt_rndis_eth_t)func->user_data)->rx_offset += size;
  753. }
  754. }
  755. else
  756. {
  757. rt_memcpy(&((rt_rndis_eth_t)func->user_data)->rx_buffer[((rt_rndis_eth_t)func->user_data)->rx_offset], data, size);
  758. ((rt_rndis_eth_t)func->user_data)->rx_offset += size;
  759. }
  760. if(((rt_rndis_eth_t)func->user_data)->rx_offset >= ((rt_rndis_eth_t)func->user_data)->rx_length)
  761. {
  762. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
  763. ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_TRUE;
  764. eth_device_ready(&(((rt_rndis_eth_t)func->user_data)->parent));
  765. }
  766. else
  767. {
  768. eps->ep_out->request.buffer = eps->ep_out->buffer;
  769. eps->ep_out->request.size = EP_MAXPACKET(eps->ep_out);
  770. eps->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
  771. rt_usbd_io_request(func->device, eps->ep_out, &eps->ep_out->request);
  772. }
  773. return RT_EOK;
  774. }
  775. /**
  776. * This function will handle RNDIS interrupt in endpoint request.
  777. *
  778. * @param device the usb device object.
  779. * @param size request size.
  780. *
  781. * @return RT_EOK.
  782. */
  783. static rt_err_t _ep_cmd_handler(ufunction_t func, rt_size_t size)
  784. {
  785. // _rndis_response_available(func);
  786. return RT_EOK;
  787. }
  788. /**
  789. * This function will run cdc class, it will be called on handle set configuration request.
  790. *
  791. * @param device the usb device object.
  792. *
  793. * @return RT_EOK on successful.
  794. */
  795. static rt_err_t _function_enable(ufunction_t func)
  796. {
  797. cdc_eps_t eps;
  798. LOG_I("plugged in");
  799. eps = (cdc_eps_t)&((rt_rndis_eth_t)func->user_data)->eps;
  800. eps->ep_in->buffer = ((rt_rndis_eth_t)func->user_data)->tx_pool;
  801. eps->ep_out->buffer = ((rt_rndis_eth_t)func->user_data)->rx_pool;
  802. eps->ep_cmd->buffer = (rt_uint8_t*)((rt_rndis_eth_t)func->user_data)->cmd_pool;
  803. eps->ep_out->request.buffer = eps->ep_out->buffer;
  804. eps->ep_out->request.size = EP_MAXPACKET(eps->ep_out);
  805. eps->ep_out->request.req_type = UIO_REQUEST_READ_BEST;
  806. rt_usbd_io_request(func->device, eps->ep_out, &eps->ep_out->request);
  807. ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
  808. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
  809. // eth_device_ready(&(((rt_rndis_eth_t)func->user_data)->parent));
  810. #ifdef RNDIS_DELAY_LINK_UP
  811. /* stop link up timer. */
  812. rt_timer_stop(&((rt_rndis_eth_t)func->user_data)->timer);
  813. #endif /* RNDIS_DELAY_LINK_UP */
  814. /* clean resp chain list. */
  815. {
  816. struct rt_rndis_response * response;
  817. rt_base_t level = rt_hw_interrupt_disable();
  818. while(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
  819. {
  820. response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
  821. rt_list_remove(&response->list);
  822. rt_free((void *)response->buffer);
  823. rt_free(response);
  824. }
  825. ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
  826. rt_hw_interrupt_enable(level);
  827. }
  828. return RT_EOK;
  829. }
  830. /**
  831. * This function will stop cdc class, it will be called on handle set configuration request.
  832. *
  833. * @param device the usb device object.
  834. *
  835. * @return RT_EOK on successful.
  836. */
  837. static rt_err_t _function_disable(ufunction_t func)
  838. {
  839. LOG_I("plugged out");
  840. #ifdef RNDIS_DELAY_LINK_UP
  841. /* stop link up timer. */
  842. rt_timer_stop(&((rt_rndis_eth_t)func->user_data)->timer);
  843. #endif /* RNDIS_DELAY_LINK_UP */
  844. /* clean resp chain list. */
  845. {
  846. struct rt_rndis_response * response;
  847. rt_base_t level = rt_hw_interrupt_disable();
  848. while(!rt_list_isempty(&((rt_rndis_eth_t)func->user_data)->response_list))
  849. {
  850. response = (struct rt_rndis_response *)((rt_rndis_eth_t)func->user_data)->response_list.next;
  851. LOG_D("remove resp chain list!");
  852. rt_list_remove(&response->list);
  853. rt_free((void *)response->buffer);
  854. rt_free(response);
  855. }
  856. ((rt_rndis_eth_t)func->user_data)->need_notify = RT_TRUE;
  857. rt_hw_interrupt_enable(level);
  858. }
  859. /* link down. */
  860. eth_device_linkchange(&((rt_rndis_eth_t)func->user_data)->parent, RT_FALSE);
  861. /* reset eth rx tx */
  862. ((rt_rndis_eth_t)func->user_data)->rx_frist = RT_TRUE;
  863. ((rt_rndis_eth_t)func->user_data)->rx_flag = RT_FALSE;
  864. return RT_EOK;
  865. }
  866. static struct ufunction_ops ops =
  867. {
  868. _function_enable,
  869. _function_disable,
  870. RT_NULL,
  871. };
  872. /**
  873. * This function will configure cdc descriptor.
  874. *
  875. * @param comm the communication interface number.
  876. * @param data the data interface number.
  877. *
  878. * @return RT_EOK on successful.
  879. */
  880. static rt_err_t _cdc_descriptor_config(ucdc_comm_desc_t comm, rt_uint8_t cintf_nr, ucdc_data_desc_t data, rt_uint8_t dintf_nr, rt_uint8_t device_is_hs)
  881. {
  882. comm->call_mgmt_desc.data_interface = dintf_nr;
  883. comm->union_desc.master_interface = cintf_nr;
  884. comm->union_desc.slave_interface0 = dintf_nr;
  885. #ifdef RT_USB_DEVICE_COMPOSITE
  886. comm->iad_desc.bFirstInterface = cintf_nr;
  887. #endif
  888. data->ep_out_desc.wMaxPacketSize = device_is_hs ? 512 : 64;
  889. data->ep_in_desc.wMaxPacketSize = device_is_hs ? 512 : 64;
  890. return RT_EOK;
  891. }
  892. #ifdef RT_USING_LWIP
  893. /* initialize the interface */
  894. static rt_err_t rt_rndis_eth_init(rt_device_t dev)
  895. {
  896. return RT_EOK;
  897. }
  898. static rt_err_t rt_rndis_eth_open(rt_device_t dev, rt_uint16_t oflag)
  899. {
  900. return RT_EOK;
  901. }
  902. static rt_err_t rt_rndis_eth_close(rt_device_t dev)
  903. {
  904. return RT_EOK;
  905. }
  906. static rt_size_t rt_rndis_eth_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
  907. {
  908. rt_set_errno(-RT_ENOSYS);
  909. return 0;
  910. }
  911. static rt_size_t rt_rndis_eth_write (rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
  912. {
  913. rt_set_errno(-RT_ENOSYS);
  914. return 0;
  915. }
  916. static rt_err_t rt_rndis_eth_control(rt_device_t dev, int cmd, void *args)
  917. {
  918. rt_rndis_eth_t rndis_eth_dev = (rt_rndis_eth_t)dev;
  919. switch(cmd)
  920. {
  921. case NIOCTL_GADDR:
  922. /* get mac address */
  923. if(args) rt_memcpy(args, rndis_eth_dev->dev_addr, MAX_ADDR_LEN);
  924. else return -RT_ERROR;
  925. break;
  926. default :
  927. break;
  928. }
  929. return RT_EOK;
  930. }
  931. /* ethernet device interface */
  932. /* reception packet. */
  933. struct pbuf *rt_rndis_eth_rx(rt_device_t dev)
  934. {
  935. struct pbuf* p = RT_NULL;
  936. rt_uint32_t offset = 0;
  937. rt_rndis_eth_t device = (rt_rndis_eth_t)dev;
  938. if(device->rx_flag == RT_FALSE)
  939. {
  940. return p;
  941. }
  942. if(device->rx_length != 0)
  943. {
  944. /* allocate buffer */
  945. p = pbuf_alloc(PBUF_LINK, device->rx_length, PBUF_RAM);
  946. if (p != RT_NULL)
  947. {
  948. struct pbuf* q;
  949. for (q = p; q != RT_NULL; q= q->next)
  950. {
  951. /* Copy the received frame into buffer from memory pointed by the current ETHERNET DMA Rx descriptor */
  952. rt_memcpy(q->payload,
  953. (rt_uint8_t *)((device->rx_buffer) + offset),
  954. q->len);
  955. offset += q->len;
  956. }
  957. }
  958. }
  959. {
  960. device->rx_flag = RT_FALSE;
  961. device->eps.ep_out->request.buffer = device->eps.ep_out->buffer;
  962. device->eps.ep_out->request.size = EP_MAXPACKET(device->eps.ep_out);
  963. device->eps.ep_out->request.req_type = UIO_REQUEST_READ_BEST;
  964. rt_usbd_io_request(device->func->device, device->eps.ep_out, &device->eps.ep_out->request);
  965. }
  966. return p;
  967. }
  968. /* transmit packet. */
  969. rt_err_t rt_rndis_eth_tx(rt_device_t dev, struct pbuf* p)
  970. {
  971. struct pbuf* q;
  972. char * buffer;
  973. rt_err_t result = RT_EOK;
  974. rt_rndis_eth_t device = (rt_rndis_eth_t)dev;
  975. if(!device->parent.link_status)
  976. {
  977. LOG_I("linkdown, drop pkg");
  978. return RT_EOK;
  979. }
  980. //RT_ASSERT(p->tot_len < sizeof(device->tx_buffer));
  981. if(p->tot_len > sizeof(device->tx_buffer))
  982. {
  983. LOG_W("RNDIS MTU is:%d, but the send packet size is %d",
  984. sizeof(device->tx_buffer), p->tot_len);
  985. p->tot_len = sizeof(device->tx_buffer);
  986. }
  987. /* wait for buffer free. */
  988. result = rt_sem_take(&device->tx_buffer_free, rt_tick_from_millisecond(1000));
  989. if(result != RT_EOK)
  990. {
  991. LOG_W("wait for buffer free timeout");
  992. /* if cost 1s to wait send done it said that connection is close . drop it */
  993. rt_sem_release(&device->tx_buffer_free);
  994. return result;
  995. }
  996. buffer = (char *)&device->tx_buffer + sizeof(struct rndis_packet_msg);
  997. for (q = p; q != NULL; q = q->next)
  998. {
  999. rt_memcpy(buffer, q->payload, q->len);
  1000. buffer += q->len;
  1001. }
  1002. /* send */
  1003. {
  1004. rndis_packet_msg_t msg;
  1005. msg = (rndis_packet_msg_t)&device->tx_buffer;
  1006. msg->MessageType = REMOTE_NDIS_PACKET_MSG;
  1007. msg->DataOffset = sizeof(struct rndis_packet_msg) - 8;
  1008. msg->DataLength = p->tot_len;
  1009. msg->OOBDataLength = 0;
  1010. msg->OOBDataOffset = 0;
  1011. msg->NumOOBDataElements = 0;
  1012. msg->PerPacketInfoOffset = 0;
  1013. msg->PerPacketInfoLength = 0;
  1014. msg->VcHandle = 0;
  1015. msg->Reserved = 0;
  1016. msg->MessageLength = sizeof(struct rndis_packet_msg) + p->tot_len;
  1017. if((msg->MessageLength & 0x3F) == 0)
  1018. {
  1019. /* pad a dummy. */
  1020. msg->MessageLength += 1;
  1021. }
  1022. device->eps.ep_in->request.buffer = (void *)&device->tx_buffer;
  1023. device->eps.ep_in->request.size = msg->MessageLength;
  1024. device->eps.ep_in->request.req_type = UIO_REQUEST_WRITE;
  1025. rt_usbd_io_request(device->func->device, device->eps.ep_in, &device->eps.ep_in->request);
  1026. }
  1027. return result;
  1028. }
  1029. #ifdef RT_USING_DEVICE_OPS
  1030. const static struct rt_device_ops rndis_device_ops =
  1031. {
  1032. rt_rndis_eth_init,
  1033. rt_rndis_eth_open,
  1034. rt_rndis_eth_close,
  1035. rt_rndis_eth_read,
  1036. rt_rndis_eth_write,
  1037. rt_rndis_eth_control
  1038. };
  1039. #endif
  1040. #endif /* RT_USING_LWIP */
  1041. #ifdef RNDIS_DELAY_LINK_UP
  1042. /**
  1043. * This function will set rndis connect status.
  1044. *
  1045. * @param device the usb device object.
  1046. * @param status the connect status.
  1047. *
  1048. * @return RT_EOK on successful.
  1049. */
  1050. static rt_err_t _rndis_indicate_status_msg(ufunction_t func, rt_uint32_t status)
  1051. {
  1052. rndis_indicate_status_msg_t resp;
  1053. struct rt_rndis_response * response;
  1054. response = rt_malloc(sizeof(struct rt_rndis_response));
  1055. resp = rt_malloc(sizeof(struct rndis_indicate_status_msg));
  1056. if( (response == RT_NULL) || (resp == RT_NULL) )
  1057. {
  1058. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  1059. if(response != RT_NULL)
  1060. rt_free(response);
  1061. if(resp != RT_NULL)
  1062. rt_free(resp);
  1063. return -RT_ENOMEM;
  1064. }
  1065. resp->MessageType = REMOTE_NDIS_INDICATE_STATUS_MSG;
  1066. resp->MessageLength = 20; /* sizeof(struct rndis_indicate_status_msg) */
  1067. resp->Status = status;
  1068. resp->StatusBufferLength = 0;
  1069. resp->StatusBufferOffset = 0;
  1070. response->buffer = resp;
  1071. {
  1072. rt_base_t level = rt_hw_interrupt_disable();
  1073. rt_list_insert_before(&((rt_rndis_eth_t)func->user_data)->response_list, &response->list);
  1074. rt_hw_interrupt_enable(level);
  1075. }
  1076. _rndis_response_available(func);
  1077. return RT_EOK;
  1078. }
  1079. /* the delay linkup timer handler. */
  1080. static void timer_timeout(void* parameter)
  1081. {
  1082. LOG_I("delay link up!");
  1083. _rndis_indicate_status_msg(((rt_rndis_eth_t)parameter)->func,
  1084. RNDIS_STATUS_MEDIA_CONNECT);
  1085. eth_device_linkchange(&((rt_rndis_eth_t)parameter)->parent, RT_TRUE);
  1086. }
  1087. #endif /* RNDIS_DELAY_LINK_UP */
  1088. /**
  1089. * This function will create a cdc rndis class instance.
  1090. *
  1091. * @param device the usb device object.
  1092. *
  1093. * @return RT_EOK on successful.
  1094. */
  1095. ufunction_t rt_usbd_function_rndis_create(udevice_t device)
  1096. {
  1097. ufunction_t cdc;
  1098. rt_rndis_eth_t _rndis;
  1099. cdc_eps_t eps;
  1100. uintf_t intf_comm, intf_data;
  1101. ualtsetting_t comm_setting, data_setting;
  1102. ucdc_data_desc_t data_desc;
  1103. ucdc_comm_desc_t comm_desc;
  1104. /* parameter check */
  1105. RT_ASSERT(device != RT_NULL);
  1106. /* set usb device string description */
  1107. #ifdef RT_USB_DEVICE_COMPOSITE
  1108. rt_usbd_device_set_interface_string(device, RNDIS_INTF_STR_INDEX, _ustring[2]);
  1109. #else
  1110. rt_usbd_device_set_string(device, _ustring);
  1111. #endif
  1112. /* create a cdc class */
  1113. cdc = rt_usbd_function_new(device, &_dev_desc, &ops);
  1114. rt_usbd_device_set_qualifier(device, &dev_qualifier);
  1115. _rndis= rt_malloc(sizeof(struct rt_rndis_eth));
  1116. rt_memset(_rndis, 0, sizeof(struct rt_rndis_eth));
  1117. cdc->user_data = _rndis;
  1118. _rndis->func = cdc;
  1119. /* create a cdc class endpoints collection */
  1120. eps = &_rndis->eps;
  1121. /* create a cdc communication interface and a cdc data interface */
  1122. intf_comm = rt_usbd_interface_new(device, _interface_handler);
  1123. intf_data = rt_usbd_interface_new(device, _interface_handler);
  1124. /* create a communication alternate setting and a data alternate setting */
  1125. comm_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_comm_descriptor));
  1126. data_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_data_descriptor));
  1127. /* config desc in alternate setting */
  1128. rt_usbd_altsetting_config_descriptor(comm_setting, &_comm_desc,
  1129. (rt_off_t)&((ucdc_comm_desc_t)0)->intf_desc);
  1130. rt_usbd_altsetting_config_descriptor(data_setting, &_data_desc, 0);
  1131. /* configure the cdc interface descriptor */
  1132. _cdc_descriptor_config(comm_setting->desc, intf_comm->intf_num, data_setting->desc, intf_data->intf_num, device->dcd->device_is_hs);
  1133. /* create a command endpoint */
  1134. comm_desc = (ucdc_comm_desc_t)comm_setting->desc;
  1135. eps->ep_cmd = rt_usbd_endpoint_new(&comm_desc->ep_desc, _ep_cmd_handler);
  1136. /* add the command endpoint to the cdc communication interface */
  1137. rt_usbd_altsetting_add_endpoint(comm_setting, eps->ep_cmd);
  1138. /* add the communication alternate setting to the communication interface,
  1139. then set default setting of the interface */
  1140. rt_usbd_interface_add_altsetting(intf_comm, comm_setting);
  1141. rt_usbd_set_altsetting(intf_comm, 0);
  1142. /* add the communication interface to the cdc class */
  1143. rt_usbd_function_add_interface(cdc, intf_comm);
  1144. /* create a bulk in and a bulk out endpoint */
  1145. data_desc = (ucdc_data_desc_t)data_setting->desc;
  1146. eps->ep_out = rt_usbd_endpoint_new(&data_desc->ep_out_desc, _ep_out_handler);
  1147. eps->ep_in = rt_usbd_endpoint_new(&data_desc->ep_in_desc, _ep_in_handler);
  1148. /* add the bulk out and bulk in endpoints to the data alternate setting */
  1149. rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_in);
  1150. rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_out);
  1151. /* add the data alternate setting to the data interface
  1152. then set default setting of the interface */
  1153. rt_usbd_interface_add_altsetting(intf_data, data_setting);
  1154. rt_usbd_set_altsetting(intf_data, 0);
  1155. /* add the cdc data interface to cdc class */
  1156. rt_usbd_function_add_interface(cdc, intf_data);
  1157. rt_usbd_os_comp_id_desc_add_os_func_comp_id_desc(device->os_comp_id_desc, &rndis_func_comp_id_desc);
  1158. #ifdef RT_USING_LWIP
  1159. rt_list_init(&_rndis->response_list);
  1160. _rndis->need_notify = RT_TRUE;
  1161. rt_sem_init(&_rndis->tx_buffer_free, "ue_tx", 1, RT_IPC_FLAG_FIFO);
  1162. #ifdef RNDIS_DELAY_LINK_UP
  1163. rt_timer_init(&_rndis->timer,
  1164. "RNDIS",
  1165. timer_timeout,
  1166. _rndis,
  1167. RT_TICK_PER_SECOND * 2,
  1168. RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
  1169. #endif /* RNDIS_DELAY_LINK_UP */
  1170. /* OUI 00-00-00, only for test. */
  1171. _rndis->dev_addr[0] = 0x34;
  1172. _rndis->dev_addr[1] = 0x97;
  1173. _rndis->dev_addr[2] = 0xF6;
  1174. /* generate random MAC. */
  1175. _rndis->dev_addr[3] = 0x94;//*(const rt_uint8_t *)(0x1fff7a10);
  1176. _rndis->dev_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x1fff7a14);
  1177. _rndis->dev_addr[5] = 0x12;//(const rt_uint8_t *)(0x1fff7a18);
  1178. /* OUI 00-00-00, only for test. */
  1179. _rndis->host_addr[0] = 0x34;
  1180. _rndis->host_addr[1] = 0x97;
  1181. _rndis->host_addr[2] = 0xF6;
  1182. /* generate random MAC. */
  1183. _rndis->host_addr[3] = 0x94;//*(const rt_uint8_t *)(0x0FE081F0);
  1184. _rndis->host_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x0FE081F1);
  1185. _rndis->host_addr[5] = 0x13;//*(const rt_uint8_t *)(0x0FE081F2);
  1186. #ifdef RT_USING_DEVICE_OPS
  1187. _rndis->parent.parent.ops = &rndis_device_ops;
  1188. #else
  1189. _rndis->parent.parent.init = rt_rndis_eth_init;
  1190. _rndis->parent.parent.open = rt_rndis_eth_open;
  1191. _rndis->parent.parent.close = rt_rndis_eth_close;
  1192. _rndis->parent.parent.read = rt_rndis_eth_read;
  1193. _rndis->parent.parent.write = rt_rndis_eth_write;
  1194. _rndis->parent.parent.control = rt_rndis_eth_control;
  1195. #endif
  1196. _rndis->parent.parent.user_data = device;
  1197. _rndis->parent.eth_rx = rt_rndis_eth_rx;
  1198. _rndis->parent.eth_tx = rt_rndis_eth_tx;
  1199. /* register eth device */
  1200. eth_device_init(&((rt_rndis_eth_t)cdc->user_data)->parent, "u0");
  1201. #endif /* RT_USING_LWIP */
  1202. return cdc;
  1203. }
  1204. struct udclass rndis_class =
  1205. {
  1206. .rt_usbd_function_create = rt_usbd_function_rndis_create
  1207. };
  1208. int rt_usbd_rndis_class_register(void)
  1209. {
  1210. rt_usbd_class_register(&rndis_class);
  1211. return 0;
  1212. }
  1213. INIT_PREV_EXPORT(rt_usbd_rndis_class_register);
  1214. #endif /* RT_USB_DEVICE_RNDIS */