Rev 213 | Rev 241 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 213 | Rev 227 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (C) 2001-2004 Jakub Jermar |
2 | * Copyright (C) 2001-2004 Jakub Jermar |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
8 | * |
8 | * |
9 | * - Redistributions of source code must retain the above copyright |
9 | * - Redistributions of source code must retain the above copyright |
10 | * notice, this list of conditions and the following disclaimer. |
10 | * notice, this list of conditions and the following disclaimer. |
11 | * - Redistributions in binary form must reproduce the above copyright |
11 | * - Redistributions in binary form must reproduce the above copyright |
12 | * notice, this list of conditions and the following disclaimer in the |
12 | * notice, this list of conditions and the following disclaimer in the |
13 | * documentation and/or other materials provided with the distribution. |
13 | * documentation and/or other materials provided with the distribution. |
14 | * - The name of the author may not be used to endorse or promote products |
14 | * - The name of the author may not be used to endorse or promote products |
15 | * derived from this software without specific prior written permission. |
15 | * derived from this software without specific prior written permission. |
16 | * |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | #include <proc/scheduler.h> |
29 | #include <proc/scheduler.h> |
30 | #include <proc/thread.h> |
30 | #include <proc/thread.h> |
31 | #include <proc/task.h> |
31 | #include <proc/task.h> |
32 | #include <mm/heap.h> |
32 | #include <mm/heap.h> |
33 | #include <mm/frame.h> |
33 | #include <mm/frame.h> |
34 | #include <mm/page.h> |
34 | #include <mm/page.h> |
35 | #include <arch/asm.h> |
35 | #include <arch/asm.h> |
36 | #include <arch.h> |
36 | #include <arch.h> |
37 | #include <synch/synch.h> |
37 | #include <synch/synch.h> |
38 | #include <synch/spinlock.h> |
38 | #include <synch/spinlock.h> |
39 | #include <synch/waitq.h> |
39 | #include <synch/waitq.h> |
40 | #include <synch/rwlock.h> |
40 | #include <synch/rwlock.h> |
41 | #include <cpu.h> |
41 | #include <cpu.h> |
42 | #include <func.h> |
42 | #include <func.h> |
43 | #include <context.h> |
43 | #include <context.h> |
44 | #include <list.h> |
44 | #include <list.h> |
45 | #include <typedefs.h> |
45 | #include <typedefs.h> |
46 | #include <time/clock.h> |
46 | #include <time/clock.h> |
47 | #include <list.h> |
47 | #include <list.h> |
48 | #include <config.h> |
48 | #include <config.h> |
49 | #include <arch/interrupt.h> |
49 | #include <arch/interrupt.h> |
50 | #include <smp/ipi.h> |
50 | #include <smp/ipi.h> |
51 | #include <arch/faddr.h> |
51 | #include <arch/faddr.h> |
52 | #include <arch/atomic.h> |
52 | #include <arch/atomic.h> |
53 | #include <memstr.h> |
53 | #include <memstr.h> |
54 | 54 | ||
55 | char *thread_states[] = {"Invalid", "Running", "Sleeping", "Ready", "Entering", "Exiting"}; /**< Thread states */ |
55 | char *thread_states[] = {"Invalid", "Running", "Sleeping", "Ready", "Entering", "Exiting"}; /**< Thread states */ |
56 | 56 | ||
57 | spinlock_t threads_lock; |
57 | spinlock_t threads_lock; |
58 | link_t threads_head; |
58 | link_t threads_head; |
59 | 59 | ||
60 | static spinlock_t tidlock; |
60 | static spinlock_t tidlock; |
61 | __u32 last_tid = 0; |
61 | __u32 last_tid = 0; |
62 | 62 | ||
63 | 63 | ||
64 | /** Thread wrapper |
64 | /** Thread wrapper |
65 | * |
65 | * |
66 | * This wrapper is provided to ensure that every thread |
66 | * This wrapper is provided to ensure that every thread |
67 | * makes a call to thread_exit() when its implementing |
67 | * makes a call to thread_exit() when its implementing |
68 | * function returns. |
68 | * function returns. |
69 | * |
69 | * |
70 | * cpu_priority_high() is assumed. |
70 | * cpu_priority_high() is assumed. |
71 | * |
71 | * |
72 | */ |
72 | */ |
73 | void cushion(void) |
73 | void cushion(void) |
74 | { |
74 | { |
75 | void (*f)(void *) = THREAD->thread_code; |
75 | void (*f)(void *) = THREAD->thread_code; |
76 | void *arg = THREAD->thread_arg; |
76 | void *arg = THREAD->thread_arg; |
77 | 77 | ||
78 | /* this is where each thread wakes up after its creation */ |
78 | /* this is where each thread wakes up after its creation */ |
79 | before_thread_runs(); |
79 | before_thread_runs(); |
80 | 80 | ||
81 | spinlock_unlock(&THREAD->lock); |
81 | spinlock_unlock(&THREAD->lock); |
82 | cpu_priority_low(); |
82 | cpu_priority_low(); |
83 | 83 | ||
84 | f(arg); |
84 | f(arg); |
85 | thread_exit(); |
85 | thread_exit(); |
86 | /* not reached */ |
86 | /* not reached */ |
87 | } |
87 | } |
88 | 88 | ||
89 | 89 | ||
90 | /** Initialize threads |
90 | /** Initialize threads |
91 | * |
91 | * |
92 | * Initialize kernel threads support. |
92 | * Initialize kernel threads support. |
93 | * |
93 | * |
94 | */ |
94 | */ |
95 | void thread_init(void) |
95 | void thread_init(void) |
96 | { |
96 | { |
97 | THREAD = NULL; |
97 | THREAD = NULL; |
98 | nrdy = 0; |
98 | nrdy = 0; |
99 | spinlock_initialize(&threads_lock); |
99 | spinlock_initialize(&threads_lock); |
100 | list_initialize(&threads_head); |
100 | list_initialize(&threads_head); |
101 | } |
101 | } |
102 | 102 | ||
103 | 103 | ||
104 | /** Make thread ready |
104 | /** Make thread ready |
105 | * |
105 | * |
106 | * Switch thread t to the ready state. |
106 | * Switch thread t to the ready state. |
107 | * |
107 | * |
108 | * @param t Thread to make ready. |
108 | * @param t Thread to make ready. |
109 | * |
109 | * |
110 | */ |
110 | */ |
111 | void thread_ready(thread_t *t) |
111 | void thread_ready(thread_t *t) |
112 | { |
112 | { |
113 | cpu_t *cpu; |
113 | cpu_t *cpu; |
114 | runq_t *r; |
114 | runq_t *r; |
115 | pri_t pri; |
115 | pri_t pri; |
116 | int i, avg, send_ipi = 0; |
116 | int i, avg, send_ipi = 0; |
117 | 117 | ||
118 | pri = cpu_priority_high(); |
118 | pri = cpu_priority_high(); |
119 | 119 | ||
120 | spinlock_lock(&t->lock); |
120 | spinlock_lock(&t->lock); |
121 | 121 | ||
122 | i = (t->pri < RQ_COUNT -1) ? ++t->pri : t->pri; |
122 | i = (t->pri < RQ_COUNT -1) ? ++t->pri : t->pri; |
123 | 123 | ||
124 | cpu = CPU; |
124 | cpu = CPU; |
125 | if (t->flags & X_WIRED) { |
125 | if (t->flags & X_WIRED) { |
126 | cpu = t->cpu; |
126 | cpu = t->cpu; |
127 | } |
127 | } |
128 | spinlock_unlock(&t->lock); |
128 | spinlock_unlock(&t->lock); |
129 | 129 | ||
130 | /* |
130 | /* |
131 | * Append t to respective ready queue on respective processor. |
131 | * Append t to respective ready queue on respective processor. |
132 | */ |
132 | */ |
133 | r = &cpu->rq[i]; |
133 | r = &cpu->rq[i]; |
134 | spinlock_lock(&r->lock); |
134 | spinlock_lock(&r->lock); |
135 | list_append(&t->rq_link, &r->rq_head); |
135 | list_append(&t->rq_link, &r->rq_head); |
136 | r->n++; |
136 | r->n++; |
137 | spinlock_unlock(&r->lock); |
137 | spinlock_unlock(&r->lock); |
138 | 138 | ||
139 | atomic_inc(&nrdy); |
139 | atomic_inc((int *) &nrdy); |
140 | avg = nrdy / config.cpu_active; |
140 | avg = nrdy / config.cpu_active; |
141 | 141 | ||
142 | spinlock_lock(&cpu->lock); |
142 | spinlock_lock(&cpu->lock); |
143 | if ((++cpu->nrdy) > avg) { |
143 | if ((++cpu->nrdy) > avg) { |
144 | /* |
144 | /* |
145 | * If there are idle halted CPU's, this will wake them up. |
145 | * If there are idle halted CPU's, this will wake them up. |
146 | */ |
146 | */ |
147 | ipi_broadcast(VECTOR_WAKEUP_IPI); |
147 | ipi_broadcast(VECTOR_WAKEUP_IPI); |
148 | } |
148 | } |
149 | spinlock_unlock(&cpu->lock); |
149 | spinlock_unlock(&cpu->lock); |
150 | 150 | ||
151 | cpu_priority_restore(pri); |
151 | cpu_priority_restore(pri); |
152 | } |
152 | } |
153 | 153 | ||
154 | 154 | ||
155 | /** Create new thread |
155 | /** Create new thread |
156 | * |
156 | * |
157 | * Create a new thread. |
157 | * Create a new thread. |
158 | * |
158 | * |
159 | * @param func Thread's implementing function. |
159 | * @param func Thread's implementing function. |
160 | * @param arg Thread's implementing function argument. |
160 | * @param arg Thread's implementing function argument. |
161 | * @param task Task to which the thread belongs. |
161 | * @param task Task to which the thread belongs. |
162 | * @param flags Thread flags. |
162 | * @param flags Thread flags. |
163 | * |
163 | * |
164 | * @return New thread's structure on success, NULL on failure. |
164 | * @return New thread's structure on success, NULL on failure. |
165 | * |
165 | * |
166 | */ |
166 | */ |
167 | thread_t *thread_create(void (* func)(void *), void *arg, task_t *task, int flags) |
167 | thread_t *thread_create(void (* func)(void *), void *arg, task_t *task, int flags) |
168 | { |
168 | { |
169 | thread_t *t; |
169 | thread_t *t; |
170 | __address frame_ks, frame_us = NULL; |
170 | __address frame_ks, frame_us = NULL; |
171 | 171 | ||
172 | t = (thread_t *) malloc(sizeof(thread_t)); |
172 | t = (thread_t *) malloc(sizeof(thread_t)); |
173 | if (t) { |
173 | if (t) { |
174 | pri_t pri; |
174 | pri_t pri; |
175 | 175 | ||
176 | spinlock_initialize(&t->lock); |
176 | spinlock_initialize(&t->lock); |
177 | 177 | ||
178 | frame_ks = frame_alloc(FRAME_KA); |
178 | frame_ks = frame_alloc(FRAME_KA); |
179 | if (THREAD_USER_STACK & flags) { |
179 | if (THREAD_USER_STACK & flags) { |
180 | frame_us = frame_alloc(FRAME_KA); |
180 | frame_us = frame_alloc(FRAME_KA); |
181 | } |
181 | } |
182 | 182 | ||
183 | pri = cpu_priority_high(); |
183 | pri = cpu_priority_high(); |
184 | spinlock_lock(&tidlock); |
184 | spinlock_lock(&tidlock); |
185 | t->tid = ++last_tid; |
185 | t->tid = ++last_tid; |
186 | spinlock_unlock(&tidlock); |
186 | spinlock_unlock(&tidlock); |
187 | cpu_priority_restore(pri); |
187 | cpu_priority_restore(pri); |
188 | 188 | ||
189 | memsetb(frame_ks, THREAD_STACK_SIZE, 0); |
189 | memsetb(frame_ks, THREAD_STACK_SIZE, 0); |
190 | link_initialize(&t->rq_link); |
190 | link_initialize(&t->rq_link); |
191 | link_initialize(&t->wq_link); |
191 | link_initialize(&t->wq_link); |
192 | link_initialize(&t->th_link); |
192 | link_initialize(&t->th_link); |
193 | link_initialize(&t->threads_link); |
193 | link_initialize(&t->threads_link); |
194 | t->kstack = (__u8 *) frame_ks; |
194 | t->kstack = (__u8 *) frame_ks; |
195 | t->ustack = (__u8 *) frame_us; |
195 | t->ustack = (__u8 *) frame_us; |
196 | 196 | ||
197 | context_save(&t->saved_context); |
197 | context_save(&t->saved_context); |
198 | context_set(&t->saved_context, FADDR(cushion), t->kstack, THREAD_STACK_SIZE); |
198 | context_set(&t->saved_context, FADDR(cushion), t->kstack, THREAD_STACK_SIZE); |
199 | 199 | ||
200 | the_initialize((the_t *) t->kstack); |
200 | the_initialize((the_t *) t->kstack); |
201 | 201 | ||
202 | pri = cpu_priority_high(); |
202 | pri = cpu_priority_high(); |
203 | t->saved_context.pri = cpu_priority_read(); |
203 | t->saved_context.pri = cpu_priority_read(); |
204 | cpu_priority_restore(pri); |
204 | cpu_priority_restore(pri); |
205 | 205 | ||
206 | t->thread_code = func; |
206 | t->thread_code = func; |
207 | t->thread_arg = arg; |
207 | t->thread_arg = arg; |
208 | t->ticks = -1; |
208 | t->ticks = -1; |
209 | t->pri = -1; /* start in rq[0] */ |
209 | t->pri = -1; /* start in rq[0] */ |
210 | t->cpu = NULL; |
210 | t->cpu = NULL; |
211 | t->flags = 0; |
211 | t->flags = 0; |
212 | t->state = Entering; |
212 | t->state = Entering; |
213 | t->call_me = NULL; |
213 | t->call_me = NULL; |
214 | t->call_me_with = NULL; |
214 | t->call_me_with = NULL; |
215 | 215 | ||
216 | timeout_initialize(&t->sleep_timeout); |
216 | timeout_initialize(&t->sleep_timeout); |
217 | t->sleep_queue = NULL; |
217 | t->sleep_queue = NULL; |
218 | t->timeout_pending = 0; |
218 | t->timeout_pending = 0; |
219 | 219 | ||
220 | t->rwlock_holder_type = RWLOCK_NONE; |
220 | t->rwlock_holder_type = RWLOCK_NONE; |
221 | 221 | ||
222 | t->task = task; |
222 | t->task = task; |
223 | 223 | ||
224 | t->fpu_context_exists=0; |
224 | t->fpu_context_exists=0; |
225 | t->fpu_context_engaged=0; |
225 | t->fpu_context_engaged=0; |
226 | 226 | ||
227 | /* |
227 | /* |
228 | * Register this thread in the system-wide list. |
228 | * Register this thread in the system-wide list. |
229 | */ |
229 | */ |
230 | pri = cpu_priority_high(); |
230 | pri = cpu_priority_high(); |
231 | spinlock_lock(&threads_lock); |
231 | spinlock_lock(&threads_lock); |
232 | list_append(&t->threads_link, &threads_head); |
232 | list_append(&t->threads_link, &threads_head); |
233 | spinlock_unlock(&threads_lock); |
233 | spinlock_unlock(&threads_lock); |
234 | 234 | ||
235 | /* |
235 | /* |
236 | * Attach to the containing task. |
236 | * Attach to the containing task. |
237 | */ |
237 | */ |
238 | spinlock_lock(&task->lock); |
238 | spinlock_lock(&task->lock); |
239 | list_append(&t->th_link, &task->th_head); |
239 | list_append(&t->th_link, &task->th_head); |
240 | spinlock_unlock(&task->lock); |
240 | spinlock_unlock(&task->lock); |
241 | 241 | ||
242 | cpu_priority_restore(pri); |
242 | cpu_priority_restore(pri); |
243 | } |
243 | } |
244 | 244 | ||
245 | return t; |
245 | return t; |
246 | } |
246 | } |
247 | 247 | ||
248 | 248 | ||
249 | /** Make thread exiting |
249 | /** Make thread exiting |
250 | * |
250 | * |
251 | * End current thread execution and switch it to the exiting |
251 | * End current thread execution and switch it to the exiting |
252 | * state. All pending timeouts are executed. |
252 | * state. All pending timeouts are executed. |
253 | * |
253 | * |
254 | */ |
254 | */ |
255 | void thread_exit(void) |
255 | void thread_exit(void) |
256 | { |
256 | { |
257 | pri_t pri; |
257 | pri_t pri; |
258 | 258 | ||
259 | restart: |
259 | restart: |
260 | pri = cpu_priority_high(); |
260 | pri = cpu_priority_high(); |
261 | spinlock_lock(&THREAD->lock); |
261 | spinlock_lock(&THREAD->lock); |
262 | if (THREAD->timeout_pending) { /* busy waiting for timeouts in progress */ |
262 | if (THREAD->timeout_pending) { /* busy waiting for timeouts in progress */ |
263 | spinlock_unlock(&THREAD->lock); |
263 | spinlock_unlock(&THREAD->lock); |
264 | cpu_priority_restore(pri); |
264 | cpu_priority_restore(pri); |
265 | goto restart; |
265 | goto restart; |
266 | } |
266 | } |
267 | THREAD->state = Exiting; |
267 | THREAD->state = Exiting; |
268 | spinlock_unlock(&THREAD->lock); |
268 | spinlock_unlock(&THREAD->lock); |
269 | scheduler(); |
269 | scheduler(); |
270 | } |
270 | } |
271 | 271 | ||
272 | 272 | ||
273 | /** Thread sleep |
273 | /** Thread sleep |
274 | * |
274 | * |
275 | * Suspend execution of the current thread. |
275 | * Suspend execution of the current thread. |
276 | * |
276 | * |
277 | * @param sec Number of seconds to sleep. |
277 | * @param sec Number of seconds to sleep. |
278 | * |
278 | * |
279 | */ |
279 | */ |
280 | void thread_sleep(__u32 sec) |
280 | void thread_sleep(__u32 sec) |
281 | { |
281 | { |
282 | thread_usleep(sec*1000000); |
282 | thread_usleep(sec*1000000); |
283 | } |
283 | } |
284 | 284 | ||
285 | 285 | ||
286 | /** Thread usleep |
286 | /** Thread usleep |
287 | * |
287 | * |
288 | * Suspend execution of the current thread. |
288 | * Suspend execution of the current thread. |
289 | * |
289 | * |
290 | * @param usec Number of microseconds to sleep. |
290 | * @param usec Number of microseconds to sleep. |
291 | * |
291 | * |
292 | */ |
292 | */ |
293 | void thread_usleep(__u32 usec) |
293 | void thread_usleep(__u32 usec) |
294 | { |
294 | { |
295 | waitq_t wq; |
295 | waitq_t wq; |
296 | 296 | ||
297 | waitq_initialize(&wq); |
297 | waitq_initialize(&wq); |
298 | 298 | ||
299 | (void) waitq_sleep_timeout(&wq, usec, SYNCH_NON_BLOCKING); |
299 | (void) waitq_sleep_timeout(&wq, usec, SYNCH_NON_BLOCKING); |
300 | } |
300 | } |
301 | 301 | ||
302 | 302 | ||
303 | /** Register thread out-of-context invocation |
303 | /** Register thread out-of-context invocation |
304 | * |
304 | * |
305 | * Register a function and its argument to be executed |
305 | * Register a function and its argument to be executed |
306 | * on next context switch to the current thread. |
306 | * on next context switch to the current thread. |
307 | * |
307 | * |
308 | * @param call_me Out-of-context function. |
308 | * @param call_me Out-of-context function. |
309 | * @param call_me_with Out-of-context function argument. |
309 | * @param call_me_with Out-of-context function argument. |
310 | * |
310 | * |
311 | */ |
311 | */ |
312 | void thread_register_call_me(void (* call_me)(void *), void *call_me_with) |
312 | void thread_register_call_me(void (* call_me)(void *), void *call_me_with) |
313 | { |
313 | { |
314 | pri_t pri; |
314 | pri_t pri; |
315 | 315 | ||
316 | pri = cpu_priority_high(); |
316 | pri = cpu_priority_high(); |
317 | spinlock_lock(&THREAD->lock); |
317 | spinlock_lock(&THREAD->lock); |
318 | THREAD->call_me = call_me; |
318 | THREAD->call_me = call_me; |
319 | THREAD->call_me_with = call_me_with; |
319 | THREAD->call_me_with = call_me_with; |
320 | spinlock_unlock(&THREAD->lock); |
320 | spinlock_unlock(&THREAD->lock); |
321 | cpu_priority_restore(pri); |
321 | cpu_priority_restore(pri); |
322 | } |
322 | } |
323 | 323 |