rndis.c 42 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476
  1. /*
  2. * Copyright (c) 2006-2023, 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. rt_align(4)
  48. rt_uint8_t rx_pool[512];
  49. rt_align(4)
  50. rt_uint8_t tx_pool[512];
  51. rt_uint32_t cmd_pool[2];
  52. rt_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. rt_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. rt_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. rt_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. rt_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. rt_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. rt_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. rt_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. rt_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_ssize_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_ssize_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. if(_rndis == RT_NULL)
  1117. {
  1118. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  1119. return RT_NULL;
  1120. }
  1121. rt_memset(_rndis, 0, sizeof(struct rt_rndis_eth));
  1122. cdc->user_data = _rndis;
  1123. _rndis->func = cdc;
  1124. /* create a cdc class endpoints collection */
  1125. eps = &_rndis->eps;
  1126. /* create a cdc communication interface and a cdc data interface */
  1127. intf_comm = rt_usbd_interface_new(device, _interface_handler);
  1128. intf_data = rt_usbd_interface_new(device, _interface_handler);
  1129. if((intf_comm == RT_NULL) || (intf_data == RT_NULL))
  1130. {
  1131. LOG_E("%s,%d: no memory!", __func__, __LINE__);
  1132. if(intf_comm != RT_NULL)
  1133. rt_free(intf_comm);
  1134. if(intf_data != RT_NULL)
  1135. rt_free(intf_data);
  1136. return RT_NULL;
  1137. }
  1138. /* create a communication alternate setting and a data alternate setting */
  1139. comm_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_comm_descriptor));
  1140. data_setting = rt_usbd_altsetting_new(sizeof(struct ucdc_data_descriptor));
  1141. /* config desc in alternate setting */
  1142. rt_usbd_altsetting_config_descriptor(comm_setting, &_comm_desc,
  1143. (rt_off_t)&((ucdc_comm_desc_t)0)->intf_desc);
  1144. rt_usbd_altsetting_config_descriptor(data_setting, &_data_desc, 0);
  1145. /* configure the cdc interface descriptor */
  1146. _cdc_descriptor_config(comm_setting->desc, intf_comm->intf_num, data_setting->desc, intf_data->intf_num, device->dcd->device_is_hs);
  1147. /* create a command endpoint */
  1148. comm_desc = (ucdc_comm_desc_t)comm_setting->desc;
  1149. eps->ep_cmd = rt_usbd_endpoint_new(&comm_desc->ep_desc, _ep_cmd_handler);
  1150. /* add the command endpoint to the cdc communication interface */
  1151. rt_usbd_altsetting_add_endpoint(comm_setting, eps->ep_cmd);
  1152. /* add the communication alternate setting to the communication interface,
  1153. then set default setting of the interface */
  1154. rt_usbd_interface_add_altsetting(intf_comm, comm_setting);
  1155. rt_usbd_set_altsetting(intf_comm, 0);
  1156. /* add the communication interface to the cdc class */
  1157. rt_usbd_function_add_interface(cdc, intf_comm);
  1158. /* create a bulk in and a bulk out endpoint */
  1159. data_desc = (ucdc_data_desc_t)data_setting->desc;
  1160. eps->ep_out = rt_usbd_endpoint_new(&data_desc->ep_out_desc, _ep_out_handler);
  1161. eps->ep_in = rt_usbd_endpoint_new(&data_desc->ep_in_desc, _ep_in_handler);
  1162. /* add the bulk out and bulk in endpoints to the data alternate setting */
  1163. rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_in);
  1164. rt_usbd_altsetting_add_endpoint(data_setting, eps->ep_out);
  1165. /* add the data alternate setting to the data interface
  1166. then set default setting of the interface */
  1167. rt_usbd_interface_add_altsetting(intf_data, data_setting);
  1168. rt_usbd_set_altsetting(intf_data, 0);
  1169. /* add the cdc data interface to cdc class */
  1170. rt_usbd_function_add_interface(cdc, intf_data);
  1171. rt_usbd_os_comp_id_desc_add_os_func_comp_id_desc(device->os_comp_id_desc, &rndis_func_comp_id_desc);
  1172. #ifdef RT_USING_LWIP
  1173. rt_list_init(&_rndis->response_list);
  1174. _rndis->need_notify = RT_TRUE;
  1175. rt_sem_init(&_rndis->tx_buffer_free, "ue_tx", 1, RT_IPC_FLAG_FIFO);
  1176. #ifdef RNDIS_DELAY_LINK_UP
  1177. rt_timer_init(&_rndis->timer,
  1178. "RNDIS",
  1179. timer_timeout,
  1180. _rndis,
  1181. RT_TICK_PER_SECOND * 2,
  1182. RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER);
  1183. #endif /* RNDIS_DELAY_LINK_UP */
  1184. /* OUI 00-00-00, only for test. */
  1185. _rndis->dev_addr[0] = 0x34;
  1186. _rndis->dev_addr[1] = 0x97;
  1187. _rndis->dev_addr[2] = 0xF6;
  1188. /* generate random MAC. */
  1189. _rndis->dev_addr[3] = 0x94;//*(const rt_uint8_t *)(0x1fff7a10);
  1190. _rndis->dev_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x1fff7a14);
  1191. _rndis->dev_addr[5] = 0x12;//(const rt_uint8_t *)(0x1fff7a18);
  1192. /* OUI 00-00-00, only for test. */
  1193. _rndis->host_addr[0] = 0x34;
  1194. _rndis->host_addr[1] = 0x97;
  1195. _rndis->host_addr[2] = 0xF6;
  1196. /* generate random MAC. */
  1197. _rndis->host_addr[3] = 0x94;//*(const rt_uint8_t *)(0x0FE081F0);
  1198. _rndis->host_addr[4] = 0xEA;//*(const rt_uint8_t *)(0x0FE081F1);
  1199. _rndis->host_addr[5] = 0x13;//*(const rt_uint8_t *)(0x0FE081F2);
  1200. #ifdef RT_USING_DEVICE_OPS
  1201. _rndis->parent.parent.ops = &rndis_device_ops;
  1202. #else
  1203. _rndis->parent.parent.init = rt_rndis_eth_init;
  1204. _rndis->parent.parent.open = rt_rndis_eth_open;
  1205. _rndis->parent.parent.close = rt_rndis_eth_close;
  1206. _rndis->parent.parent.read = rt_rndis_eth_read;
  1207. _rndis->parent.parent.write = rt_rndis_eth_write;
  1208. _rndis->parent.parent.control = rt_rndis_eth_control;
  1209. #endif
  1210. _rndis->parent.parent.user_data = device;
  1211. _rndis->parent.eth_rx = rt_rndis_eth_rx;
  1212. _rndis->parent.eth_tx = rt_rndis_eth_tx;
  1213. /* register eth device */
  1214. eth_device_init(&((rt_rndis_eth_t)cdc->user_data)->parent, "u0");
  1215. #endif /* RT_USING_LWIP */
  1216. return cdc;
  1217. }
  1218. struct udclass rndis_class =
  1219. {
  1220. .rt_usbd_function_create = rt_usbd_function_rndis_create
  1221. };
  1222. int rt_usbd_rndis_class_register(void)
  1223. {
  1224. rt_usbd_class_register(&rndis_class);
  1225. return 0;
  1226. }
  1227. INIT_PREV_EXPORT(rt_usbd_rndis_class_register);
  1228. #endif /* RT_USB_DEVICE_RNDIS */