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 <rtthread.h>
9 #include <rthw.h>
10
usb_osal_thread_create(const char * name,uint32_t stack_size,uint32_t prio,usb_thread_entry_t entry,void * args)11 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)
12 {
13 rt_thread_t htask;
14 htask = rt_thread_create(name, entry, args, stack_size, prio, 10);
15 rt_thread_startup(htask);
16 return (usb_osal_thread_t)htask;
17 }
18
usb_osal_thread_delete(usb_osal_thread_t thread)19 void usb_osal_thread_delete(usb_osal_thread_t thread)
20 {
21 if (thread == NULL) {
22 return;
23 }
24
25 rt_thread_delete(thread);
26 }
27
usb_osal_sem_create(uint32_t initial_count)28 usb_osal_sem_t usb_osal_sem_create(uint32_t initial_count)
29 {
30 return (usb_osal_sem_t)rt_sem_create("usbh_sem", initial_count, RT_IPC_FLAG_FIFO);
31 }
32
usb_osal_sem_delete(usb_osal_sem_t sem)33 void usb_osal_sem_delete(usb_osal_sem_t sem)
34 {
35 rt_sem_delete((rt_sem_t)sem);
36 }
37
usb_osal_sem_take(usb_osal_sem_t sem,uint32_t timeout)38 int usb_osal_sem_take(usb_osal_sem_t sem, uint32_t timeout)
39 {
40 int ret = 0;
41 rt_err_t result = RT_EOK;
42
43 if (timeout == USB_OSAL_WAITING_FOREVER) {
44 result = rt_sem_take((rt_sem_t)sem, RT_WAITING_FOREVER);
45 } else {
46 result = rt_sem_take((rt_sem_t)sem, rt_tick_from_millisecond(timeout));
47 }
48 if (result == -RT_ETIMEOUT) {
49 ret = -ETIMEDOUT;
50 } else if (result == -RT_ERROR) {
51 ret = -EINVAL;
52 } else {
53 ret = 0;
54 }
55
56 return (int)ret;
57 }
58
usb_osal_sem_give(usb_osal_sem_t sem)59 int usb_osal_sem_give(usb_osal_sem_t sem)
60 {
61 return (int)rt_sem_release((rt_sem_t)sem);
62 }
63
usb_osal_mutex_create(void)64 usb_osal_mutex_t usb_osal_mutex_create(void)
65 {
66 return (usb_osal_mutex_t)rt_mutex_create("usbh_mutex", RT_IPC_FLAG_FIFO);
67 }
68
usb_osal_mutex_delete(usb_osal_mutex_t mutex)69 void usb_osal_mutex_delete(usb_osal_mutex_t mutex)
70 {
71 rt_mutex_delete((rt_mutex_t)mutex);
72 }
73
usb_osal_mutex_take(usb_osal_mutex_t mutex)74 int usb_osal_mutex_take(usb_osal_mutex_t mutex)
75 {
76 return (int)rt_mutex_take((rt_mutex_t)mutex, RT_WAITING_FOREVER);
77 }
78
usb_osal_mutex_give(usb_osal_mutex_t mutex)79 int usb_osal_mutex_give(usb_osal_mutex_t mutex)
80 {
81 return (int)rt_mutex_release((rt_mutex_t)mutex);
82 }
83
usb_osal_mq_create(uint32_t max_msgs)84 usb_osal_mq_t usb_osal_mq_create(uint32_t max_msgs)
85 {
86 return (usb_osal_mq_t)rt_mq_create("usbh_mq", sizeof(uintptr_t), max_msgs, RT_IPC_FLAG_FIFO);
87 }
88
usb_osal_mq_send(usb_osal_mq_t mq,uintptr_t addr)89 int usb_osal_mq_send(usb_osal_mq_t mq, uintptr_t addr)
90 {
91 return rt_mq_send((rt_mq_t)mq, &addr, sizeof(uintptr_t));
92 }
93
usb_osal_mq_recv(usb_osal_mq_t mq,uintptr_t * addr,uint32_t timeout)94 int usb_osal_mq_recv(usb_osal_mq_t mq, uintptr_t *addr, uint32_t timeout)
95 {
96 int ret = 0;
97 rt_err_t result = RT_EOK;
98
99 if (timeout == USB_OSAL_WAITING_FOREVER) {
100 result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), RT_WAITING_FOREVER);
101 } else {
102 result = rt_mq_recv((rt_mq_t)mq, addr, sizeof(uintptr_t), rt_tick_from_millisecond(timeout));
103 }
104 if (result == -RT_ETIMEOUT) {
105 ret = -ETIMEDOUT;
106 } else if (result == -RT_ERROR) {
107 ret = -EINVAL;
108 } else {
109 ret = 0;
110 }
111
112 return (int)ret;
113 }
114
usb_osal_enter_critical_section(void)115 size_t usb_osal_enter_critical_section(void)
116 {
117 return rt_hw_interrupt_disable();
118 }
119
usb_osal_leave_critical_section(size_t flag)120 void usb_osal_leave_critical_section(size_t flag)
121 {
122 rt_hw_interrupt_enable(flag);
123 }
124
usb_osal_msleep(uint32_t delay)125 void usb_osal_msleep(uint32_t delay)
126 {
127 rt_thread_mdelay(delay);
128 }
129