usbh_rndis.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608
  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[CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE];
  17. static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_tx_buffer[CONFIG_USBHOST_RNDIS_ETH_MAX_TX_SIZE];
  18. // static USB_NOCACHE_RAM_SECTION USB_MEM_ALIGNX uint8_t g_rndis_inttx_buffer[16];
  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("rndis_initialize_msg_t 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("rndis_initialize_cmplt_t 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:%ld\r\n", resp->MaxPacketsPerTransfer);
  75. USB_LOG_INFO("MaxTransferSize:%ld\r\n", 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. USB_LOG_INFO("rndis init success\r\n");
  251. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_SUPPORTED_LIST, 0, tmp_buffer, &data_len);
  252. if (ret < 0) {
  253. return ret;
  254. }
  255. oid_num = (data_len / 4);
  256. USB_LOG_INFO("rndis query OID_GEN_SUPPORTED_LIST success,oid num :%ld\r\n", oid_num);
  257. oid_support_list = (uint32_t *)tmp_buffer;
  258. for (uint8_t i = 0; i < oid_num; i++) {
  259. oid = oid_support_list[i];
  260. switch (oid) {
  261. case OID_GEN_PHYSICAL_MEDIUM:
  262. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_PHYSICAL_MEDIUM, 4, data, &data_len);
  263. if (ret < 0) {
  264. goto query_errorout;
  265. }
  266. break;
  267. case OID_GEN_MAXIMUM_FRAME_SIZE:
  268. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_MAXIMUM_FRAME_SIZE, 4, data, &data_len);
  269. if (ret < 0) {
  270. goto query_errorout;
  271. }
  272. break;
  273. case OID_GEN_LINK_SPEED:
  274. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_LINK_SPEED, 4, data, &data_len);
  275. if (ret < 0) {
  276. goto query_errorout;
  277. }
  278. memcpy(&rndis_class->link_speed, data, 4);
  279. break;
  280. case OID_GEN_MEDIA_CONNECT_STATUS:
  281. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_GEN_MEDIA_CONNECT_STATUS, 4, data, &data_len);
  282. if (ret < 0) {
  283. goto query_errorout;
  284. }
  285. if (NDIS_MEDIA_STATE_CONNECTED == data[0]) {
  286. rndis_class->connect_status = true;
  287. } else {
  288. rndis_class->connect_status = false;
  289. }
  290. break;
  291. case OID_802_3_MAXIMUM_LIST_SIZE:
  292. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_MAXIMUM_LIST_SIZE, 4, data, &data_len);
  293. if (ret < 0) {
  294. goto query_errorout;
  295. }
  296. break;
  297. case OID_802_3_CURRENT_ADDRESS:
  298. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_CURRENT_ADDRESS, 6, data, &data_len);
  299. if (ret < 0) {
  300. goto query_errorout;
  301. }
  302. for (uint8_t j = 0; j < 6; j++) {
  303. rndis_class->mac[j] = data[j];
  304. }
  305. break;
  306. case OID_802_3_PERMANENT_ADDRESS:
  307. ret = usbh_rndis_query_msg_transfer(rndis_class, OID_802_3_PERMANENT_ADDRESS, 6, data, &data_len);
  308. if (ret < 0) {
  309. goto query_errorout;
  310. }
  311. break;
  312. default:
  313. USB_LOG_WRN("Ignore rndis query iod:%08lx\r\n", oid);
  314. continue;
  315. }
  316. USB_LOG_INFO("rndis query iod:%08lx success\r\n", oid);
  317. }
  318. uint32_t packet_filter = 0x0f;
  319. ret = usbh_rndis_set_msg_transfer(rndis_class, OID_GEN_CURRENT_PACKET_FILTER, (uint8_t *)&packet_filter, 4);
  320. if (ret < 0) {
  321. return ret;
  322. }
  323. USB_LOG_INFO("rndis set OID_GEN_CURRENT_PACKET_FILTER success\r\n");
  324. uint8_t multicast_list[6] = { 0x01, 0x00, 0x5E, 0x00, 0x00, 0x01 };
  325. ret = usbh_rndis_set_msg_transfer(rndis_class, OID_802_3_MULTICAST_LIST, multicast_list, 6);
  326. if (ret < 0) {
  327. return ret;
  328. }
  329. USB_LOG_INFO("rndis set OID_802_3_MULTICAST_LIST success\r\n");
  330. USB_LOG_INFO("rndis MAC address %02x:%02x:%02x:%02x:%02x:%02x\r\n",
  331. rndis_class->mac[0],
  332. rndis_class->mac[1],
  333. rndis_class->mac[2],
  334. rndis_class->mac[3],
  335. rndis_class->mac[4],
  336. rndis_class->mac[5]);
  337. strncpy(hport->config.intf[intf].devname, DEV_FORMAT, CONFIG_USBHOST_DEV_NAMELEN);
  338. USB_LOG_INFO("Register RNDIS Class:%s\r\n", hport->config.intf[intf].devname);
  339. usbh_rndis_run(rndis_class);
  340. return ret;
  341. query_errorout:
  342. USB_LOG_ERR("rndis query iod:%08lx error\r\n", oid);
  343. return ret;
  344. }
  345. static int usbh_rndis_disconnect(struct usbh_hubport *hport, uint8_t intf)
  346. {
  347. int ret = 0;
  348. struct usbh_rndis *rndis_class = (struct usbh_rndis *)hport->config.intf[intf].priv;
  349. if (rndis_class) {
  350. if (rndis_class->bulkin) {
  351. usbh_kill_urb(&rndis_class->bulkin_urb);
  352. }
  353. if (rndis_class->bulkout) {
  354. usbh_kill_urb(&rndis_class->bulkout_urb);
  355. }
  356. // if (rndis_class->intin) {
  357. // usbh_kill_urb(&rndis_class->intin_urb);
  358. // }
  359. if (hport->config.intf[intf].devname[0] != '\0') {
  360. USB_LOG_INFO("Unregister RNDIS Class:%s\r\n", hport->config.intf[intf].devname);
  361. usbh_rndis_stop(rndis_class);
  362. }
  363. memset(rndis_class, 0, sizeof(struct usbh_rndis));
  364. }
  365. return ret;
  366. }
  367. void usbh_rndis_rx_thread(CONFIG_USB_OSAL_THREAD_SET_ARGV)
  368. {
  369. uint32_t g_rndis_rx_length;
  370. int ret;
  371. uint32_t pmg_offset;
  372. rndis_data_packet_t *pmsg;
  373. rndis_data_packet_t temp;
  374. #if CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE <= (16 * 1024)
  375. uint32_t transfer_size = CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE;
  376. #else
  377. uint32_t transfer_size = (16 * 1024);
  378. #endif
  379. (void)CONFIG_USB_OSAL_THREAD_GET_ARGV;
  380. USB_LOG_INFO("Create rndis rx thread\r\n");
  381. // clang-format off
  382. find_class:
  383. // clang-format on
  384. g_rndis_class.connect_status = false;
  385. if (usbh_find_class_instance("/dev/rndis") == NULL) {
  386. goto delete;
  387. }
  388. while (g_rndis_class.connect_status == false) {
  389. ret = usbh_rndis_get_connect_status(&g_rndis_class);
  390. if (ret < 0) {
  391. usb_osal_msleep(100);
  392. goto find_class;
  393. }
  394. usb_osal_msleep(128);
  395. }
  396. g_rndis_rx_length = 0;
  397. while (1) {
  398. 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);
  399. ret = usbh_submit_urb(&g_rndis_class.bulkin_urb);
  400. if (ret < 0) {
  401. goto find_class;
  402. }
  403. g_rndis_rx_length += g_rndis_class.bulkin_urb.actual_length;
  404. /* A transfer is complete because last packet is a short packet.
  405. * Short packet is not zero, match g_rndis_rx_length % USB_GET_MAXPACKETSIZE(g_rndis_class.bulkin->wMaxPacketSize).
  406. * Short packet cannot be zero.
  407. */
  408. if (g_rndis_rx_length % USB_GET_MAXPACKETSIZE(g_rndis_class.bulkin->wMaxPacketSize)) {
  409. pmg_offset = 0;
  410. uint32_t total_len = g_rndis_rx_length;
  411. while (g_rndis_rx_length > 0) {
  412. USB_LOG_DBG("rxlen:%ld\r\n", g_rndis_rx_length);
  413. pmsg = (rndis_data_packet_t *)(g_rndis_rx_buffer + pmg_offset);
  414. /* Not word-aligned case */
  415. if (pmg_offset & 0x3) {
  416. usb_memcpy(&temp, pmsg, sizeof(rndis_data_packet_t));
  417. pmsg = &temp;
  418. }
  419. if (pmsg->MessageType == REMOTE_NDIS_PACKET_MSG) {
  420. uint8_t *buf = (uint8_t *)(g_rndis_rx_buffer + pmg_offset + sizeof(rndis_generic_msg_t) + pmsg->DataOffset);
  421. usbh_rndis_eth_input(buf, pmsg->DataLength);
  422. pmg_offset += pmsg->MessageLength;
  423. g_rndis_rx_length -= pmsg->MessageLength;
  424. /* drop the last dummy byte, it is a short packet to tell us we have received a multiple of wMaxPacketSize */
  425. if (g_rndis_rx_length < 4) {
  426. g_rndis_rx_length = 0;
  427. }
  428. } else {
  429. USB_LOG_ERR("offset:%ld,remain:%ld,total:%ld\r\n", pmg_offset, g_rndis_rx_length, total_len);
  430. g_rndis_rx_length = 0;
  431. USB_LOG_ERR("Error rndis packet message\r\n");
  432. }
  433. }
  434. } else {
  435. #if CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE <= (16 * 1024)
  436. if (g_rndis_rx_length == CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE) {
  437. #else
  438. if ((g_rndis_rx_length + (16 * 1024)) > CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE) {
  439. #endif
  440. USB_LOG_ERR("Rx packet is overflow, please reduce tcp window size or increase CONFIG_USBHOST_RNDIS_ETH_MAX_RX_SIZE\r\n");
  441. while (1) {
  442. }
  443. }
  444. }
  445. }
  446. // clang-format off
  447. delete:
  448. USB_LOG_INFO("Delete rndis rx thread\r\n");
  449. usb_osal_thread_delete(NULL);
  450. // clang-format on
  451. }
  452. uint8_t *usbh_rndis_get_eth_txbuf(void)
  453. {
  454. return (g_rndis_tx_buffer + sizeof(rndis_data_packet_t));
  455. }
  456. int usbh_rndis_eth_output(uint32_t buflen)
  457. {
  458. rndis_data_packet_t *hdr;
  459. uint32_t len;
  460. if (g_rndis_class.connect_status == false) {
  461. return -USB_ERR_NOTCONN;
  462. }
  463. hdr = (rndis_data_packet_t *)g_rndis_tx_buffer;
  464. memset(hdr, 0, sizeof(rndis_data_packet_t));
  465. hdr->MessageType = REMOTE_NDIS_PACKET_MSG;
  466. hdr->MessageLength = sizeof(rndis_data_packet_t) + buflen;
  467. hdr->DataOffset = sizeof(rndis_data_packet_t) - sizeof(rndis_generic_msg_t);
  468. hdr->DataLength = buflen;
  469. len = hdr->MessageLength;
  470. /* if message length is the multiple of wMaxPacketSize, we should add a short packet to tell device transfer is over. */
  471. if (!(len % g_rndis_class.bulkout->wMaxPacketSize)) {
  472. len += 1;
  473. }
  474. USB_LOG_DBG("txlen:%d\r\n", len);
  475. 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);
  476. return usbh_submit_urb(&g_rndis_class.bulkout_urb);
  477. }
  478. __WEAK void usbh_rndis_run(struct usbh_rndis *rndis_class)
  479. {
  480. (void)rndis_class;
  481. }
  482. __WEAK void usbh_rndis_stop(struct usbh_rndis *rndis_class)
  483. {
  484. (void)rndis_class;
  485. }
  486. static const struct usbh_class_driver rndis_class_driver = {
  487. .driver_name = "rndis",
  488. .connect = usbh_rndis_connect,
  489. .disconnect = usbh_rndis_disconnect
  490. };
  491. CLASS_INFO_DEFINE const struct usbh_class_info rndis_class_info = {
  492. .match_flags = USB_CLASS_MATCH_INTF_CLASS | USB_CLASS_MATCH_INTF_SUBCLASS | USB_CLASS_MATCH_INTF_PROTOCOL,
  493. .bInterfaceClass = USB_DEVICE_CLASS_WIRELESS,
  494. .bInterfaceSubClass = 0x01,
  495. .bInterfaceProtocol = 0x03,
  496. .id_table = NULL,
  497. .class_driver = &rndis_class_driver
  498. };