Subversion Repositories HelenOS-historic

Rev

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

Rev 783 Rev 786
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
#include <print.h>
54
#include <print.h>
55
 
55
 
56
char *thread_states[] = {"Invalid", "Running", "Sleeping", "Ready", "Entering", "Exiting"}; /**< Thread states */
56
char *thread_states[] = {"Invalid", "Running", "Sleeping", "Ready", "Entering", "Exiting"}; /**< Thread states */
57
 
57
 
58
SPINLOCK_INITIALIZE(threads_lock);  /**< Lock protecting threads_head list. For locking rules, see declaration thereof. */
58
SPINLOCK_INITIALIZE(threads_lock);  /**< Lock protecting threads_head list. For locking rules, see declaration thereof. */
59
LIST_INITIALIZE(threads_head);      /**< List of all threads. */
59
LIST_INITIALIZE(threads_head);      /**< List of all threads. */
60
 
60
 
61
SPINLOCK_INITIALIZE(tidlock);
61
SPINLOCK_INITIALIZE(tidlock);
62
__u32 last_tid = 0;
62
__u32 last_tid = 0;
63
 
63
 
64
 
64
 
65
/** Thread wrapper
65
/** Thread wrapper
66
 *
66
 *
67
 * This wrapper is provided to ensure that every thread
67
 * This wrapper is provided to ensure that every thread
68
 * makes a call to thread_exit() when its implementing
68
 * makes a call to thread_exit() when its implementing
69
 * function returns.
69
 * function returns.
70
 *
70
 *
71
 * interrupts_disable() is assumed.
71
 * interrupts_disable() is assumed.
72
 *
72
 *
73
 */
73
 */
74
static void cushion(void)
74
static void cushion(void)
75
{
75
{
76
    void (*f)(void *) = THREAD->thread_code;
76
    void (*f)(void *) = THREAD->thread_code;
77
    void *arg = THREAD->thread_arg;
77
    void *arg = THREAD->thread_arg;
78
 
78
 
79
    /* this is where each thread wakes up after its creation */
79
    /* this is where each thread wakes up after its creation */
80
    before_thread_runs();
80
    before_thread_runs();
81
 
81
 
82
    spinlock_unlock(&THREAD->lock);
82
    spinlock_unlock(&THREAD->lock);
83
    interrupts_enable();
83
    interrupts_enable();
84
 
84
 
85
    f(arg);
85
    f(arg);
86
    thread_exit();
86
    thread_exit();
87
    /* not reached */
87
    /* not reached */
88
}
88
}
89
 
89
 
90
 
90
 
91
/** Initialize threads
91
/** Initialize threads
92
 *
92
 *
93
 * Initialize kernel threads support.
93
 * Initialize kernel threads support.
94
 *
94
 *
95
 */
95
 */
96
void thread_init(void)
96
void thread_init(void)
97
{
97
{
98
    THREAD = NULL;
98
    THREAD = NULL;
99
    atomic_set(&nrdy,0);
99
    atomic_set(&nrdy,0);
100
}
100
}
101
 
101
 
102
 
102
 
103
/** Make thread ready
103
/** Make thread ready
104
 *
104
 *
105
 * Switch thread t to the ready state.
105
 * Switch thread t to the ready state.
106
 *
106
 *
107
 * @param t Thread to make ready.
107
 * @param t Thread to make ready.
108
 *
108
 *
109
 */
109
 */
110
void thread_ready(thread_t *t)
110
void thread_ready(thread_t *t)
111
{
111
{
112
    cpu_t *cpu;
112
    cpu_t *cpu;
113
    runq_t *r;
113
    runq_t *r;
114
    ipl_t ipl;
114
    ipl_t ipl;
115
    int i, avg;
115
    int i, avg;
116
 
116
 
117
    ipl = interrupts_disable();
117
    ipl = interrupts_disable();
118
 
118
 
119
    spinlock_lock(&t->lock);
119
    spinlock_lock(&t->lock);
120
 
120
 
121
    i = (t->priority < RQ_COUNT -1) ? ++t->priority : t->priority;
121
    i = (t->priority < RQ_COUNT -1) ? ++t->priority : t->priority;
122
   
122
   
123
    cpu = CPU;
123
    cpu = CPU;
124
    if (t->flags & X_WIRED) {
124
    if (t->flags & X_WIRED) {
125
        cpu = t->cpu;
125
        cpu = t->cpu;
126
    }
126
    }
127
    spinlock_unlock(&t->lock);
127
    spinlock_unlock(&t->lock);
128
   
128
   
129
    /*
129
    /*
130
     * Append t to respective ready queue on respective processor.
130
     * Append t to respective ready queue on respective processor.
131
     */
131
     */
132
    r = &cpu->rq[i];
132
    r = &cpu->rq[i];
133
    spinlock_lock(&r->lock);
133
    spinlock_lock(&r->lock);
134
    list_append(&t->rq_link, &r->rq_head);
134
    list_append(&t->rq_link, &r->rq_head);
135
    r->n++;
135
    r->n++;
136
    spinlock_unlock(&r->lock);
136
    spinlock_unlock(&r->lock);
137
 
137
 
138
    atomic_inc(&nrdy);
138
    atomic_inc(&nrdy);
139
    avg = atomic_get(&nrdy) / config.cpu_active;
139
    avg = atomic_get(&nrdy) / config.cpu_active;
140
    atomic_inc(&cpu->nrdy);
140
    atomic_inc(&cpu->nrdy);
141
 
141
 
142
    interrupts_restore(ipl);
142
    interrupts_restore(ipl);
143
}
143
}
144
 
