blob: 5eb999a97d66ed8790fe0a8ede87f2b5e6a4b7f0 (
plain)
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
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
|
#include "nitro/types.h"
#include "function_target.h"
#include "OS_mutex.h"
#include "OS_system.h"
ARM_FUNC void OS_InitMutex(OSMutex *mutex)
{
OS_InitThreadQueue(&mutex->queue);
mutex->thread = NULL;
mutex->count = 0;
}
ARM_FUNC void OS_LockMutex(OSMutex *mutex)
{
OSIntrMode prevIntrMode = OS_DisableInterrupts();
OSThread *currentThread = OS_GetCurrentThread();
OSThread *ownerThread;
for (;;)
{
ownerThread = ((volatile OSMutex *)mutex)->thread;
if (ownerThread == NULL)
{
mutex->thread = currentThread;
mutex->count++;
OSi_EnqueueTail(currentThread, mutex);
break;
}
else if (ownerThread == currentThread)
{
mutex->count++;
break;
}
else
{
currentThread->mutex = mutex;
OS_SleepThread(&mutex->queue);
currentThread->mutex = NULL;
}
}
(void)OS_RestoreInterrupts(prevIntrMode);
}
ARM_FUNC void OS_UnlockMutex(OSMutex *mutex)
{
OSIntrMode prevIntrMode = OS_DisableInterrupts();
OSThread *currentThread = OS_GetCurrentThread();
if (mutex->thread == currentThread && --mutex->count == 0)
{
OSi_DequeueItem(currentThread, mutex);
mutex->thread = NULL;
OS_WakeupThread(&mutex->queue);
}
(void)OS_RestoreInterrupts(prevIntrMode);
}
ARM_FUNC void OSi_UnlockAllMutex(OSThread *thread)
{
OSMutex *mutex;
while (thread->mutexQueue.head)
{
mutex = OSi_RemoveMutexLinkFromQueue(&thread->mutexQueue);
mutex->count = 0;
mutex->thread = NULL;
OS_WakeupThread(&mutex->queue);
}
}
ARM_FUNC BOOL OS_TryLockMutex(OSMutex *mutex)
{
OSIntrMode prevIntrMode = OS_DisableInterrupts();
OSThread *currentThread = OS_GetCurrentThread();
BOOL locked;
if (mutex->thread == NULL)
{
mutex->thread = currentThread;
mutex->count++;
OSi_EnqueueTail(currentThread, mutex);
locked = TRUE;
}
else if (mutex->thread == currentThread)
{
mutex->count++;
locked = TRUE;
}
else
{
locked = FALSE;
}
(void)OS_RestoreInterrupts(prevIntrMode);
return locked;
}
ARM_FUNC void OSi_EnqueueTail(OSThread *thread, OSMutex *mutex)
{
OSMutex *prev = thread->mutexQueue.tail;
if (!prev)
{
thread->mutexQueue.head = mutex;
}
else
{
prev->link.next = mutex;
}
mutex->link.prev = prev;
mutex->link.next = NULL;
thread->mutexQueue.tail = mutex;
}
ARM_FUNC void OSi_DequeueItem(OSThread *thread, OSMutex *mutex)
{
OSMutex *next = mutex->link.next;
OSMutex *prev = mutex->link.prev;
if (!next)
{
thread->mutexQueue.tail = prev;
}
else
{
next->link.prev = prev;
}
if(!prev)
{
thread->mutexQueue.head = next;
}
else
{
prev->link.next = next;
}
}
|
