1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
#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);
}
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;
}
//����������ֻ���̵߳��ã����Ը�Ϊ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
}
|
