drv_usbotgd.c 7.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311
  1. /*
  2. * Copyright (c) 2006-2021, RT-Thread Development Team
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. *
  6. * Change Logs:
  7. * Date Author Notes
  8. * 2023-02-28 leo first version
  9. */
  10. #include <rtthread.h>
  11. #include <rtdevice.h>
  12. #include "drv_common.h"
  13. #if defined(BSP_USING_DEVICE_USBOTG1) || defined(BSP_USING_DEVICE_USBOTG2)
  14. #include "usbd_int.h"
  15. #include "drv_usbotg.h"
  16. #include "drv_config.h"
  17. static struct at32_usbotg *p_usbotg_instance = RT_NULL;
  18. static struct ep_id endpoint_pool[] =
  19. {
  20. {0x0, USB_EP_ATTR_CONTROL, USB_DIR_INOUT, 64, ID_ASSIGNED },
  21. {0x1, USB_EP_ATTR_BULK, USB_DIR_IN, 64, ID_UNASSIGNED},
  22. {0x1, USB_EP_ATTR_BULK, USB_DIR_OUT, 64, ID_UNASSIGNED},
  23. {0x2, USB_EP_ATTR_INT, USB_DIR_IN, 64, ID_UNASSIGNED},
  24. {0x2, USB_EP_ATTR_INT, USB_DIR_OUT, 64, ID_UNASSIGNED},
  25. {0x3, USB_EP_ATTR_ISOC, USB_DIR_IN, 64, ID_UNASSIGNED},
  26. {0x3, USB_EP_ATTR_ISOC, USB_DIR_OUT, 64, ID_UNASSIGNED},
  27. {0xFF, USB_EP_ATTR_TYPE_MASK, USB_DIR_MASK, 0, ID_ASSIGNED },
  28. };
  29. enum
  30. {
  31. #ifdef BSP_USING_DEVICE_USBOTG1
  32. USBOTG1_INDEX,
  33. #endif
  34. #ifdef BSP_USING_DEVICE_USBOTG2
  35. USBOTG2_INDEX,
  36. #endif
  37. };
  38. static struct at32_usbotg usbotgd_config[] = {
  39. #ifdef BSP_USING_DEVICE_USBOTG1
  40. USBOTG1_CONFIG,
  41. #endif
  42. #ifdef BSP_USING_DEVICE_USBOTG2
  43. USBOTG2_CONFIG,
  44. #endif
  45. };
  46. #ifdef BSP_USING_DEVICE_USBOTG1
  47. void OTGFS1_IRQHandler(void)
  48. {
  49. /* enter interrupt */
  50. rt_interrupt_enter();
  51. usbd_irq_handler(p_usbotg_instance->p_otg_core);
  52. /* leave interrupt */
  53. rt_interrupt_leave();
  54. }
  55. #endif
  56. #ifdef BSP_USING_DEVICE_USBOTG2
  57. void OTGFS2_IRQHandler(void)
  58. {
  59. /* enter interrupt */
  60. rt_interrupt_enter();
  61. usbd_irq_handler(p_usbotg_instance->p_otg_core);
  62. /* leave interrupt */
  63. rt_interrupt_leave();
  64. }
  65. #endif
  66. void usbd_reset_callback(usbd_core_type *udev)
  67. {
  68. udcd_t udcd = (udcd_t)udev->pdata;
  69. rt_usbd_reset_handler(udcd);
  70. }
  71. void usbd_connectCallback(usbd_core_type *udev)
  72. {
  73. udcd_t udcd = (udcd_t)udev->pdata;
  74. rt_usbd_connect_handler(udcd);
  75. }
  76. void usbd_disconnectCallback(usbd_core_type *udev)
  77. {
  78. udcd_t udcd = (udcd_t)udev->pdata;
  79. rt_usbd_disconnect_handler(udcd);
  80. }
  81. void usbd_setup_phase_done_callback(usbd_core_type *udev)
  82. {
  83. udcd_t udcd = (udcd_t)udev->pdata;
  84. rt_usbd_ep0_setup_handler(udcd, (struct urequest*)udev->setup_buffer);
  85. }
  86. void usbd_data_in_stage_callback(usbd_core_type *udev, uint32_t ept_num)
  87. {
  88. udcd_t udcd = (udcd_t)udev->pdata;
  89. if (ept_num == 0)
  90. {
  91. rt_usbd_ep0_in_handler(udcd);
  92. }
  93. else
  94. {
  95. rt_usbd_ep_in_handler(udcd, 0x80 | ept_num, udev->ept_in[ept_num].trans_len);
  96. }
  97. }
  98. void usbd_sof_callback(usbd_core_type *udev)
  99. {
  100. udcd_t udcd = (udcd_t)udev->pdata;
  101. rt_usbd_sof_handler(udcd);
  102. }
  103. void usbd_data_out_stage_callback(usbd_core_type *udev, uint32_t ept_num)
  104. {
  105. udcd_t udcd = (udcd_t)udev->pdata;
  106. if (ept_num != 0)
  107. {
  108. rt_usbd_ep_out_handler(udcd, ept_num, udev->ept_out[ept_num].trans_len);
  109. }
  110. else
  111. {
  112. rt_usbd_ep0_out_handler(udcd, udev->ept_out[0].trans_len);
  113. }
  114. }
  115. static rt_err_t _ep_set_stall(rt_uint8_t address)
  116. {
  117. usbd_set_stall(&p_usbotg_instance->p_otg_core->dev, address);
  118. return RT_EOK;
  119. }
  120. static rt_err_t _ep_clear_stall(rt_uint8_t address)
  121. {
  122. usbd_clear_stall(&p_usbotg_instance->p_otg_core->dev, address);
  123. return RT_EOK;
  124. }
  125. static rt_err_t _set_address(rt_uint8_t address)
  126. {
  127. usbd_set_device_addr(&p_usbotg_instance->p_otg_core->dev, address);
  128. return RT_EOK;
  129. }
  130. static rt_err_t _set_config(rt_uint8_t address)
  131. {
  132. return RT_EOK;
  133. }
  134. static rt_err_t _ep_enable(uep_t ep)
  135. {
  136. RT_ASSERT(ep != RT_NULL);
  137. RT_ASSERT(ep->ep_desc != RT_NULL);
  138. usbd_ept_open(&p_usbotg_instance->p_otg_core->dev, ep->ep_desc->bEndpointAddress, \
  139. ep->ep_desc->bmAttributes, ep->ep_desc->wMaxPacketSize);
  140. return RT_EOK;
  141. }
  142. static rt_err_t _ep_disable(uep_t ep)
  143. {
  144. RT_ASSERT(ep != RT_NULL);
  145. RT_ASSERT(ep->ep_desc != RT_NULL);
  146. usbd_ept_close(&p_usbotg_instance->p_otg_core->dev, ep->ep_desc->bEndpointAddress);
  147. return RT_EOK;
  148. }
  149. static rt_size_t _ep_read(rt_uint8_t address, void *buffer)
  150. {
  151. rt_size_t size = 0;
  152. RT_ASSERT(buffer != RT_NULL);
  153. return size;
  154. }
  155. static rt_size_t _ep_read_prepare(rt_uint8_t address, void *buffer, rt_size_t size)
  156. {
  157. usbd_ept_recv(&p_usbotg_instance->p_otg_core->dev, address, buffer, size);
  158. return size;
  159. }
  160. static rt_size_t _ep_write(rt_uint8_t address, void *buffer, rt_size_t size)
  161. {
  162. usbd_ept_send(&p_usbotg_instance->p_otg_core->dev, address, buffer, size);
  163. return size;
  164. }
  165. static rt_err_t _ep0_send_status(void)
  166. {
  167. usbd_ept_send(&p_usbotg_instance->p_otg_core->dev, 0x00, RT_NULL, 0);
  168. return RT_EOK;
  169. }
  170. static rt_err_t _suspend(void)
  171. {
  172. return RT_EOK;
  173. }
  174. static rt_err_t _wakeup(void)
  175. {
  176. return RT_EOK;
  177. }
  178. static rt_err_t at32_dcd_init(rt_device_t device)
  179. {
  180. /* usb gpio config */
  181. at32_msp_usb_init(device);
  182. /* enable otgfs irq */
  183. nvic_irq_enable(p_usbotg_instance->irqn, 2, 0);
  184. /* init usb */
  185. p_usbotg_instance->p_otg_core->usb_reg = usb_global_select_core(p_usbotg_instance->id);
  186. /* usb device core config */
  187. usb_core_config(p_usbotg_instance->p_otg_core, p_usbotg_instance->dev_spd);
  188. if(p_usbotg_instance->p_otg_core->cfg.sof_out)
  189. {
  190. p_usbotg_instance->p_otg_core->usb_reg->gccfg_bit.sofouten = TRUE;
  191. }
  192. if(p_usbotg_instance->p_otg_core->cfg.vbusig)
  193. {
  194. p_usbotg_instance->p_otg_core->usb_reg->gccfg_bit.vbusig = TRUE;
  195. }
  196. /* usb device core init */
  197. usbd_core_init(&(p_usbotg_instance->p_otg_core->dev), p_usbotg_instance->p_otg_core->usb_reg,
  198. p_usbotg_instance->dev_spd);
  199. return RT_EOK;
  200. }
  201. const static struct udcd_ops _udc_ops =
  202. {
  203. _set_address,
  204. _set_config,
  205. _ep_set_stall,
  206. _ep_clear_stall,
  207. _ep_enable,
  208. _ep_disable,
  209. _ep_read_prepare,
  210. _ep_read,
  211. _ep_write,
  212. _ep0_send_status,
  213. _suspend,
  214. _wakeup,
  215. };
  216. int at32_usbd_register(void)
  217. {
  218. rt_size_t obj_num;
  219. rt_err_t result = 0;
  220. int index;
  221. obj_num = sizeof(usbotgd_config) / sizeof(struct at32_usbotg);
  222. for (index = 0; index < obj_num; index++) {
  223. udcd_t udcd = (udcd_t)rt_malloc(sizeof(struct udcd));
  224. if (udcd == RT_NULL)
  225. {
  226. rt_kprintf("uhcd malloc failed\r\n");
  227. return -RT_ERROR;
  228. }
  229. rt_memset((void *)udcd, 0, sizeof(struct udcd));
  230. otg_core_type *p_otg_core = (otg_core_type *)rt_malloc(sizeof(otg_core_type));
  231. if (p_otg_core == RT_NULL)
  232. {
  233. rt_kprintf("otg_core malloc failed\r\n");
  234. return -RT_ERROR;
  235. }
  236. rt_memset((void *)p_otg_core, 0, sizeof(otg_core_type));
  237. udcd->parent.type = RT_Device_Class_USBDevice;
  238. udcd->parent.init = at32_dcd_init;
  239. udcd->parent.user_data = &(p_otg_core->dev);
  240. udcd->ops = &_udc_ops;
  241. p_otg_core->dev.pdata = udcd;
  242. usbotgd_config[index].p_otg_core = p_otg_core;
  243. /* register endpoint infomation */
  244. udcd->ep_pool = endpoint_pool;
  245. udcd->ep0.id = &endpoint_pool[0];
  246. result = rt_device_register((rt_device_t)udcd, usbotgd_config[index].name, 0);
  247. RT_ASSERT(result == RT_EOK);
  248. p_usbotg_instance = &usbotgd_config[index];
  249. result = rt_usb_device_init();
  250. RT_ASSERT(result == RT_EOK);
  251. }
  252. return result;
  253. }
  254. INIT_DEVICE_EXPORT(at32_usbd_register);
  255. #endif