usbh_rndis.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603
  1. /*
  2. * Copyright (c) 2022, sakumisu
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "usbh_core.h"
  7. #include "usbh_rndis.h"
  8. #include "rndis_protocol.h"
  9. #undef USB_DBG_TAG
  10. #define USB_DBG_TAG "usbh_rndis"
  11. #include "usb_log.h"
  12. #define DEV_FORMAT "/dev/rndis"
  13. USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_buf[512];
  14. #define CONFIG_USBHOST_RNDIS_ETH_MAX_FRAME_SIZE 1514
  15. #define CONFIG_USBHOST_RNDIS_ETH_MSG_SIZE (CONFIG_USBHOST_RNDIS_ETH_MAX_FRAME_SIZE + 44)
  16. static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_rx_buffer[USB_ALIGN_UP(CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE, CONFIG_USB_ALIGN_SIZE)];
  17. static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_tx_buffer[USB_ALIGN_UP(CONFIG_USBHOST_RNDIS_ETH_MAX_TX_SIZE, CONFIG_USB_ALIGN_SIZE)];
  18. // static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_inttx_buffer[USB_ALIGN_UP(16, CONFIG_USB_ALIGN_SIZE)];
  19. static struct usbh_rndis g_rndis_class;
  20. static int usbh_rndis_get_notification(struct usbh_rndis *rndis_class)
  21. {
  22. (void)rndis_class;
  23. // int ret;
  24. // struct usbh_urb *urb = &rndis_class->intin_urb;
  25. // usbh_int_urb_fill(urb, rndis_class->hport, rndis_class->intin, g_rndis_inttx_buffer, rndis_class->intin->wMaxPacketSize, USB_OSAL_WAITING_FOREVER, NULL, NULL);
  26. // ret = usbh_submit_urb(urb);
  27. // if (ret == 0) {
  28. // ret = urb->actual_length;
  29. // }
  30. // return ret;
  31. return 0;
  32. }
  33. static int usbh_rndis_init_msg_transfer(struct usbh_rndis *rndis_class)
  34. {
  35. struct usb_setup_packet *setup;
  36. int ret = 0;
  37. rndis_initialize_msg_t *cmd;
  38. rndis_initialize_cmplt_t *resp;
  39. if (!rndis_class || !rndis_class->hport) {
  40. return -USB_ERR_INVAL;
  41. }
  42. setup = rndis_class->hport->setup;
  43. cmd = (rndis_initialize_msg_t *)g_rndis_buf;
  44. cmd->MessageType = REMOTE_NDIS_INITIALIZE_MSG;
  45. cmd->MessageLength = sizeof(rndis_initialize_msg_t);
  46. cmd->RequestId = rndis_class->request_id++;
  47. cmd->MajorVersion = 1;
  48. cmd->MinorVersion = 0;
  49. cmd->MaxTransferSize = 0x4000;
  50. setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  51. setup->bRequest = CDC_REQUEST_SEND_ENCAPSULATED_COMMAND;
  52. setup->wValue = 0;
  53. setup->wIndex = 0;
  54. setup->wLength = sizeof(rndis_initialize_msg_t);
  55. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)cmd);
  56. if (ret < 0) {
  57. USB_LOG_ERR("init send error, ret: %d\r\n", ret);
  58. return ret;
  59. }
  60. usbh_rndis_get_notification(rndis_class);
  61. resp = (rndis_initialize_cmplt_t *)g_rndis_buf;
  62. setup->bmRequestType = USB_REQUEST_DIR_IN | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  63. setup->bRequest = CDC_REQUEST_GET_ENCAPSULATED_RESPONSE;
  64. setup->wValue = 0;
  65. setup->wIndex = 0;
  66. setup->wLength = sizeof(g_rndis_buf);
  67. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)resp);
  68. if (ret < 0) {
  69. USB_LOG_ERR("init recv error, ret: %d\r\n", ret);
  70. return ret;
  71. }
  72. rndis_class->max_transfer_pkts = resp->MaxPacketsPerTransfer;
  73. rndis_class->max_transfer_size = resp->MaxTransferSize;
  74. USB_LOG_INFO("MaxPacketsPerTransfer: %u\r\n", (unsigned int)resp->MaxPacketsPerTransfer);
  75. USB_LOG_INFO("MaxTransferSize: %u\r\n", (unsigned int)resp->MaxTransferSize);
  76. return ret;
  77. }
  78. int usbh_rndis_query_msg_transfer(struct usbh_rndis *rndis_class, uint32_t oid, uint32_t query_len, uint8_t *info, uint32_t *info_len)
  79. {
  80. struct usb_setup_packet *setup;
  81. int ret = 0;
  82. rndis_query_msg_t *cmd;
  83. rndis_query_cmplt_t *resp;
  84. if (!rndis_class || !rndis_class->hport) {
  85. return -USB_ERR_INVAL;
  86. }
  87. setup = rndis_class->hport->setup;
  88. cmd = (rndis_query_msg_t *)g_rndis_buf;
  89. cmd->MessageType = REMOTE_NDIS_QUERY_MSG;
  90. cmd->MessageLength = query_len + sizeof(rndis_query_msg_t);
  91. cmd->RequestId = rndis_class->request_id++;
  92. cmd->Oid = oid;
  93. cmd->InformationBufferLength = query_len;
  94. cmd->InformationBufferOffset = 20;
  95. cmd->DeviceVcHandle = 0;
  96. setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  97. setup->bRequest = CDC_REQUEST_SEND_ENCAPSULATED_COMMAND;
  98. setup->wValue = 0;
  99. setup->wIndex = 0;
  100. setup->wLength = query_len + sizeof(rndis_query_msg_t);
  101. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)cmd);
  102. if (ret < 0) {
  103. USB_LOG_ERR("oid:%08x send error, ret: %d\r\n", (unsigned int)oid, ret);
  104. return ret;
  105. }
  106. usbh_rndis_get_notification(rndis_class);
  107. resp = (rndis_query_cmplt_t *)g_rndis_buf;
  108. setup->bmRequestType = USB_REQUEST_DIR_IN | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  109. setup->bRequest = CDC_REQUEST_GET_ENCAPSULATED_RESPONSE;
  110. setup->wValue = 0;
  111. setup->wIndex = 0;
  112. setup->wLength = sizeof(g_rndis_buf);
  113. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)resp);
  114. if (ret < 0) {
  115. USB_LOG_ERR("oid:%08x recv error, ret: %d\r\n", (unsigned int)oid, ret);
  116. return ret;
  117. }
  118. memcpy(info, ((uint8_t *)resp + sizeof(rndis_query_cmplt_t)), resp->InformationBufferLength);
  119. *info_len = resp->InformationBufferLength;
  120. return ret;
  121. }
  122. static int usbh_rndis_set_msg_transfer(struct usbh_rndis *rndis_class, uint32_t oid, uint8_t *info, uint32_t info_len)
  123. {
  124. struct usb_setup_packet *setup;
  125. int ret = 0;
  126. rndis_set_msg_t *cmd;
  127. rndis_set_cmplt_t *resp;
  128. if (!rndis_class || !rndis_class->hport) {
  129. return -USB_ERR_INVAL;
  130. }
  131. setup = rndis_class->hport->setup;
  132. cmd = (rndis_set_msg_t *)g_rndis_buf;
  133. cmd->MessageType = REMOTE_NDIS_SET_MSG;
  134. cmd->MessageLength = info_len + sizeof(rndis_set_msg_t);
  135. cmd->RequestId = rndis_class->request_id++;
  136. cmd->Oid = oid;
  137. cmd->InformationBufferLength = info_len;
  138. cmd->InformationBufferOffset = 20;
  139. cmd->DeviceVcHandle = 0;
  140. memcpy(((uint8_t *)cmd + sizeof(rndis_set_msg_t)), info, info_len);
  141. setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  142. setup->bRequest = CDC_REQUEST_SEND_ENCAPSULATED_COMMAND;
  143. setup->wValue = 0;
  144. setup->wIndex = 0;
  145. setup->wLength = info_len + sizeof(rndis_set_msg_t);
  146. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)cmd);
  147. if (ret < 0) {
  148. USB_LOG_ERR("oid:%08x send error, ret: %d\r\n", (unsigned int)oid, ret);
  149. return ret;
  150. }
  151. usbh_rndis_get_notification(rndis_class);
  152. resp = (rndis_set_cmplt_t *)g_rndis_buf;
  153. setup->bmRequestType = USB_REQUEST_DIR_IN | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  154. setup->bRequest = CDC_REQUEST_GET_ENCAPSULATED_RESPONSE;
  155. setup->wValue = 0;
  156. setup->wIndex = 0;
  157. setup->wLength = sizeof(g_rndis_buf);
  158. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)resp);
  159. if (ret < 0) {
  160. USB_LOG_ERR("oid:%08x recv error, ret: %d\r\n", (unsigned int)oid, ret);
  161. return ret;
  162. }
  163. return ret;
  164. }
  165. int usbh_rndis_get_connect_status(struct usbh_rndis *rndis_class)
  166. {
  167. int ret;
  168. uint8_t data[32];
  169. uint32_t data_len;
  170. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_MEDIA_CONNECT_STATUS, 4, data, &data_len);
  171. if (ret < 0) {
  172. return ret;
  173. }
  174. if (NDIS_MEDIA_STATE_CONNECTED == data[0]) {
  175. rndis_class->connect_status = true;
  176. } else {
  177. rndis_class->connect_status = false;
  178. }
  179. return 0;
  180. }
  181. int usbh_rndis_keepalive(struct usbh_rndis *rndis_class)
  182. {
  183. struct usb_setup_packet *setup;
  184. int ret = 0;
  185. rndis_keepalive_msg_t *cmd;
  186. rndis_keepalive_cmplt_t *resp;
  187. if (!rndis_class || !rndis_class->hport) {
  188. return -USB_ERR_INVAL;
  189. }
  190. setup = rndis_class->hport->setup;
  191. cmd = (rndis_keepalive_msg_t *)g_rndis_buf;
  192. cmd->MessageType = REMOTE_NDIS_KEEPALIVE_MSG;
  193. cmd->MessageLength = sizeof(rndis_keepalive_msg_t);
  194. cmd->RequestId = rndis_class->request_id++;
  195. setup->bmRequestType = USB_REQUEST_DIR_OUT | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  196. setup->bRequest = CDC_REQUEST_SEND_ENCAPSULATED_COMMAND;
  197. setup->wValue = 0;
  198. setup->wIndex = 0;
  199. setup->wLength = sizeof(rndis_keepalive_msg_t);
  200. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)cmd);
  201. if (ret < 0) {
  202. USB_LOG_ERR("keepalive send error, ret: %d\r\n", ret);
  203. return ret;
  204. }
  205. usbh_rndis_get_notification(rndis_class);
  206. resp = (rndis_keepalive_cmplt_t *)g_rndis_buf;
  207. setup->bmRequestType = USB_REQUEST_DIR_IN | USB_REQUEST_CLASS | USB_REQUEST_RECIPIENT_INTERFACE;
  208. setup->bRequest = CDC_REQUEST_GET_ENCAPSULATED_RESPONSE;
  209. setup->wValue = 0;
  210. setup->wIndex = 0;
  211. setup->wLength = sizeof(g_rndis_buf);
  212. ret = usbh_control_transfer(rndis_class->hport, setup, (uint8_t *)resp);
  213. if (ret < 0) {
  214. USB_LOG_ERR("keepalive recv error, ret: %d\r\n", ret);
  215. return ret;
  216. }
  217. return ret;
  218. }
  219. static int usbh_rndis_connect(struct usbh_hubport *hport, uint8_t intf)
  220. {
  221. struct usb_endpoint_descriptor *ep_desc;
  222. int ret;
  223. uint32_t *oid_support_list;
  224. uint32_t oid = 0;
  225. uint32_t oid_num = 0;
  226. uint32_t data_len;
  227. uint8_t tmp_buffer[512];
  228. uint8_t data[32];
  229. struct usbh_rndis *rndis_class = &g_rndis_class;
  230. memset(rndis_class, 0, sizeof(struct usbh_rndis));
  231. rndis_class->hport = hport;
  232. rndis_class->ctrl_intf = intf;
  233. rndis_class->data_intf = intf + 1;
  234. hport->config.intf[intf].priv = rndis_class;
  235. hport->config.intf[intf + 1].priv = NULL;
  236. // ep_desc = &hport->config.intf[intf].altsetting[0].ep[0].ep_desc;
  237. // USBH_EP_INIT(rndis_class->intin, ep_desc);
  238. for (uint8_t i = 0; i < hport->config.intf[intf + 1].altsetting[0].intf_desc.bNumEndpoints; i++) {
  239. ep_desc = &hport->config.intf[intf + 1].altsetting[0].ep[i].ep_desc;
  240. if (ep_desc->bEndpointAddress & 0x80) {
  241. USBH_EP_INIT(rndis_class->bulkin, ep_desc);
  242. } else {
  243. USBH_EP_INIT(rndis_class->bulkout, ep_desc);
  244. }
  245. }
  246. ret = usbh_rndis_init_msg_transfer(rndis_class);
  247. if (ret < 0) {
  248. return ret;
  249. }
  250. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_SUPPORTED_LIST, 0, tmp_buffer, &data_len);
  251. if (ret < 0) {
  252. return ret;
  253. }
  254. oid_num = (data_len / 4);
  255. USB_LOG_INFO("rndis query OID_GEN_SUPPORTED_LIST success,oid num: %u\r\n", (unsigned int)oid_num);
  256. oid_support_list = (uint32_t *)tmp_buffer;
  257. for (uint8_t i = 0; i < oid_num; i++) {
  258. oid = oid_support_list[i];
  259. switch (oid) {
  260. case OID_GEN_PHYSICAL_MEDIUM:
  261. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_PHYSICAL_MEDIUM, 4, data, &data_len);
  262. if (ret < 0) {
  263. goto query_errorout;
  264. }
  265. break;
  266. case OID_GEN_MAXIMUM_FRAME_SIZE:
  267. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_MAXIMUM_FRAME_SIZE, 4, data, &data_len);
  268. if (ret < 0) {
  269. goto query_errorout;
  270. }
  271. break;
  272. case OID_GEN_LINK_SPEED:
  273. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_LINK_SPEED, 4, data, &data_len);
  274. if (ret < 0) {
  275. goto query_errorout;
  276. }
  277. memcpy(&rndis_class->link_speed, data, 4);
  278. break;
  279. case OID_GEN_MEDIA_CONNECT_STATUS:
  280. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_MEDIA_CONNECT_STATUS, 4, data, &data_len);
  281. if (ret < 0) {
  282. goto query_errorout;
  283. }
  284. if (NDIS_MEDIA_STATE_CONNECTED == data[0]) {
  285. rndis_class->connect_status = true;
  286. } else {
  287. rndis_class->connect_status = false;
  288. }
  289. break;
  290. case OID_802_3_MAXIMUM_LIST_SIZE:
  291. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_MAXIMUM_LIST_SIZE, 4, data, &data_len);
  292. if (ret < 0) {
  293. goto query_errorout;
  294. }
  295. break;
  296. case OID_802_3_CURRENT_ADDRESS:
  297. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_CURRENT_ADDRESS, 6, data, &data_len);
  298. if (ret < 0) {
  299. goto query_errorout;
  300. }
  301. for (uint8_t j = 0; j < 6; j++) {
  302. rndis_class->mac[j] = data[j];
  303. }
  304. break;
  305. case OID_802_3_PERMANENT_ADDRESS:
  306. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_PERMANENT_ADDRESS, 6, data, &data_len);
  307. if (ret < 0) {
  308. goto query_errorout;
  309. }
  310. break;
  311. default:
  312. break;
  313. }
  314. }
  315. uint32_t packet_filter = 0x0f;
  316. ret = usbh_rndis_set_msg_transfer(rndis_class, OID_GEN_CURRENT_PACKET_FILTER, (uint8_t *)&packet_filter, 4);
  317. if (ret < 0) {
  318. return ret;
  319. }
  320. uint8_t multicast_list[6] = { 0x01, 0x00, 0x5E, 0x00, 0x00, 0x01 };
  321. ret = usbh_rndis_set_msg_transfer(rndis_class, OID_802_3_MULTICAST_LIST, multicast_list, 6);
  322. if (ret < 0) {
  323. return ret;
  324. }
  325. USB_LOG_INFO("rndis MAC address %02x:%02x:%02x:%02x:%02x:%02x\r\n",
  326. rndis_class->mac[0],
  327. rndis_class->mac[1],
  328. rndis_class->mac[2],
  329. rndis_class->mac[3],
  330. rndis_class->mac[4],
  331. rndis_class->mac[5]);
  332. strncpy(hport->config.intf[intf].devname, DEV_FORMAT, CONFIG_USBHOST_DEV_NAMELEN);
  333. USB_LOG_INFO("Register RNDIS Class:%s\r\n", hport->config.intf[intf].devname);
  334. usbh_rndis_run(rndis_class);
  335. return ret;
  336. query_errorout:
  337. USB_LOG_ERR("rndis query iod:%08x error\r\n", (unsigned int)oid);
  338. return ret;
  339. }
  340. static int usbh_rndis_disconnect(struct usbh_hubport *hport, uint8_t intf)
  341. {
  342. int ret = 0;
  343. struct usbh_rndis *rndis_class = (struct usbh_rndis *)hport->config.intf[intf].priv;
  344. if (rndis_class) {
  345. if (rndis_class->bulkin) {
  346. usbh_kill_urb(&rndis_class->bulkin_urb);
  347. }
  348. if (rndis_class->bulkout) {
  349. usbh_kill_urb(&rndis_class->bulkout_urb);
  350. }
  351. // if (rndis_class->intin) {
  352. // usbh_kill_urb(&rndis_class->intin_urb);
  353. // }
  354. if (hport->config.intf[intf].devname[0] != '\0') {
  355. usb_osal_thread_schedule_other();
  356. USB_LOG_INFO("Unregister RNDIS Class:%s\r\n", hport->config.intf[intf].devname);
  357. usbh_rndis_stop(rndis_class);
  358. }
  359. memset(rndis_class, 0, sizeof(struct usbh_rndis));
  360. }
  361. return ret;
  362. }
  363. void usbh_rndis_rx_thread(CONFIG_USB_OSAL_THREAD_SET_ARGV)
  364. {
  365. uint32_t g_rndis_rx_length;
  366. int ret;
  367. uint32_t pmg_offset;
  368. rndis_data_packet_t *pmsg;
  369. rndis_data_packet_t temp;
  370. #if CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE <= (16 * 1024)
  371. uint32_t transfer_size = CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE;
  372. #else
  373. uint32_t transfer_size = (16 * 1024);
  374. #endif
  375. (void)CONFIG_USB_OSAL_THREAD_GET_ARGV;
  376. USB_LOG_INFO("Create rndis rx thread\r\n");
  377. // clang-format off
  378. find_class:
  379. // clang-format on
  380. g_rndis_class.connect_status = false;
  381. if (usbh_find_class_instance("/dev/rndis") == NULL) {
  382. goto delete;
  383. }
  384. while (g_rndis_class.connect_status == false) {
  385. ret = usbh_rndis_get_connect_status(&g_rndis_class);
  386. if (ret < 0) {
  387. usb_osal_msleep(100);
  388. goto find_class;
  389. }
  390. usb_osal_msleep(128);
  391. }
  392. g_rndis_rx_length = 0;
  393. while (1) {
  394. usbh_bulk_urb_fill(&g_rndis_class.bulkin_urb, g_rndis_class.hport, g_rndis_class.bulkin, &g_rndis_rx_buffer[g_rndis_rx_length], transfer_size, USB_OSAL_WAITING_FOREVER, NULL, NULL);
  395. ret = usbh_submit_urb(&g_rndis_class.bulkin_urb);
  396. if (ret < 0) {
  397. break;
  398. }
  399. g_rndis_rx_length += g_rndis_class.bulkin_urb.actual_length;
  400. /* A transfer is complete because last packet is a short packet.
  401. * Short packet is not zero, match g_rndis_rx_length % USB_GET_MAXPACKETSIZE(g_rndis_class.bulkin->wMaxPacketSize).
  402. * Short packet cannot be zero.
  403. */
  404. if (g_rndis_rx_length % USB_GET_MAXPACKETSIZE(g_rndis_class.bulkin->wMaxPacketSize)) {
  405. pmg_offset = 0;
  406. uint32_t total_len = g_rndis_rx_length;
  407. while (g_rndis_rx_length > 0) {
  408. USB_LOG_DBG("rxlen:%u\r\n", (unsigned int)g_rndis_rx_length);
  409. pmsg = (rndis_data_packet_t *)(g_rndis_rx_buffer + pmg_offset);
  410. /* Not word-aligned case */
  411. if (pmg_offset & 0x3) {
  412. usb_memcpy(&temp, pmsg, sizeof(rndis_data_packet_t));
  413. pmsg = &temp;
  414. }
  415. if (pmsg->MessageType == REMOTE_NDIS_PACKET_MSG) {
  416. uint8_t *buf = (uint8_t *)(g_rndis_rx_buffer + pmg_offset + sizeof(rndis_generic_msg_t) + pmsg->DataOffset);
  417. usbh_rndis_eth_input(buf, pmsg->DataLength);
  418. pmg_offset += pmsg->MessageLength;
  419. g_rndis_rx_length -= pmsg->MessageLength;
  420. /* drop the last dummy byte, it is a short packet to tell us we have received a multiple of wMaxPacketSize */
  421. if (g_rndis_rx_length < 4) {
  422. g_rndis_rx_length = 0;
  423. }
  424. } else {
  425. USB_LOG_ERR("offset:%u,remain:%u,total:%u\r\n", (unsigned int)pmg_offset, (unsigned int)g_rndis_rx_length, (unsigned int)total_len);
  426. g_rndis_rx_length = 0;
  427. USB_LOG_ERR("Error rndis packet message\r\n");
  428. }
  429. }
  430. } else {
  431. #if CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE <= (16 * 1024)
  432. if (g_rndis_rx_length == CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE) {
  433. #else
  434. if ((g_rndis_rx_length + (16 * 1024)) > CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE) {
  435. #endif
  436. USB_LOG_ERR("Rx packet is overflow, please reduce tcp window size or increase CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE\r\n");
  437. while (1) {
  438. }
  439. }
  440. }
  441. }
  442. // clang-format off
  443. delete:
  444. USB_LOG_INFO("Delete rndis rx thread\r\n");
  445. usb_osal_thread_delete(NULL);
  446. // clang-format on
  447. }
  448. uint8_t *usbh_rndis_get_eth_txbuf(void)
  449. {
  450. return (g_rndis_tx_buffer + sizeof(rndis_data_packet_t));
  451. }
  452. int usbh_rndis_eth_output(uint32_t buflen)
  453. {
  454. rndis_data_packet_t *hdr;
  455. uint32_t len;
  456. if (g_rndis_class.connect_status == false) {
  457. return -USB_ERR_NOTCONN;
  458. }
  459. hdr = (rndis_data_packet_t *)g_rndis_tx_buffer;
  460. memset(hdr, 0, sizeof(rndis_data_packet_t));
  461. hdr->MessageType = REMOTE_NDIS_PACKET_MSG;
  462. hdr->MessageLength = sizeof(rndis_data_packet_t) + buflen;
  463. hdr->DataOffset = sizeof(rndis_data_packet_t) - sizeof(rndis_generic_msg_t);
  464. hdr->DataLength = buflen;
  465. len = hdr->MessageLength;
  466. /* if message length is the multiple of wMaxPacketSize, we should add a short packet to tell device transfer is over. */
  467. if (!(len % g_rndis_class.bulkout->wMaxPacketSize)) {
  468. len += 1;
  469. }
  470. USB_LOG_DBG("txlen:%d\r\n", len);
  471. usbh_bulk_urb_fill(&g_rndis_class.bulkout_urb, g_rndis_class.hport, g_rndis_class.bulkout, g_rndis_tx_buffer, len, USB_OSAL_WAITING_FOREVER, NULL, NULL);
  472. return usbh_submit_urb(&g_rndis_class.bulkout_urb);
  473. }
  474. static const struct usbh_class_driver rndis_class_driver = {
  475. .driver_name = "rndis",
  476. .connect = usbh_rndis_connect,
  477. .disconnect = usbh_rndis_disconnect
  478. };
  479. CLASS_INFO_DEFINE const struct usbh_class_info rndis_class_info = {
  480. .match_flags = USB_CLASS_MATCH_INTF_CLASS | USB_CLASS_MATCH_INTF_SUBCLASS | USB_CLASS_MATCH_INTF_PROTOCOL,
  481. .bInterfaceClass = USB_DEVICE_CLASS_WIRELESS,
  482. .bInterfaceSubClass = 0x01,
  483. .bInterfaceProtocol = 0x03,
  484. .id_table = NULL,
  485. .class_driver = &rndis_class_driver
  486. };
  487. CLASS_INFO_DEFINE const struct usbh_class_info rndis_cdcacm_class_info = {
  488. .match_flags = USB_CLASS_MATCH_INTF_CLASS | USB_CLASS_MATCH_INTF_SUBCLASS | USB_CLASS_MATCH_INTF_PROTOCOL,
  489. .bInterfaceClass = USB_DEVICE_CLASS_CDC,
  490. .bInterfaceSubClass = CDC_ABSTRACT_CONTROL_MODEL,
  491. .bInterfaceProtocol = 0xff,
  492. .id_table = NULL,
  493. .class_driver = &rndis_class_driver
  494. };