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
|
#ifndef __WAIT_H__
#define __WAIT_H__
#include <sched.h>
#include <list.h>
#include <lib.h>
#include <os.h>
struct wait_queue
{
struct thread *thread;
struct list_head thread_list;
};
struct wait_queue_head
{
/* TODO - lock required? */
struct list_head thread_list;
};
#define DECLARE_WAIT_QUEUE_HEAD(name) \
struct wait_queue_head name = \
{ .thread_list = { &(name).thread_list, &(name).thread_list} }
#define __WAIT_QUEUE_HEAD_INITIALIZER(name) { \
.thread_list = { &(name).thread_list, &(name).thread_list } }
#define DEFINE_WAIT(name) \
struct wait_queue name = { \
.thread = current, \
.thread_list = LIST_HEAD_INIT((name).thread_list), \
}
static inline void init_waitqueue_head(struct wait_queue_head *h)
{
INIT_LIST_HEAD(&h->thread_list);
}
static inline void init_waitqueue_entry(struct wait_queue *q, struct thread *thread)
{
q->thread = thread;
INIT_LIST_HEAD(&q->thread_list);
}
static inline void add_wait_queue(struct wait_queue_head *h, struct wait_queue *q)
{
if (list_empty(&q->thread_list))
list_add(&q->thread_list, &h->thread_list);
}
static inline void remove_wait_queue(struct wait_queue *q)
{
list_del(&q->thread_list);
}
static inline void wake_up(struct wait_queue_head *head)
{
unsigned long flags;
struct list_head *tmp, *next;
local_irq_save(flags);
list_for_each_safe(tmp, next, &head->thread_list)
{
struct wait_queue *curr;
curr = list_entry(tmp, struct wait_queue, thread_list);
wake(curr->thread);
}
local_irq_restore(flags);
}
#define add_waiter(w, wq) do { \
unsigned long flags; \
local_irq_save(flags); \
add_wait_queue(&wq, &w); \
block(current); \
local_irq_restore(flags); \
} while (0)
#define remove_waiter(w) do { \
unsigned long flags; \
local_irq_save(flags); \
remove_wait_queue(&w); \
local_irq_restore(flags); \
} while (0)
#define wait_event_deadline(wq, condition, deadline) do { \
unsigned long flags; \
if(condition) \
break; \
DEFINE_WAIT(__wait); \
for(;;) \
{ \
/* protect the list */ \
local_irq_save(flags); \
add_wait_queue(&wq, &__wait); \
current->wakeup_time = deadline; \
clear_runnable(current); \
local_irq_restore(flags); \
if((condition) || (deadline && NOW() >= deadline)) \
break; \
schedule(); \
} \
local_irq_save(flags); \
/* need to wake up */ \
wake(current); \
remove_wait_queue(&__wait); \
local_irq_restore(flags); \
} while(0)
#define wait_event(wq, condition) wait_event_deadline(wq, condition, 0)
#endif /* __WAIT_H__ */
|