144
 
145
 
145
 
146
/** Create new thread
146
/** Create new thread
147
 *
147
 *
148
 * Create a new thread.
148
 * Create a new thread.
149
 *
149
 *
150
 * @param func  Thread's implementing function.
150
 * @param func  Thread's implementing function.
151
 * @param arg   Thread's implementing function argument.
151
 * @param arg   Thread's implementing function argument.
152
 * @param task  Task to which the thread belongs.
152
 * @param task  Task to which the thread belongs.
153
 * @param flags Thread flags.
153
 * @param flags Thread flags.
154
 *
154
 *
155
 * @return New thread's structure on success, NULL on failure.
155
 * @return New thread's structure on success, NULL on failure.
156
 *
156
 *
157
 */
157
 */
158
thread_t *thread_create(void (* func)(void *), void *arg, task_t *task, int flags)
158
thread_t *thread_create(void (* func)(void *), void *arg, task_t *task, int flags)
159
{
159
{
160
    thread_t *t;
160
    thread_t *t;
161
    __address frame_ks, frame_us = NULL;
161
    __address frame_ks, frame_us = NULL;
162
 
162
 
163
    t = (thread_t *) malloc(sizeof(thread_t));
163
    t = (thread_t *) malloc(sizeof(thread_t));
164
    if (t) {
164
    if (t) {
165
        ipl_t ipl;
165
        ipl_t ipl;
166
   
166
   
167
        spinlock_initialize(&t->lock, "thread_t_lock");
167
        spinlock_initialize(&t->lock, "thread_t_lock");
168
   
168
   
169
        frame_ks = frame_alloc(FRAME_KA, ONE_FRAME, NULL, NULL);
169
        frame_ks = frame_alloc(ONE_FRAME, FRAME_KA);
170
        if (THREAD_USER_STACK & flags) {
170
        if (THREAD_USER_STACK & flags) {
171
            frame_us = frame_alloc(FRAME_KA, ONE_FRAME, NULL,NULL);
171
            frame_us = frame_alloc(ONE_FRAME, FRAME_KA);
172
        }
172
        }
173
 
173
 
174
        ipl = interrupts_disable();
174
        ipl = interrupts_disable();
175
        spinlock_lock(&tidlock);
175
        spinlock_lock(&tidlock);
176
        t->tid = ++last_tid;
176
        t->tid = ++last_tid;
177
        spinlock_unlock(&tidlock);
177
        spinlock_unlock(&tidlock);
178
        interrupts_restore(ipl);
178
        interrupts_restore(ipl);
179
       
179
       
180
        memsetb(frame_ks, THREAD_STACK_SIZE, 0);
180
        memsetb(frame_ks, THREAD_STACK_SIZE, 0);
181
        link_initialize(&t->rq_link);
181
        link_initialize(&t->rq_link);
182
        link_initialize(&t->wq_link);
182
        link_initialize(&t->wq_link);
183
        link_initialize(&t->th_link);
183
        link_initialize(&t->th_link);
184
        link_initialize(&t->threads_link);
184
        link_initialize(&t->threads_link);
185
        t->kstack = (__u8 *) frame_ks;
185
        t->kstack = (__u8 *) frame_ks;
186
        t->ustack = (__u8 *) frame_us;
186
        t->ustack = (__u8 *) frame_us;
187
       
187
       
188
        context_save(&t->saved_context);
188
        context_save(&t->saved_context);
189
        context_set(&t->saved_context, FADDR(cushion), (__address) t->kstack, THREAD_STACK_SIZE);
189
        context_set(&t->saved_context, FADDR(cushion), (__address) t->kstack, THREAD_STACK_SIZE);
190
       
190
       
191
        the_initialize((the_t *) t->kstack);
191
        the_initialize((the_t *) t->kstack);
192
 
192
 
193
        ipl = interrupts_disable();
193
        ipl = interrupts_disable();
194
        t->saved_context.ipl = interrupts_read();
194
        t->saved_context.ipl = interrupts_read();
195
        interrupts_restore(ipl);
195
        interrupts_restore(ipl);
196
       
196
       
197
        t->thread_code = func;
197
        t->thread_code = func;
198
        t->thread_arg = arg;
198
        t->thread_arg = arg;
199
        t->ticks = -1;
199
        t->ticks = -1;
200
        t->priority = -1;       /* start in rq[0] */
200
        t->priority = -1;       /* start in rq[0] */
201
        t->cpu = NULL;
201
        t->cpu = NULL;
202
        t->flags = 0;
202
        t->flags = 0;
203
        t->state = Entering;
203
        t->state = Entering;
204
        t->call_me = NULL;
204
        t->call_me = NULL;
205
        t->call_me_with = NULL;
205
        t->call_me_with = NULL;
206
       
206
       
207
        timeout_initialize(&t->sleep_timeout);
207
        timeout_initialize(&t->sleep_timeout);
208
        t->sleep_queue = NULL;
208
        t->sleep_queue = NULL;
209
        t->timeout_pending = 0;
209
        t->timeout_pending = 0;
210
       
210
       
211
        t->rwlock_holder_type = RWLOCK_NONE;
211
        t->rwlock_holder_type = RWLOCK_NONE;
212
       
212
       
213
        t->task = task;
213
        t->task = task;
214
       
214
       
215
        t->fpu_context_exists=0;
215
        t->fpu_context_exists=0;
216
        t->fpu_context_engaged=0;
216
        t->fpu_context_engaged=0;
217
       
217
       
218
        /*
218
        /*
219
         * Register this thread in the system-wide list.
219
         * Register this thread in the system-wide list.
220
         */
220
         */
221
        ipl = interrupts_disable();    
221
        ipl = interrupts_disable();    
222
        spinlock_lock(&threads_lock);
222
        spinlock_lock(&threads_lock);
223
        list_append(&t->threads_link, &threads_head);
223
        list_append(&t->threads_link, &threads_head);
224
        spinlock_unlock(&threads_lock);
224
        spinlock_unlock(&threads_lock);
225
 
225
 
226
        /*
226
        /*
227
         * Attach to the containing task.
227
         * Attach to the containing task.
228
         */
228
         */
229
        spinlock_lock(&task->lock);
229
        spinlock_lock(&task->lock);
230
        list_append(&t->th_link, &task->th_head);
230
        list_append(&t->th_link, &task->th_head);
231
        spinlock_unlock(&task->lock);
231
        spinlock_unlock(&task->lock);
232
 
232
 
233
        interrupts_restore(ipl);
233
        interrupts_restore(ipl);
234
    }
234
    }
235
 
235
 
236
    return t;
236
    return t;
237
}
237
}
238
 
