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
|
#ifndef _SEMAPHORE_H_
#define _SEMAPHORE_H_
#include <mini-os/wait.h>
#include <mini-os/spinlock.h>
/*
* Implementation of semaphore in Mini-os is simple, because
* there are no preemptive threads, the atomicity is guaranteed.
*/
struct semaphore
{
int count;
struct wait_queue_head wait;
};
/*
* the semaphore definition
*/
struct rw_semaphore {
signed long count;
spinlock_t wait_lock;
int debug;
};
#define __SEMAPHORE_INITIALIZER(name, n) \
{ \
.count = n, \
.wait = __WAIT_QUEUE_HEAD_INITIALIZER((name).wait) \
}
#define __MUTEX_INITIALIZER(name) \
__SEMAPHORE_INITIALIZER(name,1)
#define __DECLARE_SEMAPHORE_GENERIC(name,count) \
struct semaphore name = __SEMAPHORE_INITIALIZER(name,count)
#define DECLARE_MUTEX(name) __DECLARE_SEMAPHORE_GENERIC(name,1)
#define DECLARE_MUTEX_LOCKED(name) __DECLARE_SEMAPHORE_GENERIC(name,0)
static inline void init_SEMAPHORE(struct semaphore *sem, int count)
{
sem->count = count;
init_waitqueue_head(&sem->wait);
}
#define init_MUTEX(sem) init_SEMAPHORE(sem, 1)
static inline int trydown(struct semaphore *sem)
{
unsigned long flags;
int ret = 0;
local_irq_save(flags);
if (sem->count > 0) {
ret = 1;
sem->count--;
}
local_irq_restore(flags);
return ret;
}
static void inline down(struct semaphore *sem)
{
unsigned long flags;
while (1) {
wait_event(sem->wait, sem->count > 0);
local_irq_save(flags);
if (sem->count > 0)
break;
local_irq_restore(flags);
}
sem->count--;
local_irq_restore(flags);
}
static void inline up(struct semaphore *sem)
{
unsigned long flags;
local_irq_save(flags);
sem->count++;
wake_up(&sem->wait);
local_irq_restore(flags);
}
/* FIXME! Thre read/write semaphores are unimplemented! */
static inline void init_rwsem(struct rw_semaphore *sem)
{
sem->count = 1;
}
static inline void down_read(struct rw_semaphore *sem)
{
}
static inline void up_read(struct rw_semaphore *sem)
{
}
static inline void up_write(struct rw_semaphore *sem)
{
}
static inline void down_write(struct rw_semaphore *sem)
{
}
#endif /* _SEMAPHORE_H */
|