usb_osal_rtthread.c 4.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207
  1. /*
  2. * Copyright (c) 2022, sakumisu
  3. *
  4. * SPDX-License-Identifier: Apache-2.0
  5. */
  6. #include "usb_osal.h"
  7. #include "usb_errno.h"
  8. #include "usb_config.h"
  9. #include "usb_log.h"
  10. #include <rtthread.h>
  11. #include <rthw.h>
  12. usb_osal_thread_t usb_osal_thread_create(const char *name, uint32_t stack_size, uint32_t prio, usb_thread_entry_t entry, void *args)
  13. {
  14. rt_thread_t htask;
  15. htask = rt_thread_create(name, entry, args, stack_size, prio, 10);
  16. if (htask == NULL) {
  17. USB_LOG_ERR("Create thread %s failed\r\n", name);
  18. while (1) {
  19. }
  20. }
  21. rt_thread_startup(htask);
  22. return (usb_osal_thread_t)htask;
  23. }
  24. void usb_osal_thread_delete(usb_osal_thread_t thread)
  25. {
  26. if (thread == NULL) {
  27. rt_thread_t self = rt_thread_self();
  28. rt_thread_control(self, RT_THREAD_CTRL_CLOSE, RT_NULL);
  29. return;
  30. }
  31. rt_thread_delete(thread);
  32. }
  33. usb_osal_sem_t usb_osal_sem_create(uint32_t initial_count)
  34. {
  35. usb_osal_sem_t sem = (usb_osal_sem_t)rt_sem_create("usbh_sem", initial_count, RT_IPC_FLAG_FIFO);
  36. if (sem == NULL) {
  37. USB_LOG_ERR("Create semaphore failed\r\n");
  38. while (1) {
  39. }
  40. }
  41. return sem;
  42. }
  43. void usb_osal_sem_delete(usb_osal_sem_t sem)
  44. {
  45. rt_sem_delete((rt_sem_t)sem);
  46. }
  47. int usb_osal_sem_take(usb_osal_sem_t sem, uint32_t timeout)
  48. {
  49. int ret = 0;
  50. rt_err_t result = RT_EOK;
  51. if (timeout == USB_OSAL_WAITING_FOREVER) {
  52. result = rt_sem_take((rt_sem_t)sem, RT_WAITING_FOREVER);
  53. } else {
  54. result = rt_sem_take((rt_sem_t)sem, rt_tick_from_millisecond(timeout));
  55. }
  56. if (result == -RT_ETIMEOUT) {
  57. ret = -USB_ERR_TIMEOUT;
  58. } else if (result == -RT_ERROR) {
  59. ret = -USB_ERR_INVAL;
  60. } else {
  61. ret = 0;
  62. }
  63. return (int)ret;
  64. }
  65. int usb_osal_sem_give(usb_osal_sem_t sem)
  66. {
  67. return (int)rt_sem_release((rt_sem_t)sem);
  68. }
  69. void usb_osal_sem_reset(usb_osal_sem_t sem)
  70. {
  71. rt_sem_control((rt_sem_t)sem, RT_IPC_CMD_RESET, (void *)0);
  72. }
  73. usb_osal_mutex_t usb_osal_mutex_create(void)
  74. {
  75. usb_osal_mutex_t mutex = (usb_osal_mutex_t)rt_mutex_create("usbh_mutex", RT_IPC_FLAG_FIFO);
  76. if (mutex == NULL) {
  77. USB_LOG_ERR("Create mutex failed\r\n");
  78. while (1) {
  79. }
  80. }
  81. return mutex;
  82. }
  83. void usb_osal_mutex_delete(usb_osal_mutex_t mutex)
  84. {
  85. rt_mutex_delete((rt_mutex_t)mutex);
  86. }
  87. int usb_osal_mutex_take(usb_osal_mutex_t mutex)
  88. {
  89. return (int)rt_mutex_take((rt_mutex_t)mutex, RT_WAITING_FOREVER);
  90. }
  91. int usb_osal_mutex_give(usb_osal_mutex_t mutex)
  92. {
  93. return (int)rt_mutex_release((rt_mutex_t)mutex);
  94. }
  95. usb_osal_mq_t usb_osal_mq_create(uint32_t max_msgs)
  96. {
  97. return (usb_osal_mq_t)rt_mq_create("usbh_mq", sizeof(uintptr_t), max_msgs, RT_IPC_FLAG_FIFO);
  98. }
  99. void usb_osal_mq_delete(usb_osal_mq_t mq)
  100. {
  101. rt_mq_delete((rt_mq_t)mq);
  102. }
  103. int usb_osal_mq_send(usb_osal_mq_t mq, uintptr_t addr)
  104. {
  105. return rt_mq_send((rt_mq_t)mq, &addr, sizeof(uintptr_t));
  106. }
  107. int usb_osal_mq_recv(usb_osal_mq_t mq, uintptr_t *addr, uint32_t timeout)
  108. {
  109. int ret = 0;
  110. rt_err_t result = RT_EOK;
  111. if (timeout == USB_OSAL_WAITING_FOREVER) {
  112. result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), RT_WAITING_FOREVER);
  113. } else {
  114. result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), rt_tick_from_millisecond(timeout));
  115. }
  116. if (result == -RT_ETIMEOUT) {
  117. ret = -USB_ERR_TIMEOUT;
  118. } else if (result == -RT_ERROR) {
  119. ret = -USB_ERR_INVAL;
  120. } else {
  121. ret = 0;
  122. }
  123. return (int)ret;
  124. }
  125. struct usb_osal_timer *usb_osal_timer_create(const char *name, uint32_t timeout_ms, usb_timer_handler_t handler, void *argument, bool is_period)
  126. {
  127. struct usb_osal_timer *timer;
  128. timer = rt_malloc(sizeof(struct usb_osal_timer));
  129. if (timer == NULL) {
  130. USB_LOG_ERR("Create usb_osal_timer failed\r\n");
  131. while (1) {
  132. }
  133. }
  134. memset(timer, 0, sizeof(struct usb_osal_timer));
  135. timer->timer = (void *)rt_timer_create(name, handler, argument, timeout_ms, is_period ? (RT_TIMER_FLAG_PERIODIC | RT_TIMER_FLAG_SOFT_TIMER) : (RT_TIMER_FLAG_ONE_SHOT | RT_TIMER_FLAG_SOFT_TIMER));
  136. if (timer->timer == NULL) {
  137. USB_LOG_ERR("Create timer failed\r\n");
  138. while (1) {
  139. }
  140. }
  141. return timer;
  142. }
  143. void usb_osal_timer_delete(struct usb_osal_timer *timer)
  144. {
  145. rt_timer_stop(timer->timer);
  146. rt_timer_delete(timer->timer);
  147. rt_free(timer);
  148. }
  149. void usb_osal_timer_start(struct usb_osal_timer *timer)
  150. {
  151. rt_timer_start(timer->timer);
  152. }
  153. void usb_osal_timer_stop(struct usb_osal_timer *timer)
  154. {
  155. rt_timer_stop(timer->timer);
  156. }
  157. size_t usb_osal_enter_critical_section(void)
  158. {
  159. return rt_hw_interrupt_disable();
  160. }
  161. void usb_osal_leave_critical_section(size_t flag)
  162. {
  163. rt_hw_interrupt_enable(flag);
  164. }
  165. void usb_osal_msleep(uint32_t delay)
  166. {
  167. rt_thread_mdelay(delay);
  168. }
  169. void *usb_osal_malloc(size_t size)
  170. {
  171. return rt_malloc(size);
  172. }
  173. void usb_osal_free(void *ptr)
  174. {
  175. rt_free(ptr);
  176. }