238
 
239
 
239
 
240
/** Make thread exiting
240
/** Make thread exiting
241
 *
241
 *
242
 * End current thread execution and switch it to the exiting
242
 * End current thread execution and switch it to the exiting
243
 * state. All pending timeouts are executed.
243
 * state. All pending timeouts are executed.
244
 *
244
 *
245
 */
245
 */
246
void thread_exit(void)
246
void thread_exit(void)
247
{
247
{
248
    ipl_t ipl;
248
    ipl_t ipl;
249
 
249
 
250
restart:
250
restart:
251
    ipl = interrupts_disable();
251
    ipl = interrupts_disable();
252
    spinlock_lock(&THREAD->lock);
252
    spinlock_lock(&THREAD->lock);
253
    if (THREAD->timeout_pending) { /* busy waiting for timeouts in progress */
253
    if (THREAD->timeout_pending) { /* busy waiting for timeouts in progress */
254
        spinlock_unlock(&THREAD->lock);
254
        spinlock_unlock(&THREAD->lock);
255
        interrupts_restore(ipl);
255
        interrupts_restore(ipl);
256
        goto restart;
256
        goto restart;
257
    }
257
    }
258
    THREAD->state = Exiting;
258
    THREAD->state = Exiting;
259
    spinlock_unlock(&THREAD->lock);
259
    spinlock_unlock(&THREAD->lock);
260
    scheduler();
260
    scheduler();
261
}
261
}
262
 
262
 
263
 
