165 lines
3.5 KiB
C
165 lines
3.5 KiB
C
#include "usb_osal.h"
|
||
#include "usb_errno.h"
|
||
#include "stdlib.h"
|
||
#include "RTL.h"
|
||
|
||
uint32_t enter_critical(void);
|
||
uint32_t exit_critical(uint32_t sr);
|
||
|
||
//延时=timeout/os_tick， os tick设置为1ms，延时=timeout
|
||
//移植为arm9，其他版本可能需要调整汇编代码
|
||
|
||
//按最大端点数量设置，这里设为8
|
||
_declare_box8(sem_mpool, sizeof(OS_SEM), 8);
|
||
_declare_box8(mut_mpool, sizeof(OS_MUT), 8);
|
||
|
||
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)
|
||
{
|
||
void *stk = malloc(stack_size);
|
||
_init_box8(sem_mpool, sizeof(sem_mpool), sizeof(OS_SEM));
|
||
_init_box8(mut_mpool, sizeof(mut_mpool), sizeof(OS_MUT));
|
||
|
||
return (usb_osal_thread_t)os_tsk_create_user_ex (entry, prio,
|
||
stk, stack_size,
|
||
args);
|
||
}
|
||
|
||
void usb_osal_thread_suspend(usb_osal_thread_t thread)
|
||
{
|
||
os_suspend();
|
||
}
|
||
|
||
void usb_osal_thread_resume(usb_osal_thread_t thread)
|
||
{
|
||
os_resume(0);
|
||
}
|
||
|
||
usb_osal_sem_t usb_osal_sem_create(uint32_t initial_count)
|
||
{
|
||
void *sem = _alloc_box(sem_mpool);
|
||
if(sem != NULL) os_sem_init(sem, initial_count);
|
||
return (usb_osal_sem_t)sem;
|
||
}
|
||
|
||
//删除os同步量，并不简单 //不能有无限等待的信号量，否则不能删除
|
||
void usb_osal_sem_delete(usb_osal_sem_t sem)
|
||
{
|
||
_free_box(sem_mpool, sem);
|
||
}
|
||
|
||
int usb_osal_sem_take(usb_osal_sem_t sem, uint32_t timeout)
|
||
{
|
||
return (os_sem_wait(sem, timeout) != OS_R_TMO) ? 0 : -ETIMEDOUT;
|
||
}
|
||
|
||
//在线程，中断均调用
|
||
int usb_osal_sem_give(usb_osal_sem_t sem)
|
||
{
|
||
uint32_t intstatus = 0;
|
||
/* Obtain the number of the currently executing interrupt. */
|
||
__asm volatile ( "mrs intstatus, cpsr" );
|
||
if ((intstatus & 0xf) == 0) { //user mode
|
||
os_sem_send(sem);
|
||
} else {
|
||
isr_sem_send(sem);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
usb_osal_mutex_t usb_osal_mutex_create(void)
|
||
{
|
||
void *mut = _alloc_box(mut_mpool);
|
||
if(mut != NULL) os_mut_init(mut);
|
||
return (usb_osal_mutex_t)mut;
|
||
}
|
||
|
||
void usb_osal_mutex_delete(usb_osal_mutex_t mutex)
|
||
{
|
||
_free_box(mut_mpool, mutex);
|
||
}
|
||
|
||
int usb_osal_mutex_take(usb_osal_mutex_t mutex)
|
||
{
|
||
os_mut_wait(mutex, 0xffff);
|
||
return 0;
|
||
}
|
||
|
||
int usb_osal_mutex_give(usb_osal_mutex_t mutex)
|
||
{
|
||
return (os_mut_release(mutex) == OS_R_OK) ? 0 : -EINVAL;
|
||
}
|
||
|
||
usb_osal_event_t usb_osal_event_create(void)
|
||
{
|
||
return (usb_osal_event_t)os_tsk_self();
|
||
}
|
||
|
||
void usb_osal_event_delete(usb_osal_event_t event)
|
||
{
|
||
return;
|
||
}
|
||
|
||
int usb_osal_event_recv(usb_osal_event_t event, uint32_t set, uint32_t *recved)
|
||
{
|
||
os_evt_wait_or(set, 0xffff);
|
||
*recved = os_evt_get();
|
||
return 0;
|
||
}
|
||
|
||
//在线程，中断均调用
|
||
int usb_osal_event_send(usb_osal_event_t event, uint32_t set)
|
||
{
|
||
uint32_t intstatus = 0;
|
||
/* Obtain the number of the currently executing interrupt. */
|
||
__asm volatile ( "mrs intstatus, cpsr" );
|
||
if ((intstatus & 0xf) == 0) { //user mode
|
||
os_evt_set(set, (OS_TID)event);
|
||
} else {
|
||
isr_evt_set(set, (OS_TID)event);
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
//这两个函数只在线程调用，可以改为tsk_lock和tsk_unlock版本
|
||
size_t usb_osal_enter_critical_section(void)
|
||
{
|
||
return enter_critical();
|
||
}
|
||
|
||
void usb_osal_leave_critical_section(size_t flag)
|
||
{
|
||
exit_critical(flag);
|
||
}
|
||
|
||
void usb_osal_msleep(uint32_t delay)
|
||
{
|
||
os_dly_wait(delay);
|
||
}
|
||
|
||
#pragma arm
|
||
|
||
__asm uint32_t __builtin_ctz(uint32_t val)
|
||
{
|
||
rsb r3, r0, #0
|
||
and r0, r3, r0
|
||
clz r0, r0
|
||
rsb r0, r0, #31
|
||
bx lr
|
||
}
|
||
|
||
__asm uint32_t enter_critical(void)
|
||
{
|
||
mrs R0, CPSR
|
||
orr R1, R0, #0xC0 ; Disable IRQ and FIQ
|
||
msr CPSR_c, R1
|
||
bx lr
|
||
}
|
||
|
||
__asm uint32_t exit_critical(uint32_t sr)
|
||
{
|
||
msr CPSR_c, R0
|
||
bx lr
|
||
}
|