blob: b05aee3b603ae19532090031fc537969d1182858 (
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
|
#include <cpu.h>
#include <drivers/uart.h>
#include <util/mutex.h>
#include <util/lock.h>
#include <globals.h>
void mutex_init(void)
{
for (unsigned long m = 0; m < MAX_MUTEXS; m++) {
mutexs[m].pid = 0;
mutexs[m].addr = 0;
mutexs[m].locking_thread = 0;
mutexs[m].waiting_threads = 0;
mutex_entries[m].value = &mutexs[m];
mutex_entries[m].next = &mutex_entries[m+1];
}
// Initialize Free Mutexs
mutex_manager.free.start.next = &mutex_entries[0];
mutex_entries[MAX_MUTEXS-1].next = 0;
}
struct Mutex* create_mutex(void* addr)
{
struct Entry* e = pop_from_queue(&mutex_manager.free);
if (e == 0)
return 0;
struct Mutex* m = e->value;
m->pid = 0;
m->addr = addr;
mutex_manager.used_mutexes++;
return e->value;
}
unsigned char delete_mutex(struct Mutex* m)
{
unsigned long spacing = (unsigned long)&mutexs[1] - (unsigned long)&mutexs[0];
unsigned long difference = (unsigned long)m - (unsigned long)&mutexs[0];
unsigned long index = difference/spacing;
if (index >= MAX_MUTEXS)
return 1;
struct Entry* entry = &mutex_entries[index];
// Add it to the free queue
push_to_queue(entry, &mutex_manager.free);
mutex_manager.used_mutexes--;
return 0;
}
void uart_mutexes(void)
{
uart_hexn(mutex_manager.used_mutexes);
}
unsigned char lock_mutex(struct Mutex* m)
{
struct Thread* rthread = scheduler.rthread;
unsigned long mode = getmode() & 0x1F;
if (mode == 0x10) {
unsigned long spacing = (unsigned long)&mutexs[1] - (unsigned long)&mutexs[0];
unsigned long difference = (unsigned long)m - (unsigned long)&mutexs[0];
unsigned long index = difference/spacing;
// If it is not a managed mutex, break away
if (index >= MAX_MUTEXS)
return 1;
if ((unsigned char) index > rthread->highest_mutex)
return 2;
sys1(SYS_LOCK, m);
m->locking_thread = &mutex_entries[index];
return 0;
}
return 3;
}
void unlock_mutex(struct Mutex* m)
{
unlock((struct Lock*)m);
}
|