usb_dc_usbfs.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409
  1. /*
  2. * Copyright (c) 2022, sakumisu
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "usbd_core.h"
  7. #include "usb_ch32_usbfs_reg.h"
  8. #ifdef CONFIG_USB_HS
  9. #error "usb fs do not support hs"
  10. #endif
  11. #ifndef USBD_IRQHandler
  12. #define USBD_IRQHandler OTG_FS_IRQHandler //use actual usb irq name instead
  13. #endif
  14. #ifndef USB_NUM_BIDIR_ENDPOINTS
  15. #define USB_NUM_BIDIR_ENDPOINTS 8
  16. #endif
  17. #define USB_SET_DMA(ep_idx, addr) (*(volatile uint32_t *)((uint32_t)(&USBFS_DEVICE->UEP0_DMA) + 4 * ep_idx) = addr)
  18. #define USB_SET_TX_LEN(ep_idx, len) (*(volatile uint16_t *)((uint32_t)(&USBFS_DEVICE->UEP0_TX_LEN) + 4 * ep_idx) = len)
  19. #define USB_GET_TX_LEN(ep_idx) (*(volatile uint16_t *)((uint32_t)(&USBFS_DEVICE->UEP0_TX_LEN) + 4 * ep_idx))
  20. #define USB_SET_TX_CTRL(ep_idx, val) (*(volatile uint8_t *)((uint32_t)(&USBFS_DEVICE->UEP0_TX_CTRL) + 4 * ep_idx) = val)
  21. #define USB_GET_TX_CTRL(ep_idx) (*(volatile uint8_t *)((uint32_t)(&USBFS_DEVICE->UEP0_TX_CTRL) + 4 * ep_idx))
  22. #define USB_SET_RX_CTRL(ep_idx, val) (*(volatile uint8_t *)((uint32_t)(&USBFS_DEVICE->UEP0_RX_CTRL) + 4 * ep_idx) = val)
  23. #define USB_GET_RX_CTRL(ep_idx) (*(volatile uint8_t *)((uint32_t)(&USBFS_DEVICE->UEP0_RX_CTRL) + 4 * ep_idx))
  24. /* Endpoint state */
  25. struct ch32_usbfs_ep_state {
  26. uint16_t ep_mps; /* Endpoint max packet size */
  27. uint8_t ep_type; /* Endpoint type */
  28. uint8_t ep_stalled; /* Endpoint stall flag */
  29. uint8_t ep_enable; /* Endpoint enable */
  30. uint8_t *xfer_buf;
  31. uint32_t xfer_len;
  32. uint32_t actual_xfer_len;
  33. };
  34. /* Driver state */
  35. struct ch32_usbfs_udc {
  36. __attribute__((aligned(4))) struct usb_setup_packet setup;
  37. volatile uint8_t dev_addr;
  38. struct ch32_usbfs_ep_state in_ep[USB_NUM_BIDIR_ENDPOINTS]; /*!< IN endpoint parameters*/
  39. struct ch32_usbfs_ep_state out_ep[USB_NUM_BIDIR_ENDPOINTS]; /*!< OUT endpoint parameters */
  40. __attribute__((aligned(4))) uint8_t ep_databuf[USB_NUM_BIDIR_ENDPOINTS - 1][64 + 64]; //epx_out(64)+epx_in(64)
  41. } g_ch32_usbfs_udc;
  42. volatile bool ep0_rx_data_toggle;
  43. volatile bool ep0_tx_data_toggle;
  44. void USBD_IRQHandler(void) __attribute__((interrupt("WCH-Interrupt-fast")));
  45. __WEAK void usb_dc_low_level_init(void)
  46. {
  47. }
  48. __WEAK void usb_dc_low_level_deinit(void)
  49. {
  50. }
  51. int usb_dc_init(uint8_t busid)
  52. {
  53. usb_dc_low_level_init();
  54. USBFS_DEVICE->BASE_CTRL = 0x00;
  55. USBFS_DEVICE->UEP4_1_MOD = USBFS_UEP4_RX_EN | USBFS_UEP4_TX_EN | USBFS_UEP1_RX_EN | USBFS_UEP1_TX_EN;
  56. USBFS_DEVICE->UEP2_3_MOD = USBFS_UEP2_RX_EN | USBFS_UEP2_TX_EN | USBFS_UEP3_RX_EN | USBFS_UEP3_TX_EN;
  57. USBFS_DEVICE->UEP5_6_MOD = USBFS_UEP5_RX_EN | USBFS_UEP5_TX_EN | USBFS_UEP6_RX_EN | USBFS_UEP6_TX_EN;
  58. USBFS_DEVICE->UEP7_MOD = USBFS_UEP7_RX_EN | USBFS_UEP7_TX_EN;
  59. USBFS_DEVICE->UEP1_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[0];
  60. USBFS_DEVICE->UEP2_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[1];
  61. USBFS_DEVICE->UEP3_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[2];
  62. USBFS_DEVICE->UEP4_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[3];
  63. USBFS_DEVICE->UEP5_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[4];
  64. USBFS_DEVICE->UEP6_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[5];
  65. USBFS_DEVICE->UEP7_DMA = (uint32_t)g_ch32_usbfs_udc.ep_databuf[6];
  66. USBFS_DEVICE->INT_FG = 0xFF;
  67. USBFS_DEVICE->INT_EN = USBFS_UIE_SUSPEND | USBFS_UIE_BUS_RST | USBFS_UIE_TRANSFER;
  68. USBFS_DEVICE->DEV_ADDR = 0x00;
  69. USBFS_DEVICE->BASE_CTRL = USBFS_UC_DEV_PU_EN | USBFS_UC_INT_BUSY | USBFS_UC_DMA_EN;
  70. USBFS_DEVICE->UDEV_CTRL = USBFS_UD_PD_DIS | USBFS_UD_PORT_EN;
  71. return 0;
  72. }
  73. int usb_dc_deinit(uint8_t busid)
  74. {
  75. return 0;
  76. }
  77. int usbd_set_address(uint8_t busid, const uint8_t addr)
  78. {
  79. if (addr == 0) {
  80. USBFS_DEVICE->DEV_ADDR = (USBFS_DEVICE->DEV_ADDR & USBFS_UDA_GP_BIT) | 0;
  81. }
  82. g_ch32_usbfs_udc.dev_addr = addr;
  83. return 0;
  84. }
  85. int usbd_set_remote_wakeup(uint8_t busid)
  86. {
  87. return -1;
  88. }
  89. uint8_t usbd_get_port_speed(uint8_t busid)
  90. {
  91. return USB_SPEED_FULL;
  92. }
  93. int usbd_ep_open(uint8_t busid, const struct usb_endpoint_descriptor *ep)
  94. {
  95. uint8_t ep_idx = USB_EP_GET_IDX(ep->bEndpointAddress);
  96. if (USB_EP_DIR_IS_OUT(ep->bEndpointAddress)) {
  97. g_ch32_usbfs_udc.out_ep[ep_idx].ep_mps = USB_GET_MAXPACKETSIZE(ep->wMaxPacketSize);
  98. g_ch32_usbfs_udc.out_ep[ep_idx].ep_type = USB_GET_ENDPOINT_TYPE(ep->bmAttributes);
  99. g_ch32_usbfs_udc.out_ep[ep_idx].ep_enable = true;
  100. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_NAK | USBFS_UEP_AUTO_TOG);
  101. } else {
  102. g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps = USB_GET_MAXPACKETSIZE(ep->wMaxPacketSize);
  103. g_ch32_usbfs_udc.in_ep[ep_idx].ep_type = USB_GET_ENDPOINT_TYPE(ep->bmAttributes);
  104. g_ch32_usbfs_udc.in_ep[ep_idx].ep_enable = true;
  105. USB_SET_TX_CTRL(ep_idx, USBFS_UEP_T_RES_NAK | USBFS_UEP_AUTO_TOG);
  106. }
  107. return 0;
  108. }
  109. int usbd_ep_close(uint8_t busid, const uint8_t ep)
  110. {
  111. return 0;
  112. }
  113. int usbd_ep_set_stall(uint8_t busid, const uint8_t ep)
  114. {
  115. uint8_t ep_idx = USB_EP_GET_IDX(ep);
  116. if (USB_EP_DIR_IS_OUT(ep)) {
  117. if (ep_idx == 0) {
  118. USBFS_DEVICE->UEP0_RX_CTRL = USBFS_UEP_R_TOG | USBFS_UEP_R_RES_STALL;
  119. } else {
  120. USB_SET_RX_CTRL(ep_idx, (USB_GET_RX_CTRL(ep_idx) & ~USBFS_UEP_R_RES_MASK) | USBFS_UEP_R_RES_STALL);
  121. }
  122. } else {
  123. if (ep_idx == 0) {
  124. USBFS_DEVICE->UEP0_TX_CTRL = USBFS_UEP_T_TOG | USBFS_UEP_T_RES_STALL;
  125. } else {
  126. USB_SET_TX_CTRL(ep_idx, (USB_GET_TX_CTRL(ep_idx) & ~USBFS_UEP_T_RES_MASK) | USBFS_UEP_T_RES_STALL);
  127. }
  128. }
  129. if (ep_idx == 0) {
  130. USB_SET_DMA(ep_idx, (uint32_t)&g_ch32_usbfs_udc.setup);
  131. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  132. }
  133. return 0;
  134. }
  135. int usbd_ep_clear_stall(uint8_t busid, const uint8_t ep)
  136. {
  137. uint8_t ep_idx = USB_EP_GET_IDX(ep);
  138. if (ep_idx == 0) {
  139. return 0;
  140. }
  141. if (USB_EP_DIR_IS_OUT(ep)) {
  142. USB_SET_RX_CTRL(ep_idx, (USB_GET_RX_CTRL(ep_idx) & ~(USBFS_UEP_R_TOG | USBFS_UEP_R_RES_MASK)) | USBFS_UEP_R_RES_ACK);
  143. } else {
  144. USB_SET_TX_CTRL(ep_idx, (USB_GET_TX_CTRL(ep_idx) & ~(USBFS_UEP_T_TOG | USBFS_UEP_T_RES_MASK)) | USBFS_UEP_T_RES_NAK);
  145. }
  146. return 0;
  147. }
  148. int usbd_ep_is_stalled(uint8_t busid, const uint8_t ep, uint8_t *stalled)
  149. {
  150. return 0;
  151. }
  152. int usbd_ep_start_write(uint8_t busid, const uint8_t ep, const uint8_t *data, uint32_t data_len)
  153. {
  154. uint8_t ep_idx = USB_EP_GET_IDX(ep);
  155. if (!data && data_len) {
  156. return -1;
  157. }
  158. if (!g_ch32_usbfs_udc.in_ep[ep_idx].ep_enable) {
  159. return -2;
  160. }
  161. if ((uint32_t)data & 0x03) {
  162. printf("data do not align4\r\n");
  163. return -3;
  164. }
  165. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_buf = (uint8_t *)data;
  166. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len = data_len;
  167. g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len = 0;
  168. if (ep_idx == 0) {
  169. if (data_len == 0) {
  170. USB_SET_TX_LEN(ep_idx, 0);
  171. } else {
  172. data_len = MIN(data_len, g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps);
  173. USB_SET_TX_LEN(ep_idx, data_len);
  174. USB_SET_DMA(ep_idx, (uint32_t)data);
  175. }
  176. if (ep0_tx_data_toggle) {
  177. USB_SET_TX_CTRL(ep_idx, USBFS_UEP_T_TOG | USBFS_UEP_T_RES_ACK);
  178. } else {
  179. USB_SET_TX_CTRL(ep_idx, USBFS_UEP_T_RES_ACK);
  180. }
  181. } else {
  182. if (data_len == 0) {
  183. USB_SET_TX_LEN(ep_idx, 0);
  184. } else {
  185. data_len = MIN(data_len, g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps);
  186. USB_SET_TX_LEN(ep_idx, data_len);
  187. memcpy(&g_ch32_usbfs_udc.ep_databuf[ep_idx - 1][64], data, data_len);
  188. }
  189. USB_SET_TX_CTRL(ep_idx, (USB_GET_TX_CTRL(ep_idx) & ~USBFS_UEP_T_RES_MASK) | USBFS_UEP_T_RES_ACK);
  190. }
  191. return 0;
  192. }
  193. int usbd_ep_start_read(uint8_t busid, const uint8_t ep, uint8_t *data, uint32_t data_len)
  194. {
  195. uint8_t ep_idx = USB_EP_GET_IDX(ep);
  196. if (!data && data_len) {
  197. return -1;
  198. }
  199. if (!g_ch32_usbfs_udc.out_ep[ep_idx].ep_enable) {
  200. return -2;
  201. }
  202. if ((uint32_t)data & 0x03) {
  203. printf("data do not align4\r\n");
  204. return -3;
  205. }
  206. g_ch32_usbfs_udc.out_ep[ep_idx].xfer_buf = (uint8_t *)data;
  207. g_ch32_usbfs_udc.out_ep[ep_idx].xfer_len = data_len;
  208. g_ch32_usbfs_udc.out_ep[ep_idx].actual_xfer_len = 0;
  209. if (ep_idx == 0) {
  210. if (data_len == 0) {
  211. } else {
  212. USB_SET_DMA(ep_idx, (uint32_t)data);
  213. }
  214. if (ep0_rx_data_toggle) {
  215. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_TOG | USBFS_UEP_R_RES_ACK);
  216. } else {
  217. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  218. }
  219. return 0;
  220. } else {
  221. USB_SET_RX_CTRL(ep_idx, (USB_GET_RX_CTRL(ep_idx) & ~USBFS_UEP_R_RES_MASK) | USBFS_UEP_R_RES_ACK);
  222. }
  223. return 0;
  224. }
  225. void USBD_IRQHandler(void)
  226. {
  227. uint32_t ep_idx = 0, token, write_count, read_count;
  228. uint8_t intflag = 0;
  229. intflag = USBFS_DEVICE->INT_FG;
  230. if (intflag & USBFS_UIF_TRANSFER) {
  231. token = USBFS_DEVICE->INT_ST & USBFS_UIS_TOKEN_MASK;
  232. ep_idx = USBFS_DEVICE->INT_ST & USBFS_UIS_ENDP_MASK;
  233. switch (token) {
  234. case USBFS_UIS_TOKEN_SETUP:
  235. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_NAK);
  236. usbd_event_ep0_setup_complete_handler(0, (uint8_t *)&g_ch32_usbfs_udc.setup);
  237. break;
  238. case USBFS_UIS_TOKEN_IN:
  239. if (ep_idx == 0x00) {
  240. if (g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len >= g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps) {
  241. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len -= g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps;
  242. g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len += g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps;
  243. ep0_tx_data_toggle ^= 1;
  244. } else {
  245. g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len += g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len;
  246. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len = 0;
  247. ep0_tx_data_toggle = true;
  248. }
  249. usbd_event_ep_in_complete_handler(0, ep_idx | 0x80, g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len);
  250. if (g_ch32_usbfs_udc.dev_addr > 0) {
  251. USBFS_DEVICE->DEV_ADDR = (USBFS_DEVICE->DEV_ADDR & USBFS_UDA_GP_BIT) | g_ch32_usbfs_udc.dev_addr;
  252. g_ch32_usbfs_udc.dev_addr = 0;
  253. }
  254. if (g_ch32_usbfs_udc.setup.wLength && ((g_ch32_usbfs_udc.setup.bmRequestType & USB_REQUEST_DIR_MASK) == USB_REQUEST_DIR_OUT)) {
  255. /* In status, start reading setup */
  256. USB_SET_DMA(ep_idx, (uint32_t)&g_ch32_usbfs_udc.setup);
  257. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  258. ep0_tx_data_toggle = true;
  259. } else if (g_ch32_usbfs_udc.setup.wLength == 0) {
  260. /* In status, start reading setup */
  261. USB_SET_DMA(ep_idx, (uint32_t)&g_ch32_usbfs_udc.setup);
  262. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  263. ep0_tx_data_toggle = true;
  264. }
  265. } else {
  266. USB_SET_TX_CTRL(ep_idx, (USB_GET_TX_CTRL(ep_idx) & ~USBFS_UEP_T_RES_MASK) | USBFS_UEP_T_RES_NAK);
  267. if (g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len > g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps) {
  268. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_buf += g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps;
  269. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len -= g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps;
  270. g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len += g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps;
  271. write_count = MIN(g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len, g_ch32_usbfs_udc.in_ep[ep_idx].ep_mps);
  272. USB_SET_TX_LEN(ep_idx, write_count);
  273. memcpy(&g_ch32_usbfs_udc.ep_databuf[ep_idx - 1][64], g_ch32_usbfs_udc.in_ep[ep_idx].xfer_buf, write_count);
  274. USB_SET_TX_CTRL(ep_idx, (USB_GET_TX_CTRL(ep_idx) & ~USBFS_UEP_T_RES_MASK) | USBFS_UEP_T_RES_ACK);
  275. } else {
  276. g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len += g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len;
  277. g_ch32_usbfs_udc.in_ep[ep_idx].xfer_len = 0;
  278. usbd_event_ep_in_complete_handler(0, ep_idx | 0x80, g_ch32_usbfs_udc.in_ep[ep_idx].actual_xfer_len);
  279. }
  280. }
  281. break;
  282. case USBFS_UIS_TOKEN_OUT:
  283. if (ep_idx == 0x00) {
  284. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_NAK);
  285. read_count = USBFS_DEVICE->RX_LEN;
  286. g_ch32_usbfs_udc.out_ep[ep_idx].actual_xfer_len += read_count;
  287. g_ch32_usbfs_udc.out_ep[ep_idx].xfer_len -= read_count;
  288. usbd_event_ep_out_complete_handler(0, 0x00, g_ch32_usbfs_udc.out_ep[ep_idx].actual_xfer_len);
  289. if (read_count == 0) {
  290. /* Out status, start reading setup */
  291. USB_SET_DMA(ep_idx, (uint32_t)&g_ch32_usbfs_udc.setup);
  292. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  293. ep0_rx_data_toggle = true;
  294. ep0_tx_data_toggle = true;
  295. } else {
  296. ep0_rx_data_toggle ^= 1;
  297. }
  298. } else {
  299. if (USBFS_DEVICE->INT_ST & USBFS_UIS_TOG_OK) {
  300. USB_SET_RX_CTRL(ep_idx, (USB_GET_RX_CTRL(ep_idx) & ~USBFS_UEP_R_RES_MASK) | USBFS_UEP_R_RES_NAK);
  301. read_count = USBFS_DEVICE->RX_LEN;
  302. memcpy(g_ch32_usbfs_udc.out_ep[ep_idx].xfer_buf, &g_ch32_usbfs_udc.ep_databuf[ep_idx - 1][0], read_count);
  303. g_ch32_usbfs_udc.out_ep[ep_idx].xfer_buf += read_count;
  304. g_ch32_usbfs_udc.out_ep[ep_idx].actual_xfer_len += read_count;
  305. g_ch32_usbfs_udc.out_ep[ep_idx].xfer_len -= read_count;
  306. if ((read_count < g_ch32_usbfs_udc.out_ep[ep_idx].ep_mps) || (g_ch32_usbfs_udc.out_ep[ep_idx].xfer_len == 0)) {
  307. usbd_event_ep_out_complete_handler(0, ep_idx, g_ch32_usbfs_udc.out_ep[ep_idx].actual_xfer_len);
  308. } else {
  309. USB_SET_RX_CTRL(ep_idx, (USB_GET_RX_CTRL(ep_idx) & ~USBFS_UEP_R_RES_MASK) | USBFS_UEP_R_RES_ACK);
  310. }
  311. }
  312. }
  313. break;
  314. case USBFS_UIS_TOKEN_SOF:
  315. break;
  316. default:
  317. break;
  318. }
  319. USBFS_DEVICE->INT_FG = USBFS_UIF_TRANSFER;
  320. } else if (intflag & USBFS_UIF_BUS_RST) {
  321. USBFS_DEVICE->UEP0_TX_LEN = 0;
  322. USBFS_DEVICE->UEP0_TX_CTRL = USBFS_UEP_T_RES_NAK;
  323. USBFS_DEVICE->UEP0_RX_CTRL = USBFS_UEP_R_RES_NAK;
  324. for (uint8_t ep_idx = 1; ep_idx < USB_NUM_BIDIR_ENDPOINTS; ep_idx++) {
  325. USB_SET_TX_LEN(ep_idx, 0);
  326. USB_SET_TX_CTRL(ep_idx, USBFS_UEP_T_RES_NAK | USBFS_UEP_AUTO_TOG);
  327. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_NAK | USBFS_UEP_AUTO_TOG);
  328. }
  329. ep0_tx_data_toggle = true;
  330. ep0_rx_data_toggle = true;
  331. memset(&g_ch32_usbfs_udc, 0, sizeof(struct ch32_usbfs_udc));
  332. usbd_event_reset_handler(0);
  333. USB_SET_DMA(ep_idx, (uint32_t)&g_ch32_usbfs_udc.setup);
  334. USB_SET_RX_CTRL(ep_idx, USBFS_UEP_R_RES_ACK);
  335. USBFS_DEVICE->INT_FG |= USBFS_UIF_BUS_RST;
  336. } else if (intflag & USBFS_UIF_SUSPEND) {
  337. if (USBFS_DEVICE->MIS_ST & USBFS_UMS_SUSPEND) {
  338. } else {
  339. }
  340. USBFS_DEVICE->INT_FG = USBFS_UIF_SUSPEND;
  341. } else {
  342. USBFS_DEVICE->INT_FG = intflag;
  343. }
  344. }