usb_osal_rtthread.c 4.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205
  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. return;
  28. }
  29. rt_thread_delete(thread);
  30. }
  31. usb_osal_sem_t usb_osal_sem_create(uint32_t initial_count)
  32. {
  33. usb_osal_sem_t sem = (usb_osal_sem_t)rt_sem_create("usbh_sem", initial_count, RT_IPC_FLAG_FIFO);
  34. if (sem == NULL) {
  35. USB_LOG_ERR("Create semaphore failed\r\n");
  36. while (1) {
  37. }
  38. }
  39. return sem;
  40. }
  41. void usb_osal_sem_delete(usb_osal_sem_t sem)
  42. {
  43. rt_sem_delete((rt_sem_t)sem);
  44. }
  45. int usb_osal_sem_take(usb_osal_sem_t sem, uint32_t timeout)
  46. {
  47. int ret = 0;
  48. rt_err_t result = RT_EOK;
  49. if (timeout == USB_OSAL_WAITING_FOREVER) {
  50. result = rt_sem_take((rt_sem_t)sem, RT_WAITING_FOREVER);
  51. } else {
  52. result = rt_sem_take((rt_sem_t)sem, rt_tick_from_millisecond(timeout));
  53. }
  54. if (result == -RT_ETIMEOUT) {
  55. ret = -USB_ERR_TIMEOUT;
  56. } else if (result == -RT_ERROR) {
  57. ret = -USB_ERR_INVAL;
  58. } else {
  59. ret = 0;
  60. }
  61. return (int)ret;
  62. }
  63. int usb_osal_sem_give(usb_osal_sem_t sem)
  64. {
  65. return (int)rt_sem_release((rt_sem_t)sem);
  66. }
  67. void usb_osal_sem_reset(usb_osal_sem_t sem)
  68. {
  69. rt_sem_control((rt_sem_t)sem, RT_IPC_CMD_RESET, (void *)0);
  70. }
  71. usb_osal_mutex_t usb_osal_mutex_create(void)
  72. {
  73. usb_osal_mutex_t mutex = (usb_osal_mutex_t)rt_mutex_create("usbh_mutex", RT_IPC_FLAG_FIFO);
  74. if (mutex == NULL) {
  75. USB_LOG_ERR("Create mutex failed\r\n");
  76. while (1) {
  77. }
  78. }
  79. return mutex;
  80. }
  81. void usb_osal_mutex_delete(usb_osal_mutex_t mutex)
  82. {
  83. rt_mutex_delete((rt_mutex_t)mutex);
  84. }
  85. int usb_osal_mutex_take(usb_osal_mutex_t mutex)
  86. {
  87. return (int)rt_mutex_take((rt_mutex_t)mutex, RT_WAITING_FOREVER);
  88. }
  89. int usb_osal_mutex_give(usb_osal_mutex_t mutex)
  90. {
  91. return (int)rt_mutex_release((rt_mutex_t)mutex);
  92. }
  93. usb_osal_mq_t usb_osal_mq_create(uint32_t max_msgs)
  94. {
  95. return (usb_osal_mq_t)rt_mq_create("usbh_mq", sizeof(uintptr_t), max_msgs, RT_IPC_FLAG_FIFO);
  96. }
  97. void usb_osal_mq_delete(usb_osal_mq_t mq)
  98. {
  99. rt_mq_delete((rt_mq_t)mq);
  100. }
  101. int usb_osal_mq_send(usb_osal_mq_t mq, uintptr_t addr)
  102. {
  103. return rt_mq_send((rt_mq_t)mq, &addr, sizeof(uintptr_t));
  104. }
  105. int usb_osal_mq_recv(usb_osal_mq_t mq, uintptr_t *addr, uint32_t timeout)
  106. {
  107. int ret = 0;
  108. rt_err_t result = RT_EOK;
  109. if (timeout == USB_OSAL_WAITING_FOREVER) {
  110. result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), RT_WAITING_FOREVER);
  111. } else {
  112. result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), rt_tick_from_millisecond(timeout));
  113. }
  114. if (result == -RT_ETIMEOUT) {
  115. ret = -USB_ERR_TIMEOUT;
  116. } else if (result == -RT_ERROR) {
  117. ret = -USB_ERR_INVAL;
  118. } else {
  119. ret = 0;
  120. }
  121. return (int)ret;
  122. }
  123. 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)
  124. {
  125. struct usb_osal_timer *timer;
  126. timer = rt_malloc(sizeof(struct usb_osal_timer));
  127. if (timer == NULL) {
  128. USB_LOG_ERR("Create usb_osal_timer failed\r\n");
  129. while (1) {
  130. }
  131. }
  132. memset(timer, 0, sizeof(struct usb_osal_timer));
  133. 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));
  134. if (timer->timer == NULL) {
  135. USB_LOG_ERR("Create timer failed\r\n");
  136. while (1) {
  137. }
  138. }
  139. return timer;
  140. }
  141. void usb_osal_timer_delete(struct usb_osal_timer *timer)
  142. {
  143. rt_timer_stop(timer->timer);
  144. rt_timer_delete(timer->timer);
  145. rt_free(timer);
  146. }
  147. void usb_osal_timer_start(struct usb_osal_timer *timer)
  148. {
  149. rt_timer_start(timer->timer);
  150. }
  151. void usb_osal_timer_stop(struct usb_osal_timer *timer)
  152. {
  153. rt_timer_stop(timer->timer);
  154. }
  155. size_t usb_osal_enter_critical_section(void)
  156. {
  157. return rt_hw_interrupt_disable();
  158. }
  159. void usb_osal_leave_critical_section(size_t flag)
  160. {
  161. rt_hw_interrupt_enable(flag);
  162. }
  163. void usb_osal_msleep(uint32_t delay)
  164. {
  165. rt_thread_mdelay(delay);
  166. }
  167. void *usb_osal_malloc(size_t size)
  168. {
  169. return rt_malloc(size);
  170. }
  171. void usb_osal_free(void *ptr)
  172. {
  173. rt_free(ptr);
  174. }