263
 
264
/** Thread sleep
264
/** Thread sleep
265
 *
265
 *
266
 * Suspend execution of the current thread.
266
 * Suspend execution of the current thread.
267
 *
267
 *
268
 * @param sec Number of seconds to sleep.
268
 * @param sec Number of seconds to sleep.
269
 *
269
 *
270
 */
270
 */
271
void thread_sleep(__u32 sec)
271
void thread_sleep(__u32 sec)
272
{
272
{
273
    thread_usleep(sec*1000000);
273
    thread_usleep(sec*1000000);
274
}
274
}
275
 
275
 
276
 
276
 
277
/** Thread usleep
277
/** Thread usleep
278
 *
278
 *
279
 * Suspend execution of the current thread.
279
 * Suspend execution of the current thread.
280
 *
280
 *
281
 * @param usec Number of microseconds to sleep.
281
 * @param usec Number of microseconds to sleep.
282
 *
282
 *
283
 */
283
 */
284
void thread_usleep(__u32 usec)
284
void thread_usleep(__u32 usec)
285
{
285
{
286
    waitq_t wq;
286
    waitq_t wq;
287
                 
287
                 
288
    waitq_initialize(&wq);
288
    waitq_initialize(&wq);
289
 
289
 
290
    (void) waitq_sleep_timeout(&wq, usec, SYNCH_NON_BLOCKING);
290
    (void) waitq_sleep_timeout(&wq, usec, SYNCH_NON_BLOCKING);
291
}
291
}
292
 
292
 
293
 
293
 
294
/** Register thread out-of-context invocation
294
/** Register thread out-of-context invocation
295
 *
295
 *
296
 * Register a function and its argument to be executed
296
 * Register a function and its argument to be executed
297
 * on next context switch to the current thread.
297
 * on next context switch to the current thread.
298
 *
298
 *
299
 * @param call_me      Out-of-context function.
299
 * @param call_me      Out-of-context function.
300
 * @param call_me_with Out-of-context function argument.
300
 * @param call_me_with Out-of-context function argument.
301
 *
301
 *
302
 */
302
 */
303
void thread_register_call_me(void (* call_me)(void *), void *call_me_with)
303
void thread_register_call_me(void (* call_me)(void *), void *call_me_with)
304
{
304
{
305
    ipl_t ipl;
305
    ipl_t ipl;
306
   
306
   
307
    ipl = interrupts_disable();
307
    ipl = interrupts_disable();
308
    spinlock_lock(&THREAD->lock);
308
    spinlock_lock(&THREAD->lock);
309
    THREAD->call_me = call_me;
309
    THREAD->call_me = call_me;
310
    THREAD->call_me_with = call_me_with;
310
    THREAD->call_me_with = call_me_with;
311
    spinlock_unlock(&THREAD->lock);
311
    spinlock_unlock(&THREAD->lock);
312
    interrupts_restore(ipl);
312
    interrupts_restore(ipl);
313
}
313
}
314
 
314
 
315
/** Print list of threads debug info */
315
/** Print list of threads debug info */
316
void thread_print_list(void)
316
void thread_print_list(void)
317
{
317
{
318
    link_t *cur;
318
    link_t *cur;
319
    thread_t *t;
319
    thread_t *t;
320
    ipl_t ipl;
320
    ipl_t ipl;
321
   
321
   
322
    /* Messing with thread structures, avoid deadlock */
322
    /* Messing with thread structures, avoid deadlock */
323
    ipl = interrupts_disable();
323
    ipl = interrupts_disable();
324
    spinlock_lock(&threads_lock);
324
    spinlock_lock(&threads_lock);
325
 
325
 
326
    for (cur=threads_head.next; cur!=&threads_head; cur=cur->next) {
326
    for (cur=threads_head.next; cur!=&threads_head; cur=cur->next) {
327
        t = list_get_instance(cur, thread_t, threads_link);
327
        t = list_get_instance(cur, thread_t, threads_link);
328
        printf("Thr: %d(%s) ", t->tid, thread_states[t->state]);
328
        printf("Thr: %d(%s) ", t->tid, thread_states[t->state]);
329
        if (t->cpu)
329
        if (t->cpu)
330
            printf("cpu%d ", t->cpu->id);
330
            printf("cpu%d ", t->cpu->id);
331
       
331
       
332
        printf("\n");
332
        printf("\n");
333
    }
333
    }
334
 
334
 
335
    spinlock_unlock(&threads_lock);
335
    spinlock_unlock(&threads_lock);
336
    interrupts_enable();
336
    interrupts_enable();
337
}
337
}
338
 
338