From 498ba9b4e1e7faf60cff6d7322bb78a429d3a1ec Mon Sep 17 00:00:00 2001 From: sakumisu <1203593632@qq.com> Date: Thu, 9 Oct 2025 21:28:41 +0800 Subject: [PATCH] feat(osal): add ucosiii osal Signed-off-by: sakumisu <1203593632@qq.com> --- osal/usb_osal_ucosiii.c | 402 ++++++++++++++++++++++++++++++++++++++++ 1 file changed, 402 insertions(+) create mode 100644 osal/usb_osal_ucosiii.c diff --git a/osal/usb_osal_ucosiii.c b/osal/usb_osal_ucosiii.c new file mode 100644 index 00000000..52e99398 --- /dev/null +++ b/osal/usb_osal_ucosiii.c @@ -0,0 +1,402 @@ +/* + * Copyright (c) 2025, sakumisu + * + * SPDX-License-Identifier: Apache-2.0 + */ +#include "usb_config.h" +#include "usb_util.h" +#include "usb_osal.h" +#include "usb_errno.h" +#include "usb_log.h" +/* + ********************************************************************************************************* + * STANDARD LIBRARIES + ********************************************************************************************************* + */ + +#include +#include +#include +#include +#include +#include + +/* + ********************************************************************************************************* + * OS + ********************************************************************************************************* + */ + +#include + +/* + ********************************************************************************************************* + * LIBRARIES + ********************************************************************************************************* + */ + +#include +#include +#include +#include +#include +#include + +/* + ********************************************************************************************************* + * APP / BSP + ********************************************************************************************************* + */ + +#include + +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) +{ + OS_ERR err; + OS_TCB *tcb; + + tcb = (OS_TCB *)usb_osal_malloc(USB_ALIGN_UP(sizeof(OS_TCB), 4) + stack_size); + if (tcb == NULL) { + USB_LOG_ERR("Create thread %s failed\r\n", name); + while (1) { + } + } + + OSTaskCreate((OS_TCB *)tcb, + (CPU_CHAR *)name, + (OS_TASK_PTR)entry, + (void *)args, + (OS_PRIO)prio, + (CPU_STK *)((uint8_t *)tcb + USB_ALIGN_UP(sizeof(OS_TCB), 4)), + (CPU_STK_SIZE)(stack_size / 4) / 10, + (CPU_STK_SIZE)(stack_size / 4), + (OS_MSG_QTY)0, + (OS_TICK)0, + (void *)0, + (OS_OPT)OS_OPT_TASK_STK_CHK | OS_OPT_TASK_STK_CLR, + (OS_ERR *)&err); + + return (usb_osal_thread_t)tcb; +} + +void usb_osal_thread_delete(usb_osal_thread_t thread) +{ + OS_ERR err; + OS_TCB *tcb; + + if (thread == NULL) { + tcb = OSTCBCurPtr; + } else { + tcb = (OS_TCB *)thread; + } + + OSTaskDel(tcb, &err); + usb_osal_free(tcb); +} + +void usb_osal_thread_schedule_other(void) +{ + OS_ERR err; + + OS_TCB *current_tcb = OSTCBCurPtr; + + const OS_PRIO old_priority = OSPrioCur; + + OSTaskChangePrio(current_tcb, OS_CFG_PRIO_MAX - 1, &err); + + OSSchedRoundRobinYield(&err); + + OSTaskChangePrio(current_tcb, old_priority, &err); +} + +usb_osal_sem_t usb_osal_sem_create(uint32_t initial_count) +{ + OS_ERR err; + OS_SEM *sem; + + sem = (OS_SEM *)usb_osal_malloc(sizeof(OS_SEM)); + if (sem == NULL) { + USB_LOG_ERR("Create semaphore failed\r\n"); + while (1) { + } + } + + OSSemCreate(sem, "usbh_sem", initial_count, &err); + + return sem; +} + +void usb_osal_sem_delete(usb_osal_sem_t sem) +{ + OS_ERR err; + + OSSemDel((OS_SEM *)sem, OS_OPT_DEL_ALWAYS, &err); + usb_osal_free(sem); +} + +int usb_osal_sem_take(usb_osal_sem_t sem, uint32_t timeout) +{ + OS_ERR err; + CPU_TS ts; + + if (timeout == USB_OSAL_WAITING_FOREVER) { + OSSemPend((OS_SEM *)sem, 0, OS_OPT_PEND_BLOCKING, &ts, &err); + } else { + if (timeout == 0) { + OSSemPend((OS_SEM *)sem, 0, OS_OPT_PEND_NON_BLOCKING, &ts, &err); + } else { + OSSemPend((OS_SEM *)sem, timeout, OS_OPT_PEND_BLOCKING, &ts, &err); + } + } + + if (err == OS_ERR_TIMEOUT) { + return -USB_ERR_TIMEOUT; + } + + if (err != OS_ERR_NONE) { + return -USB_ERR_INVAL; + } + + return 0; +} + +int usb_osal_sem_give(usb_osal_sem_t sem) +{ + OS_ERR err; + + return (OSSemPost((OS_SEM *)sem, OS_OPT_POST_1, &err) == OS_ERR_NONE) ? 0 : -USB_ERR_TIMEOUT; +} + +void usb_osal_sem_reset(usb_osal_sem_t sem) +{ + OS_ERR err; + + OSSemSet((OS_SEM *)sem, 0, &err); +} + +usb_osal_mutex_t usb_osal_mutex_create(void) +{ + OS_ERR err; + OS_MUTEX *mutex; + + mutex = (OS_MUTEX *)usb_osal_malloc(sizeof(OS_MUTEX)); + if (mutex == NULL) { + USB_LOG_ERR("Create mutex failed\r\n"); + while (1) { + } + } + + OSMutexCreate(mutex, "usbh_mutex", &err); + + return mutex; +} + +void usb_osal_mutex_delete(usb_osal_mutex_t mutex) +{ + OS_ERR err; + + OSMutexDel((OS_MUTEX *)mutex, OS_OPT_DEL_ALWAYS, &err); + usb_osal_free(mutex); +} + +int usb_osal_mutex_take(usb_osal_mutex_t mutex) +{ + OS_ERR err; + + CPU_TS ts; + + OSMutexPend((OS_MUTEX *)mutex, 0, OS_OPT_PEND_BLOCKING, &ts, &err); + + if (err == OS_ERR_TIMEOUT) { + return -USB_ERR_TIMEOUT; + } + + if (err != OS_ERR_NONE) { + return -USB_ERR_INVAL; + } + + return 0; +} + +int usb_osal_mutex_give(usb_osal_mutex_t mutex) +{ + OS_ERR err; + + OSMutexPost((OS_MUTEX *)mutex, OS_OPT_POST_NONE, &err); + + return (err == OS_ERR_NONE) ? 0 : -USB_ERR_TIMEOUT; +} + +usb_osal_mq_t usb_osal_mq_create(uint32_t max_msgs) +{ + OS_ERR err; + OS_Q *mq; + + mq = (OS_Q *)usb_osal_malloc(sizeof(OS_Q)); + if (mq == NULL) { + USB_LOG_ERR("Create message queue failed\r\n"); + while (1) { + } + } + + OSQCreate((OS_Q *)mq, "usbh_mq", (OS_MSG_QTY)max_msgs, &err); + + return mq; +} + +void usb_osal_mq_delete(usb_osal_mq_t mq) +{ + OS_ERR err; + + OSQDel((OS_Q *)mq, OS_OPT_DEL_ALWAYS, &err); + usb_osal_free(mq); +} + +int usb_osal_mq_send(usb_osal_mq_t mq, uintptr_t addr) +{ + OS_ERR err; + + OSQPost((OS_Q *)mq, &addr, sizeof(uintptr_t), OS_OPT_POST_FIFO, &err); + + if (err == OS_ERR_TIMEOUT) { + return -USB_ERR_TIMEOUT; + } + + if (err != OS_ERR_NONE) { + return -USB_ERR_INVAL; + } + + return 0; +} + +int usb_osal_mq_recv(usb_osal_mq_t mq, uintptr_t *addr, uint32_t timeout) +{ + OS_ERR err; + void *msg = NULL; + OS_MSG_SIZE msg_size; + + if (timeout == USB_OSAL_WAITING_FOREVER) { + msg = OSQPend((OS_Q *)mq, 0, OS_OPT_PEND_BLOCKING, &msg_size, NULL, &err); + } else { + if (timeout == 0) { + msg = OSQPend((OS_Q *)mq, 0, OS_OPT_PEND_NON_BLOCKING, &msg_size, NULL, &err); + } else { + msg = OSQPend((OS_Q *)mq, timeout, OS_OPT_PEND_BLOCKING, &msg_size, NULL, &err); + } + } + + if (err == OS_ERR_TIMEOUT) { + return -USB_ERR_TIMEOUT; + } + + if (err != OS_ERR_NONE) { + return -USB_ERR_INVAL; + } + + *addr = *(uintptr_t *)msg; + + return 0; +} + +static void __usb_timeout(void *p_tmr, void *p_arg) +{ + struct usb_osal_timer *timer = (struct usb_osal_timer *)p_arg; + + timer->handler(timer->argument); +} + +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) +{ + struct usb_osal_timer *timer; + OS_ERR err; + OS_TMR *tmr; + (void)name; + + timer = (struct usb_osal_timer *)usb_osal_malloc(sizeof(struct usb_osal_timer)); + if (timer == NULL) { + USB_LOG_ERR("Create timer %s failed\r\n", name); + while (1) { + } + } + + tmr = (OS_TMR *)usb_osal_malloc(sizeof(OS_TMR)); + if (tmr == NULL) { + USB_LOG_ERR("Create timer %s failed\r\n", name); + while (1) { + } + } + + timer->timeout_ms = timeout_ms; + timer->handler = handler; + timer->argument = argument; + timer->is_period = is_period; + timer->timer = tmr; + + OSTmrCreate((OS_TMR *)tmr, + (CPU_CHAR *)name, + (OS_TICK)is_period ? 0 : timeout_ms, + (OS_TICK)is_period ? timeout_ms : 0, + (OS_OPT)is_period ? OS_OPT_TMR_PERIODIC : OS_OPT_TMR_ONE_SHOT, + (OS_TMR_CALLBACK_PTR)__usb_timeout, + (void *)timer, + (OS_ERR *)&err); + + return timer; +} + +void usb_osal_timer_delete(struct usb_osal_timer *timer) +{ + OS_ERR err; + + OSTmrStop((OS_TMR *)timer->timer, OS_OPT_TMR_NONE, NULL, &err); + OSTmrDel((OS_TMR *)timer->timer, &err); + usb_osal_free(timer->timer); + usb_osal_free(timer); +} + +void usb_osal_timer_start(struct usb_osal_timer *timer) +{ + OS_ERR err; + + OSTmrStart((OS_TMR *)timer->timer, &err); +} + +void usb_osal_timer_stop(struct usb_osal_timer *timer) +{ + OS_ERR err; + + OSTmrStop((OS_TMR *)timer->timer, OS_OPT_TMR_NONE, NULL, &err); +} + +size_t usb_osal_enter_critical_section(void) +{ + return CPU_SR_Save(); +} + +void usb_osal_leave_critical_section(size_t flag) +{ + CPU_SR_Restore(flag); +} + +void usb_osal_msleep(uint32_t delay) +{ + OS_ERR err; + + OSTimeDlyHMSM(0, 0, 0, delay, OS_OPT_TIME_HMSM_STRICT, &err); +} + +void *usb_osal_malloc(size_t size) +{ + void *buf = malloc(size); + if (!buf) { + USB_LOG_ERR("usb_osal_malloc failed\r\n"); + while (1) { + } + } + return buf; +} + +void usb_osal_free(void *ptr) +{ + free(ptr); +} \ No newline at end of file