rndis.c 41 KB

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