Subversion Repositories HelenOS-historic

Rev

Rev 548 | Rev 557 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 548 Rev 552
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
 * interrupts_disable() is assumed.
70
 * interrupts_disable() is assumed.
71
 *
71
 *
72
 */
72
 */
73
static void cushion(void)
73
static 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
    interrupts_enable();
82
    interrupts_enable();
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, "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
    ipl_t ipl;
115
    ipl_t ipl;
116
    int i, avg, send_ipi = 0;
116
    int i, avg, send_ipi = 0;
117
 
117
 
118
    ipl = interrupts_disable();
118
    ipl = interrupts_disable();
119
 
119
 
120
    spinlock_lock(&t->lock);
120
    spinlock_lock(&t->lock);
121
 
121
 
122
    i = (t->priority < RQ_COUNT -1) ? ++t->priority : t->priority;
122
    i = (t->priority < RQ_COUNT -1) ? ++t->priority : t->priority;
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(&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
    interrupts_restore(ipl);
151
    interrupts_restore(ipl);
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
        ipl_t ipl;
174
        ipl_t ipl;
175
   
175
   
176
        spinlock_initialize(&t->lock);
176
        spinlock_initialize(&t->lock, "thread_t_lock");
177
   
177
   
178
        frame_ks = frame_alloc(FRAME_KA, ONE_FRAME);
178
        frame_ks = frame_alloc(FRAME_KA, ONE_FRAME);
179
        if (THREAD_USER_STACK & flags) {
179
        if (THREAD_USER_STACK & flags) {
180
            frame_us = frame_alloc(FRAME_KA, ONE_FRAME);
180
            frame_us = frame_alloc(FRAME_KA, ONE_FRAME);
181
        }
181
        }
182
 
182
 
183
        ipl = interrupts_disable();
183
        ipl = interrupts_disable();
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
        interrupts_restore(ipl);
187
        interrupts_restore(ipl);
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), (__address) t->kstack, THREAD_STACK_SIZE);
198
        context_set(&t->saved_context, FADDR(cushion), (__address) t->kstack, THREAD_STACK_SIZE);
199
       
199
       
200
        the_initialize((the_t *) t->kstack);
200
        the_initialize((the_t *) t->kstack);
201
 
201
 
202
        ipl = interrupts_disable();
202
        ipl = interrupts_disable();
203
        t->saved_context.ipl = interrupts_read();
203
        t->saved_context.ipl = interrupts_read();
204
        interrupts_restore(ipl);
204
        interrupts_restore(ipl);
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->priority = -1;       /* start in rq[0] */
209
        t->priority = -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
        ipl = interrupts_disable();    
230
        ipl = interrupts_disable();    
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
        interrupts_restore(ipl);
242
        interrupts_restore(ipl);
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
    ipl_t ipl;
257
    ipl_t ipl;
258
 
258
 
259
restart:
259
restart:
260
    ipl = interrupts_disable();
260
    ipl = interrupts_disable();
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
        interrupts_restore(ipl);
264
        interrupts_restore(ipl);
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
    ipl_t ipl;
314
    ipl_t ipl;
315
   
315
   
316
    ipl = interrupts_disable();
316
    ipl = interrupts_disable();
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
    interrupts_restore(ipl);
321
    interrupts_restore(ipl);
322
}
322
}
323
 
323