usbd_rndis.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594
  1. /*
  2. * Copyright (c) 2022, sakumisu
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "usbd_core.h"
  7. #include "usbd_rndis.h"
  8. #include "rndis_protocol.h"
  9. #define RNDIS_OUT_EP_IDX 0
  10. #define RNDIS_IN_EP_IDX 1
  11. #define RNDIS_INT_EP_IDX 2
  12. /* Describe EndPoints configuration */
  13. static struct usbd_endpoint rndis_ep_data[3];
  14. #define RNDIS_INQUIRY_PUT(src, len) (memcpy(infomation_buffer, src, len))
  15. #define RNDIS_INQUIRY_PUT_LE32(value) (*(uint32_t *)infomation_buffer = (value))
  16. /* Device data structure */
  17. struct usbd_rndis_priv {
  18. uint32_t drv_version;
  19. uint32_t link_status;
  20. uint32_t net_filter;
  21. usb_eth_stat_t eth_state;
  22. rndis_state_t init_state;
  23. uint8_t mac[6];
  24. } g_usbd_rndis;
  25. #if CONFIG_USBDEV_RNDIS_RESP_BUFFER_SIZE < 140
  26. #undef CONFIG_USBDEV_RNDIS_RESP_BUFFER_SIZE
  27. #define CONFIG_USBDEV_RNDIS_RESP_BUFFER_SIZE 156
  28. #endif
  29. #if CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE < 1580
  30. #undef CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE
  31. #define CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE 1580
  32. #endif
  33. static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_rx_buffer[CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE];
  34. static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_tx_buffer[CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE];
  35. USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t rndis_encapsulated_resp_buffer[CONFIG_USBDEV_RNDIS_RESP_BUFFER_SIZE];
  36. USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t NOTIFY_RESPONSE_AVAILABLE[8];
  37. volatile uint8_t *g_rndis_rx_data_buffer;
  38. volatile uint32_t g_rndis_rx_data_length;
  39. volatile uint32_t g_rndis_tx_data_length;
  40. /* RNDIS options list */
  41. const uint32_t oid_supported_list[] = {
  42. /* General OIDs */
  43. OID_GEN_SUPPORTED_LIST,
  44. OID_GEN_HARDWARE_STATUS,
  45. OID_GEN_MEDIA_SUPPORTED,
  46. OID_GEN_MEDIA_IN_USE,
  47. OID_GEN_MAXIMUM_FRAME_SIZE,
  48. OID_GEN_LINK_SPEED,
  49. OID_GEN_TRANSMIT_BLOCK_SIZE,
  50. OID_GEN_RECEIVE_BLOCK_SIZE,
  51. OID_GEN_VENDOR_ID,
  52. OID_GEN_VENDOR_DESCRIPTION,
  53. OID_GEN_VENDOR_DRIVER_VERSION,
  54. OID_GEN_CURRENT_PACKET_FILTER,
  55. OID_GEN_MAXIMUM_TOTAL_SIZE,
  56. OID_GEN_MEDIA_CONNECT_STATUS,
  57. OID_GEN_PHYSICAL_MEDIUM,
  58. /* General Statistic OIDs */
  59. OID_GEN_XMIT_OK,
  60. OID_GEN_RCV_OK,
  61. OID_GEN_XMIT_ERROR,
  62. OID_GEN_RCV_ERROR,
  63. OID_GEN_RCV_NO_BUFFER,
  64. /* Please configure us */
  65. OID_GEN_RNDIS_CONFIG_PARAMETER,
  66. /* 802.3 OIDs */
  67. OID_802_3_PERMANENT_ADDRESS,
  68. OID_802_3_CURRENT_ADDRESS,
  69. OID_802_3_MULTICAST_LIST,
  70. OID_802_3_MAXIMUM_LIST_SIZE,
  71. /* 802.3 Statistic OIDs */
  72. OID_802_3_RCV_ERROR_ALIGNMENT,
  73. OID_802_3_XMIT_ONE_COLLISION,
  74. OID_802_3_XMIT_MORE_COLLISIONS,
  75. OID_802_3_MAC_OPTIONS,
  76. };
  77. static int rndis_encapsulated_cmd_handler(uint8_t *data, uint32_t len);
  78. static void rndis_notify_rsp(void)
  79. {
  80. memset(NOTIFY_RESPONSE_AVAILABLE, 0, 8);
  81. NOTIFY_RESPONSE_AVAILABLE[0] = 0x01;
  82. usbd_ep_start_write(0, rndis_ep_data[RNDIS_INT_EP_IDX].ep_addr, NOTIFY_RESPONSE_AVAILABLE, 8);
  83. }
  84. static int rndis_class_interface_request_handler(uint8_t busid, struct usb_setup_packet *setup, uint8_t **data, uint32_t *len)
  85. {
  86. (void)busid;
  87. switch (setup->bRequest) {
  88. case CDC_REQUEST_SEND_ENCAPSULATED_COMMAND:
  89. rndis_encapsulated_cmd_handler(*data, setup->wLength);
  90. break;
  91. case CDC_REQUEST_GET_ENCAPSULATED_RESPONSE:
  92. *data = rndis_encapsulated_resp_buffer;
  93. *len = ((rndis_generic_msg_t *)rndis_encapsulated_resp_buffer)->MessageLength;
  94. break;
  95. default:
  96. return -1;
  97. }
  98. return 0;
  99. }
  100. static int rndis_init_cmd_handler(uint8_t *data, uint32_t len);
  101. static int rndis_halt_cmd_handler(uint8_t *data, uint32_t len);
  102. static int rndis_query_cmd_handler(uint8_t *data, uint32_t len);
  103. static int rndis_set_cmd_handler(uint8_t *data, uint32_t len);
  104. static int rndis_reset_cmd_handler(uint8_t *data, uint32_t len);
  105. static int rndis_keepalive_cmd_handler(uint8_t *data, uint32_t len);
  106. static int rndis_encapsulated_cmd_handler(uint8_t *data, uint32_t len)
  107. {
  108. switch (((rndis_generic_msg_t *)data)->MessageType) {
  109. case REMOTE_NDIS_INITIALIZE_MSG:
  110. return rndis_init_cmd_handler(data, len);
  111. case REMOTE_NDIS_HALT_MSG:
  112. return rndis_halt_cmd_handler(data, len);
  113. case REMOTE_NDIS_QUERY_MSG:
  114. return rndis_query_cmd_handler(data, len);
  115. case REMOTE_NDIS_SET_MSG:
  116. return rndis_set_cmd_handler(data, len);
  117. case REMOTE_NDIS_RESET_MSG:
  118. return rndis_reset_cmd_handler(data, len);
  119. case REMOTE_NDIS_KEEPALIVE_MSG:
  120. return rndis_keepalive_cmd_handler(data, len);
  121. default:
  122. break;
  123. }
  124. return -1;
  125. }
  126. static int rndis_init_cmd_handler(uint8_t *data, uint32_t len)
  127. {
  128. rndis_initialize_msg_t *cmd = (rndis_initialize_msg_t *)data;
  129. rndis_initialize_cmplt_t *resp;
  130. (void)len;
  131. resp = ((rndis_initialize_cmplt_t *)rndis_encapsulated_resp_buffer);
  132. resp->RequestId = cmd->RequestId;
  133. resp->MessageType = REMOTE_NDIS_INITIALIZE_CMPLT;
  134. resp->MessageLength = sizeof(rndis_initialize_cmplt_t);
  135. resp->MajorVersion = RNDIS_MAJOR_VERSION;
  136. resp->MinorVersion = RNDIS_MINOR_VERSION;
  137. resp->Status = RNDIS_STATUS_SUCCESS;
  138. resp->DeviceFlags = RNDIS_DF_CONNECTIONLESS;
  139. resp->Medium = RNDIS_MEDIUM_802_3;
  140. resp->MaxPacketsPerTransfer = CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE / 1580;
  141. resp->MaxTransferSize = CONFIG_USBDEV_RNDIS_ETH_MAX_FRAME_SIZE;
  142. resp->PacketAlignmentFactor = 0;
  143. resp->AfListOffset = 0;
  144. resp->AfListSize = 0;
  145. g_usbd_rndis.init_state = rndis_initialized;
  146. rndis_notify_rsp();
  147. return 0;
  148. }
  149. static int rndis_halt_cmd_handler(uint8_t *data, uint32_t len)
  150. {
  151. rndis_halt_msg_t *resp;
  152. (void)data;
  153. (void)len;
  154. resp = ((rndis_halt_msg_t *)rndis_encapsulated_resp_buffer);
  155. resp->MessageLength = 0;
  156. g_usbd_rndis.init_state = rndis_uninitialized;
  157. return 0;
  158. }
  159. static int rndis_query_cmd_handler(uint8_t *data, uint32_t len)
  160. {
  161. rndis_query_msg_t *cmd = (rndis_query_msg_t *)data;
  162. rndis_query_cmplt_t *resp;
  163. uint8_t *infomation_buffer;
  164. uint32_t infomation_len = 0;
  165. (void)len;
  166. resp = ((rndis_query_cmplt_t *)rndis_encapsulated_resp_buffer);
  167. resp->MessageType = REMOTE_NDIS_QUERY_CMPLT;
  168. resp->RequestId = cmd->RequestId;
  169. resp->InformationBufferOffset = sizeof(rndis_query_cmplt_t) - sizeof(rndis_generic_msg_t);
  170. resp->Status = RNDIS_STATUS_SUCCESS;
  171. infomation_buffer = (uint8_t *)resp + sizeof(rndis_query_cmplt_t);
  172. switch (cmd->Oid) {
  173. case OID_GEN_SUPPORTED_LIST:
  174. RNDIS_INQUIRY_PUT(oid_supported_list, sizeof(oid_supported_list));
  175. infomation_len = sizeof(oid_supported_list);
  176. break;
  177. case OID_GEN_HARDWARE_STATUS:
  178. RNDIS_INQUIRY_PUT_LE32(NDIS_HW_STS_READY);
  179. infomation_len = 4;
  180. break;
  181. case OID_GEN_MEDIA_SUPPORTED:
  182. case OID_GEN_MEDIA_IN_USE:
  183. RNDIS_INQUIRY_PUT_LE32(NDIS_MEDIUM_802_3);
  184. infomation_len = 4;
  185. break;
  186. case OID_GEN_MAXIMUM_FRAME_SIZE:
  187. case OID_GEN_TRANSMIT_BLOCK_SIZE:
  188. case OID_GEN_RECEIVE_BLOCK_SIZE:
  189. RNDIS_INQUIRY_PUT_LE32(0x05DC); /* mtu 1500 */
  190. infomation_len = 4;
  191. break;
  192. case OID_GEN_VENDOR_ID:
  193. RNDIS_INQUIRY_PUT_LE32(CONFIG_USBDEV_RNDIS_VENDOR_ID);
  194. infomation_len = 4;
  195. break;
  196. case OID_GEN_VENDOR_DRIVER_VERSION:
  197. RNDIS_INQUIRY_PUT_LE32(0x0001);
  198. infomation_len = 4;
  199. break;
  200. case OID_GEN_VENDOR_DESCRIPTION:
  201. RNDIS_INQUIRY_PUT(CONFIG_USBDEV_RNDIS_VENDOR_DESC, strlen(CONFIG_USBDEV_RNDIS_VENDOR_DESC));
  202. infomation_len = (strlen(CONFIG_USBDEV_RNDIS_VENDOR_DESC) + 1);
  203. break;
  204. case OID_802_3_CURRENT_ADDRESS:
  205. case OID_802_3_PERMANENT_ADDRESS:
  206. RNDIS_INQUIRY_PUT(g_usbd_rndis.mac, 6);
  207. infomation_len = 6;
  208. break;
  209. case OID_GEN_PHYSICAL_MEDIUM:
  210. RNDIS_INQUIRY_PUT_LE32(NDIS_MEDIUM_802_3);
  211. infomation_len = 4;
  212. break;
  213. case OID_GEN_LINK_SPEED:
  214. if (usbd_get_ep_mps(0, rndis_ep_data[RNDIS_OUT_EP_IDX].ep_addr) > 64) {
  215. RNDIS_INQUIRY_PUT_LE32(480000000 / 100);
  216. } else {
  217. RNDIS_INQUIRY_PUT_LE32(12000000 / 100);
  218. }
  219. infomation_len = 4;
  220. break;
  221. case OID_GEN_CURRENT_PACKET_FILTER:
  222. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.net_filter);
  223. infomation_len = 4;
  224. break;
  225. case OID_GEN_MAXIMUM_TOTAL_SIZE:
  226. RNDIS_INQUIRY_PUT_LE32(0x0616); /* 1514 + 44 */
  227. infomation_len = 4;
  228. break;
  229. case OID_GEN_MEDIA_CONNECT_STATUS:
  230. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.link_status);
  231. infomation_len = 4;
  232. break;
  233. case OID_GEN_RNDIS_CONFIG_PARAMETER:
  234. RNDIS_INQUIRY_PUT_LE32(0);
  235. infomation_len = 4;
  236. break;
  237. case OID_802_3_MAXIMUM_LIST_SIZE:
  238. RNDIS_INQUIRY_PUT_LE32(1); /* one address */
  239. infomation_len = 4;
  240. break;
  241. case OID_802_3_MULTICAST_LIST:
  242. //RNDIS_INQUIRY_PUT_LE32(0xE0000000); /* 224.0.0.0 */
  243. resp->Status = RNDIS_STATUS_NOT_SUPPORTED;
  244. RNDIS_INQUIRY_PUT_LE32(0);
  245. infomation_len = 4;
  246. break;
  247. case OID_802_3_MAC_OPTIONS:
  248. // infomation_len = 0;
  249. resp->Status = RNDIS_STATUS_NOT_SUPPORTED;
  250. RNDIS_INQUIRY_PUT_LE32(0);
  251. infomation_len = 4;
  252. break;
  253. case OID_GEN_MAC_OPTIONS:
  254. RNDIS_INQUIRY_PUT_LE32(0);
  255. infomation_len = 4;
  256. break;
  257. case OID_802_3_RCV_ERROR_ALIGNMENT:
  258. RNDIS_INQUIRY_PUT_LE32(0);
  259. infomation_len = 4;
  260. break;
  261. case OID_802_3_XMIT_ONE_COLLISION:
  262. RNDIS_INQUIRY_PUT_LE32(0);
  263. infomation_len = 4;
  264. break;
  265. case OID_802_3_XMIT_MORE_COLLISIONS:
  266. RNDIS_INQUIRY_PUT_LE32(0);
  267. infomation_len = 4;
  268. break;
  269. case OID_GEN_XMIT_OK:
  270. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.eth_state.txok);
  271. infomation_len = 4;
  272. break;
  273. case OID_GEN_RCV_OK:
  274. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.eth_state.rxok);
  275. infomation_len = 4;
  276. break;
  277. case OID_GEN_RCV_ERROR:
  278. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.eth_state.rxbad);
  279. infomation_len = 4;
  280. break;
  281. case OID_GEN_XMIT_ERROR:
  282. RNDIS_INQUIRY_PUT_LE32(g_usbd_rndis.eth_state.txbad);
  283. infomation_len = 4;
  284. break;
  285. case OID_GEN_RCV_NO_BUFFER:
  286. RNDIS_INQUIRY_PUT_LE32(0);
  287. infomation_len = 4;
  288. break;
  289. default:
  290. resp->Status = RNDIS_STATUS_FAILURE;
  291. infomation_len = 0;
  292. USB_LOG_WRN("Unhandled query for Object ID 0x%x\r\n", cmd->Oid);
  293. break;
  294. }
  295. resp->MessageLength = sizeof(rndis_query_cmplt_t) + infomation_len;
  296. resp->InformationBufferLength = infomation_len;
  297. rndis_notify_rsp();
  298. return 0;
  299. }
  300. static int rndis_set_cmd_handler(uint8_t *data, uint32_t len)
  301. {
  302. rndis_set_msg_t *cmd = (rndis_set_msg_t *)data;
  303. rndis_set_cmplt_t *resp;
  304. rndis_config_parameter_t *param;
  305. (void)len;
  306. resp = ((rndis_set_cmplt_t *)rndis_encapsulated_resp_buffer);
  307. resp->RequestId = cmd->RequestId;
  308. resp->MessageType = REMOTE_NDIS_SET_CMPLT;
  309. resp->MessageLength = sizeof(rndis_set_cmplt_t);
  310. resp->Status = RNDIS_STATUS_SUCCESS;
  311. switch (cmd->Oid) {
  312. case OID_GEN_RNDIS_CONFIG_PARAMETER:
  313. param = (rndis_config_parameter_t *)((uint8_t *)&(cmd->RequestId) + cmd->InformationBufferOffset);
  314. USB_LOG_WRN("RNDIS cfg param: NameOfs=%d, NameLen=%d, ValueOfs=%d, ValueLen=%d\r\n",
  315. param->ParameterNameOffset, param->ParameterNameLength,
  316. param->ParameterValueOffset, param->ParameterValueLength);
  317. break;
  318. case OID_GEN_CURRENT_PACKET_FILTER:
  319. if (cmd->InformationBufferLength < sizeof(g_usbd_rndis.net_filter)) {
  320. USB_LOG_WRN("PACKET_FILTER!\r\n");
  321. resp->Status = RNDIS_STATUS_INVALID_DATA;
  322. } else {
  323. uint32_t *filter;
  324. /* Parameter starts at offset buf_offset of the req_id field */
  325. filter = (uint32_t *)((uint8_t *)&(cmd->RequestId) + cmd->InformationBufferOffset);
  326. //g_usbd_rndis.net_filter = param->ParameterNameOffset;
  327. g_usbd_rndis.net_filter = *(uint32_t *)filter;
  328. if (g_usbd_rndis.net_filter) {
  329. g_usbd_rndis.init_state = rndis_data_initialized;
  330. } else {
  331. g_usbd_rndis.init_state = rndis_initialized;
  332. }
  333. }
  334. break;
  335. case OID_GEN_CURRENT_LOOKAHEAD:
  336. break;
  337. case OID_GEN_PROTOCOL_OPTIONS:
  338. break;
  339. case OID_802_3_MULTICAST_LIST:
  340. break;
  341. case OID_PNP_ADD_WAKE_UP_PATTERN:
  342. case OID_PNP_REMOVE_WAKE_UP_PATTERN:
  343. case OID_PNP_ENABLE_WAKE_UP:
  344. default:
  345. resp->Status = RNDIS_STATUS_FAILURE;
  346. USB_LOG_WRN("Unhandled query for Object ID 0x%x\r\n", cmd->Oid);
  347. break;
  348. }
  349. rndis_notify_rsp();
  350. return 0;
  351. }
  352. static int rndis_reset_cmd_handler(uint8_t *data, uint32_t len)
  353. {
  354. // rndis_reset_msg_t *cmd = (rndis_reset_msg_t *)data;
  355. rndis_reset_cmplt_t *resp;
  356. (void)data;
  357. (void)len;
  358. resp = ((rndis_reset_cmplt_t *)rndis_encapsulated_resp_buffer);
  359. resp->MessageType = REMOTE_NDIS_RESET_CMPLT;
  360. resp->MessageLength = sizeof(rndis_reset_cmplt_t);
  361. resp->Status = RNDIS_STATUS_SUCCESS;
  362. resp->AddressingReset = 1;
  363. g_usbd_rndis.init_state = rndis_uninitialized;
  364. rndis_notify_rsp();
  365. return 0;
  366. }
  367. static int rndis_keepalive_cmd_handler(uint8_t *data, uint32_t len)
  368. {
  369. rndis_keepalive_msg_t *cmd = (rndis_keepalive_msg_t *)data;
  370. rndis_keepalive_cmplt_t *resp;
  371. (void)len;
  372. resp = ((rndis_keepalive_cmplt_t *)rndis_encapsulated_resp_buffer);
  373. resp->RequestId = cmd->RequestId;
  374. resp->MessageType = REMOTE_NDIS_KEEPALIVE_CMPLT;
  375. resp->MessageLength = sizeof(rndis_keepalive_cmplt_t);
  376. resp->Status = RNDIS_STATUS_SUCCESS;
  377. rndis_notify_rsp();
  378. return 0;
  379. }
  380. static void rndis_notify_handler(uint8_t busid, uint8_t event, void *arg)
  381. {
  382. (void)busid;
  383. (void)arg;
  384. switch (event) {
  385. case USBD_EVENT_RESET:
  386. g_usbd_rndis.link_status = NDIS_MEDIA_STATE_DISCONNECTED;
  387. break;
  388. case USBD_EVENT_CONFIGURED:
  389. g_rndis_rx_data_length = 0;
  390. g_rndis_tx_data_length = 0;
  391. g_usbd_rndis.link_status = NDIS_MEDIA_STATE_CONNECTED;
  392. usbd_ep_start_read(0, rndis_ep_data[RNDIS_OUT_EP_IDX].ep_addr, g_rndis_rx_buffer, sizeof(g_rndis_rx_buffer));
  393. break;
  394. default:
  395. break;
  396. }
  397. }
  398. void rndis_bulk_out(uint8_t busid, uint8_t ep, uint32_t nbytes)
  399. {
  400. rndis_data_packet_t *hdr;
  401. (void)busid;
  402. (void)ep;
  403. hdr = (rndis_data_packet_t *)g_rndis_rx_buffer;
  404. g_rndis_rx_data_buffer = g_rndis_rx_buffer;
  405. if ((hdr->MessageType != REMOTE_NDIS_PACKET_MSG) || (nbytes < hdr->MessageLength)) {
  406. usbd_ep_start_read(0, rndis_ep_data[RNDIS_OUT_EP_IDX].ep_addr, g_rndis_rx_buffer, sizeof(g_rndis_rx_buffer));
  407. return;
  408. }
  409. /* Point to the payload and update the message length */
  410. g_rndis_rx_data_buffer += hdr->DataOffset + sizeof(rndis_generic_msg_t);
  411. g_rndis_rx_data_length = hdr->DataLength;
  412. usbd_rndis_data_recv_done();
  413. }
  414. void rndis_bulk_in(uint8_t busid, uint8_t ep, uint32_t nbytes)
  415. {
  416. (void)busid;
  417. if ((nbytes % usbd_get_ep_mps(0, ep)) == 0 && nbytes) {
  418. /* send zlp */
  419. usbd_ep_start_write(0, ep, NULL, 0);
  420. } else {
  421. g_rndis_tx_data_length = 0;
  422. }
  423. }
  424. void rndis_int_in(uint8_t busid, uint8_t ep, uint32_t nbytes)
  425. {
  426. (void)busid;
  427. (void)ep;
  428. (void)nbytes;
  429. //USB_LOG_DBG("len:%d\r\n", nbytes);
  430. }
  431. #ifdef CONFIG_USBDEV_RNDIS_USING_LWIP
  432. #include <lwip/pbuf.h>
  433. struct pbuf *usbd_rndis_eth_rx(void)
  434. {
  435. struct pbuf *p;
  436. if (g_rndis_rx_data_length == 0) {
  437. return NULL;
  438. }
  439. p = pbuf_alloc(PBUF_RAW, g_rndis_rx_data_length, PBUF_POOL);
  440. if (p == NULL) {
  441. return NULL;
  442. }
  443. usb_memcpy(p->payload, (uint8_t *)g_rndis_rx_data_buffer, g_rndis_rx_data_length);
  444. p->len = g_rndis_rx_data_length;
  445. USB_LOG_DBG("rxlen:%d\r\n", g_rndis_rx_data_length);
  446. g_rndis_rx_data_length = 0;
  447. usbd_ep_start_read(0, rndis_ep_data[RNDIS_OUT_EP_IDX].ep_addr, g_rndis_rx_buffer, sizeof(g_rndis_rx_buffer));
  448. return p;
  449. }
  450. int usbd_rndis_eth_tx(struct pbuf *p)
  451. {
  452. struct pbuf *q;
  453. uint8_t *buffer;
  454. rndis_data_packet_t *hdr;
  455. if (g_usbd_rndis.link_status == NDIS_MEDIA_STATE_DISCONNECTED) {
  456. return -USB_ERR_NOTCONN;
  457. }
  458. if (g_rndis_tx_data_length > 0) {
  459. return -USB_ERR_BUSY;
  460. }
  461. if (p->tot_len > sizeof(g_rndis_tx_buffer)) {
  462. p->tot_len = sizeof(g_rndis_tx_buffer);
  463. }
  464. buffer = (uint8_t *)(g_rndis_tx_buffer + sizeof(rndis_data_packet_t));
  465. for (q = p; q != NULL; q = q->next) {
  466. usb_memcpy(buffer, q->payload, q->len);
  467. buffer += q->len;
  468. }
  469. hdr = (rndis_data_packet_t *)g_rndis_tx_buffer;
  470. memset(hdr, 0, sizeof(rndis_data_packet_t));
  471. hdr->MessageType = REMOTE_NDIS_PACKET_MSG;
  472. hdr->MessageLength = sizeof(rndis_data_packet_t) + p->tot_len;
  473. hdr->DataOffset = sizeof(rndis_data_packet_t) - sizeof(rndis_generic_msg_t);
  474. hdr->DataLength = p->tot_len;
  475. g_rndis_tx_data_length = sizeof(rndis_data_packet_t) + p->tot_len;
  476. USB_LOG_DBG("txlen:%d\r\n", g_rndis_tx_data_length);
  477. return usbd_ep_start_write(0, rndis_ep_data[RNDIS_IN_EP_IDX].ep_addr, g_rndis_tx_buffer, g_rndis_tx_data_length);
  478. }
  479. #endif
  480. struct usbd_interface *usbd_rndis_init_intf(struct usbd_interface *intf,
  481. const uint8_t out_ep,
  482. const uint8_t in_ep,
  483. const uint8_t int_ep, uint8_t mac[6])
  484. {
  485. memcpy(g_usbd_rndis.mac, mac, 6);
  486. g_usbd_rndis.drv_version = 0x0001;
  487. g_usbd_rndis.link_status = NDIS_MEDIA_STATE_DISCONNECTED;
  488. rndis_ep_data[RNDIS_OUT_EP_IDX].ep_addr = out_ep;
  489. rndis_ep_data[RNDIS_OUT_EP_IDX].ep_cb = rndis_bulk_out;
  490. rndis_ep_data[RNDIS_IN_EP_IDX].ep_addr = in_ep;
  491. rndis_ep_data[RNDIS_IN_EP_IDX].ep_cb = rndis_bulk_in;
  492. rndis_ep_data[RNDIS_INT_EP_IDX].ep_addr = int_ep;
  493. rndis_ep_data[RNDIS_INT_EP_IDX].ep_cb = rndis_int_in;
  494. usbd_add_endpoint(0, &rndis_ep_data[RNDIS_OUT_EP_IDX]);
  495. usbd_add_endpoint(0, &rndis_ep_data[RNDIS_IN_EP_IDX]);
  496. usbd_add_endpoint(0, &rndis_ep_data[RNDIS_INT_EP_IDX]);
  497. intf->class_interface_handler = rndis_class_interface_request_handler;
  498. intf->class_endpoint_handler = NULL;
  499. intf->vendor_handler = NULL;
  500. intf->notify_handler = rndis_notify_handler;
  501. return intf;
  502. }