Subversion Repositories HelenOS

Rev

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

Rev 3424 Rev 3425
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
/** @addtogroup genericproc
29
/** @addtogroup genericproc
30
 * @{
30
 * @{
31
 */
31
 */
32
 
32
 
33
/**
33
/**
34
 * @file
34
 * @file
35
 * @brief   Thread management functions.
35
 * @brief   Thread management functions.
36
 */
36
 */
37
 
37
 
38
#include <proc/scheduler.h>
38
#include <proc/scheduler.h>
39
#include <proc/thread.h>
39
#include <proc/thread.h>
40
#include <proc/task.h>
40
#include <proc/task.h>
41
#include <proc/uarg.h>
41
#include <proc/uarg.h>
42
#include <mm/frame.h>
42
#include <mm/frame.h>
43
#include <mm/page.h>
43
#include <mm/page.h>
44
#include <arch/asm.h>
44
#include <arch/asm.h>
45
#include <arch/cycle.h>
45
#include <arch/cycle.h>
46
#include <arch.h>
46
#include <arch.h>
47
#include <synch/synch.h>
47
#include <synch/synch.h>
48
#include <synch/spinlock.h>
48
#include <synch/spinlock.h>
49
#include <synch/waitq.h>
49
#include <synch/waitq.h>
50
#include <synch/rwlock.h>
50
#include <synch/rwlock.h>
51
#include <cpu.h>
51
#include <cpu.h>
52
#include <func.h>
52
#include <func.h>
53
#include <context.h>
53
#include <context.h>
54
#include <adt/avl.h>
54
#include <adt/avl.h>
55
#include <adt/list.h>
55
#include <adt/list.h>
56
#include <time/clock.h>
56
#include <time/clock.h>
57
#include <time/timeout.h>
57
#include <time/timeout.h>
58
#include <config.h>
58
#include <config.h>
59
#include <arch/interrupt.h>
59
#include <arch/interrupt.h>
60
#include <smp/ipi.h>
60
#include <smp/ipi.h>
61
#include <arch/faddr.h>
61
#include <arch/faddr.h>
62
#include <atomic.h>
62
#include <atomic.h>
63
#include <memstr.h>
63
#include <memstr.h>
64
#include <print.h>
64
#include <print.h>
65
#include <mm/slab.h>
65
#include <mm/slab.h>
66
#include <debug.h>
66
#include <debug.h>
67
#include <main/uinit.h>
67
#include <main/uinit.h>
68
#include <syscall/copy.h>
68
#include <syscall/copy.h>
69
#include <errno.h>
69
#include <errno.h>
70
 
70
 
71
 
71
 
72
#ifndef LOADED_PROG_STACK_PAGES_NO
72
#ifndef LOADED_PROG_STACK_PAGES_NO
73
#define LOADED_PROG_STACK_PAGES_NO 1
73
#define LOADED_PROG_STACK_PAGES_NO 1
74
#endif
74
#endif
75
 
75
 
76
 
76
 
77
/** Thread states */
77
/** Thread states */
78
char *thread_states[] = {
78
char *thread_states[] = {
79
    "Invalid",
79
    "Invalid",
80
    "Running",
80
    "Running",
81
    "Sleeping",
81
    "Sleeping",
82
    "Ready",
82
    "Ready",
83
    "Entering",
83
    "Entering",
84
    "Exiting",
84
    "Exiting",
85
    "Lingering"
85
    "Lingering"
86
};
86
};
87
 
87
 
88
/** Lock protecting the threads_tree AVL tree.
88
/** Lock protecting the threads_tree AVL tree.
89
 *
89
 *
90
 * For locking rules, see declaration thereof.
90
 * For locking rules, see declaration thereof.
91
 */
91
 */
92
SPINLOCK_INITIALIZE(threads_lock);
92
SPINLOCK_INITIALIZE(threads_lock);
93
 
93
 
94
/** AVL tree of all threads.
94
/** AVL tree of all threads.
95
 *
95
 *
96
 * When a thread is found in the threads_tree AVL tree, it is guaranteed to
96
 * When a thread is found in the threads_tree AVL tree, it is guaranteed to
97
 * exist as long as the threads_lock is held.
97
 * exist as long as the threads_lock is held.
98
 */
98
 */
99
avltree_t threads_tree;    
99
avltree_t threads_tree;    
100
 
100
 
101
SPINLOCK_INITIALIZE(tidlock);
101
SPINLOCK_INITIALIZE(tidlock);
102
thread_id_t last_tid = 0;
102
thread_id_t last_tid = 0;
103
 
103
 
104
static slab_cache_t *thread_slab;
104
static slab_cache_t *thread_slab;
105
#ifdef ARCH_HAS_FPU
105
#ifdef ARCH_HAS_FPU
106
slab_cache_t *fpu_context_slab;
106
slab_cache_t *fpu_context_slab;
107
#endif
107
#endif
108
 
108
 
109
/** Thread wrapper.
109
/** Thread wrapper.
110
 *
110
 *
111
 * This wrapper is provided to ensure that every thread makes a call to
111
 * This wrapper is provided to ensure that every thread makes a call to
112
 * thread_exit() when its implementing function returns.
112
 * thread_exit() when its implementing function returns.
113
 *
113
 *
114
 * interrupts_disable() is assumed.
114
 * interrupts_disable() is assumed.
115
 *
115
 *
116
 */
116
 */
117
static void cushion(void)
117
static void cushion(void)
118
{
118
{
119
    void (*f)(void *) = THREAD->thread_code;
119
    void (*f)(void *) = THREAD->thread_code;
120
    void *arg = THREAD->thread_arg;
120
    void *arg = THREAD->thread_arg;
121
    THREAD->last_cycle = get_cycle();
121
    THREAD->last_cycle = get_cycle();
122
 
122
 
123
    /* This is where each thread wakes up after its creation */
123
    /* This is where each thread wakes up after its creation */
124
    spinlock_unlock(&THREAD->lock);
124
    spinlock_unlock(&THREAD->lock);
125
    interrupts_enable();
125
    interrupts_enable();
126
 
126
 
127
    f(arg);
127
    f(arg);
128
   
128
   
129
    /* Accumulate accounting to the task */
129
    /* Accumulate accounting to the task */
130
    ipl_t ipl = interrupts_disable();
130
    ipl_t ipl = interrupts_disable();
131
   
131
   
132
    spinlock_lock(&THREAD->lock);
132
    spinlock_lock(&THREAD->lock);
133
    if (!THREAD->uncounted) {
133
    if (!THREAD->uncounted) {
134
        thread_update_accounting();
134
        thread_update_accounting();
135
        uint64_t cycles = THREAD->cycles;
135
        uint64_t cycles = THREAD->cycles;
136
        THREAD->cycles = 0;
136
        THREAD->cycles = 0;
137
        spinlock_unlock(&THREAD->lock);
137
        spinlock_unlock(&THREAD->lock);
138
       
138
       
139
        spinlock_lock(&TASK->lock);
139
        spinlock_lock(&TASK->lock);
140
        TASK->cycles += cycles;
140
        TASK->cycles += cycles;
141
        spinlock_unlock(&TASK->lock);
141
        spinlock_unlock(&TASK->lock);
142
    } else
142
    } else
143
        spinlock_unlock(&THREAD->lock);
143
        spinlock_unlock(&THREAD->lock);
144
   
144
   
145
    interrupts_restore(ipl);
145
    interrupts_restore(ipl);
146
   
146
   
147
    thread_exit();
147
    thread_exit();
148
    /* not reached */
148
    /* not reached */
149
}
149
}
150
 
150
 
151
/** Initialization and allocation for thread_t structure */
151
/** Initialization and allocation for thread_t structure */
152
static int thr_constructor(void *obj, int kmflags)
152
static int thr_constructor(void *obj, int kmflags)
153
{
153
{
154
    thread_t *t = (thread_t *) obj;
154
    thread_t *t = (thread_t *) obj;
155
 
155
 
156
    spinlock_initialize(&t->lock, "thread_t_lock");
156
    spinlock_initialize(&t->lock, "thread_t_lock");
157
    link_initialize(&t->rq_link);
157
    link_initialize(&t->rq_link);
158
    link_initialize(&t->wq_link);
158
    link_initialize(&t->wq_link);
159
    link_initialize(&t->th_link);
159
    link_initialize(&t->th_link);
160
 
160
 
161
    /* call the architecture-specific part of the constructor */
161
    /* call the architecture-specific part of the constructor */
162
    thr_constructor_arch(t);
162
    thr_constructor_arch(t);
163
   
163
   
164
#ifdef ARCH_HAS_FPU
164
#ifdef ARCH_HAS_FPU
165
#ifdef CONFIG_FPU_LAZY
165
#ifdef CONFIG_FPU_LAZY
166
    t->saved_fpu_context = NULL;
166
    t->saved_fpu_context = NULL;
167
#else
167
#else
168
    t->saved_fpu_context = slab_alloc(fpu_context_slab, kmflags);
168
    t->saved_fpu_context = slab_alloc(fpu_context_slab, kmflags);
169
    if (!t->saved_fpu_context)
169
    if (!t->saved_fpu_context)
170
        return -1;
170
        return -1;
171
#endif
171
#endif
172
#endif  
172
#endif  
173
 
173
 
174
    t->kstack = (uint8_t *) frame_alloc(STACK_FRAMES, FRAME_KA | kmflags);
174
    t->kstack = (uint8_t *) frame_alloc(STACK_FRAMES, FRAME_KA | kmflags);
175
    if (!t->kstack) {
175
    if (!t->kstack) {
176
#ifdef ARCH_HAS_FPU
176
#ifdef ARCH_HAS_FPU
177
        if (t->saved_fpu_context)
177
        if (t->saved_fpu_context)
178
            slab_free(fpu_context_slab, t->saved_fpu_context);
178
            slab_free(fpu_context_slab, t->saved_fpu_context);
179
#endif
179
#endif
180
        return -1;
180
        return -1;
181
    }
181
    }
182
 
182
 
183
    mutex_initialize(&t->udebug.lock);
183
    mutex_initialize(&t->udebug.lock);
184
 
184
 
185
    return 0;
185
    return 0;
186
}
186
}
187
 
187
 
188
/** Destruction of thread_t object */
188
/** Destruction of thread_t object */
189
static int thr_destructor(void *obj)
189
static int thr_destructor(void *obj)
190
{
190
{
191
    thread_t *t = (thread_t *) obj;
191
    thread_t *t = (thread_t *) obj;
192
 
192
 
193
    /* call the architecture-specific part of the destructor */
193
    /* call the architecture-specific part of the destructor */
194
    thr_destructor_arch(t);
194
    thr_destructor_arch(t);
195
 
195
 
196
    frame_free(KA2PA(t->kstack));
196
    frame_free(KA2PA(t->kstack));
197
#ifdef ARCH_HAS_FPU
197
#ifdef ARCH_HAS_FPU
198
    if (t->saved_fpu_context)
198
    if (t->saved_fpu_context)
199
        slab_free(fpu_context_slab, t->saved_fpu_context);
199
        slab_free(fpu_context_slab, t->saved_fpu_context);
200
#endif
200
#endif
201
    return 1; /* One page freed */
201
    return 1; /* One page freed */
202
}
202
}
203
 
203
 
204
/** Initialize threads
204
/** Initialize threads
205
 *
205
 *
206
 * Initialize kernel threads support.
206
 * Initialize kernel threads support.
207
 *
207
 *
208
 */
208
 */
209
void thread_init(void)
209
void thread_init(void)
210
{
210
{
211
    THREAD = NULL;
211
    THREAD = NULL;
212
    atomic_set(&nrdy,0);
212
    atomic_set(&nrdy,0);
213
    thread_slab = slab_cache_create("thread_slab", sizeof(thread_t), 0,
213
    thread_slab = slab_cache_create("thread_slab", sizeof(thread_t), 0,
214
        thr_constructor, thr_destructor, 0);
214
        thr_constructor, thr_destructor, 0);
215
 
215
 
216
#ifdef ARCH_HAS_FPU
216
#ifdef ARCH_HAS_FPU
217
    fpu_context_slab = slab_cache_create("fpu_slab", sizeof(fpu_context_t),
217
    fpu_context_slab = slab_cache_create("fpu_slab", sizeof(fpu_context_t),
218
        FPU_CONTEXT_ALIGN, NULL, NULL, 0);
218
        FPU_CONTEXT_ALIGN, NULL, NULL, 0);
219
#endif
219
#endif
220
 
220
 
221
    avltree_create(&threads_tree);
221
    avltree_create(&threads_tree);
222
}
222
}
223
 
223
 
224
/** Make thread ready
224
/** Make thread ready
225
 *
225
 *
226
 * Switch thread t to the ready state.
226
 * Switch thread t to the ready state.
227
 *
227
 *
228
 * @param t Thread to make ready.
228
 * @param t Thread to make ready.
229
 *
229
 *
230
 */
230
 */
231
void thread_ready(thread_t *t)
231
void thread_ready(thread_t *t)
232
{
232
{
233
    cpu_t *cpu;
233
    cpu_t *cpu;
234
    runq_t *r;
234
    runq_t *r;
235
    ipl_t ipl;
235
    ipl_t ipl;
236
    int i, avg;
236
    int i, avg;
237
 
237
 
238
    ipl = interrupts_disable();
238
    ipl = interrupts_disable();
239
 
239
 
240
    spinlock_lock(&t->lock);
240
    spinlock_lock(&t->lock);
241
 
241
 
242
    ASSERT(!(t->state == Ready));
242
    ASSERT(!(t->state == Ready));
243
 
243
 
244
    i = (t->priority < RQ_COUNT - 1) ? ++t->priority : t->priority;
244
    i = (t->priority < RQ_COUNT - 1) ? ++t->priority : t->priority;
245
   
245
   
246
    cpu = CPU;
246
    cpu = CPU;
247
    if (t->flags & THREAD_FLAG_WIRED) {
247
    if (t->flags & THREAD_FLAG_WIRED) {
248
        ASSERT(t->cpu != NULL);
248
        ASSERT(t->cpu != NULL);
249
        cpu = t->cpu;
249
        cpu = t->cpu;
250
    }
250
    }
251
    t->state = Ready;
251
    t->state = Ready;
252
    spinlock_unlock(&t->lock);
252
    spinlock_unlock(&t->lock);
253
   
253
   
254
    /*
254
    /*
255
     * Append t to respective ready queue on respective processor.
255
     * Append t to respective ready queue on respective processor.
256
     */
256
     */
257
    r = &cpu->rq[i];
257
    r = &cpu->rq[i];
258
    spinlock_lock(&r->lock);
258
    spinlock_lock(&r->lock);
259
    list_append(&t->rq_link, &r->rq_head);
259
    list_append(&t->rq_link, &r->rq_head);
260
    r->n++;
260
    r->n++;
261
    spinlock_unlock(&r->lock);
261
    spinlock_unlock(&r->lock);
262
 
262
 
263
    atomic_inc(&nrdy);
263
    atomic_inc(&nrdy);
264
    avg = atomic_get(&nrdy) / config.cpu_active;
264
    avg = atomic_get(&nrdy) / config.cpu_active;
265
    atomic_inc(&cpu->nrdy);
265
    atomic_inc(&cpu->nrdy);
266
 
266
 
267
    interrupts_restore(ipl);
267
    interrupts_restore(ipl);
268
}
268
}
269
 
269
 
270
/** Create new thread
270
/** Create new thread
271
 *
271
 *
272
 * Create a new thread.
272
 * Create a new thread.
273
 *
273
 *
274
 * @param func      Thread's implementing function.
274
 * @param func      Thread's implementing function.
275
 * @param arg       Thread's implementing function argument.
275
 * @param arg       Thread's implementing function argument.
276
 * @param task      Task to which the thread belongs. The caller must
276
 * @param task      Task to which the thread belongs. The caller must
277
 *          guarantee that the task won't cease to exist during the
277
 *          guarantee that the task won't cease to exist during the
278
 *          call. The task's lock may not be held.
278
 *          call. The task's lock may not be held.
279
 * @param flags     Thread flags.
279
 * @param flags     Thread flags.
280
 * @param name      Symbolic name.
280
 * @param name      Symbolic name.
281
 * @param uncounted Thread's accounting doesn't affect accumulated task
281
 * @param uncounted Thread's accounting doesn't affect accumulated task
282
 *          accounting.
282
 *          accounting.
283
 *
283
 *
284
 * @return      New thread's structure on success, NULL on failure.
284
 * @return      New thread's structure on success, NULL on failure.
285
 *
285
 *
286
 */
286
 */
287
thread_t *thread_create(void (* func)(void *), void *arg, task_t *task,
287
thread_t *thread_create(void (* func)(void *), void *arg, task_t *task,
288
    int flags, char *name, bool uncounted)
288
    int flags, char *name, bool uncounted)
289
{
289
{
290
    thread_t *t;
290
    thread_t *t;
291
    ipl_t ipl;
291
    ipl_t ipl;
292
   
292
   
293
    t = (thread_t *) slab_alloc(thread_slab, 0);
293
    t = (thread_t *) slab_alloc(thread_slab, 0);
294
    if (!t)
294
    if (!t)
295
        return NULL;
295
        return NULL;
296
   
296
   
297
    /* Not needed, but good for debugging */
297
    /* Not needed, but good for debugging */
298
    memsetb(t->kstack, THREAD_STACK_SIZE * 1 << STACK_FRAMES, 0);
298
    memsetb(t->kstack, THREAD_STACK_SIZE * 1 << STACK_FRAMES, 0);
299
   
299
   
300
    ipl = interrupts_disable();
300
    ipl = interrupts_disable();
301
    spinlock_lock(&tidlock);
301
    spinlock_lock(&tidlock);
302
    t->tid = ++last_tid;
302
    t->tid = ++last_tid;
303
    spinlock_unlock(&tidlock);
303
    spinlock_unlock(&tidlock);
304
    interrupts_restore(ipl);
304
    interrupts_restore(ipl);
305
   
305
   
306
    context_save(&t->saved_context);
306
    context_save(&t->saved_context);
307
    context_set(&t->saved_context, FADDR(cushion), (uintptr_t) t->kstack,
307
    context_set(&t->saved_context, FADDR(cushion), (uintptr_t) t->kstack,
308
        THREAD_STACK_SIZE);
308
        THREAD_STACK_SIZE);
309
   
309
   
310
    the_initialize((the_t *) t->kstack);
310
    the_initialize((the_t *) t->kstack);
311
   
311
   
312
    ipl = interrupts_disable();
312
    ipl = interrupts_disable();
313
    t->saved_context.ipl = interrupts_read();
313
    t->saved_context.ipl = interrupts_read();
314
    interrupts_restore(ipl);
314
    interrupts_restore(ipl);
315
   
315
   
316
    memcpy(t->name, name, THREAD_NAME_BUFLEN);
316
    memcpy(t->name, name, THREAD_NAME_BUFLEN);
317
   
317
   
318
    t->thread_code = func;
318
    t->thread_code = func;
319
    t->thread_arg = arg;
319
    t->thread_arg = arg;
320
    t->ticks = -1;
320
    t->ticks = -1;
321
    t->cycles = 0;
321
    t->cycles = 0;
322
    t->uncounted = uncounted;
322
    t->uncounted = uncounted;
323
    t->priority = -1;       /* start in rq[0] */
323
    t->priority = -1;       /* start in rq[0] */
324
    t->cpu = NULL;
324
    t->cpu = NULL;
325
    t->flags = flags;
325
    t->flags = flags;
326
    t->state = Entering;
326
    t->state = Entering;
327
    t->call_me = NULL;
327
    t->call_me = NULL;
328
    t->call_me_with = NULL;
328
    t->call_me_with = NULL;
329
   
329
   
330
    timeout_initialize(&t->sleep_timeout);
330
    timeout_initialize(&t->sleep_timeout);
331
    t->sleep_interruptible = false;
331
    t->sleep_interruptible = false;
332
    t->sleep_queue = NULL;
332
    t->sleep_queue = NULL;
333
    t->timeout_pending = 0;
333
    t->timeout_pending = 0;
334
 
334
 
335
    t->in_copy_from_uspace = false;
335
    t->in_copy_from_uspace = false;
336
    t->in_copy_to_uspace = false;
336
    t->in_copy_to_uspace = false;
337
 
337
 
338
    t->interrupted = false;
338
    t->interrupted = false;
339
    t->detached = false;
339
    t->detached = false;
340
    waitq_initialize(&t->join_wq);
340
    waitq_initialize(&t->join_wq);
341
   
341
   
342
    t->rwlock_holder_type = RWLOCK_NONE;
342
    t->rwlock_holder_type = RWLOCK_NONE;
343
       
343
       
344
    t->task = task;
344
    t->task = task;
345
   
345
   
346
    t->fpu_context_exists = 0;
346
    t->fpu_context_exists = 0;
347
    t->fpu_context_engaged = 0;
347
    t->fpu_context_engaged = 0;
348
 
348
 
349
    avltree_node_initialize(&t->threads_tree_node);
349
    avltree_node_initialize(&t->threads_tree_node);
350
    t->threads_tree_node.key = (uintptr_t) t;
350
    t->threads_tree_node.key = (uintptr_t) t;
351
   
351
   
352
    /* Init debugging stuff */
352
    /* Init debugging stuff */
353
    udebug_thread_initialize(&t->udebug);
353
    udebug_thread_initialize(&t->udebug);
354
 
354
 
355
    /* might depend on previous initialization */
355
    /* might depend on previous initialization */
356
    thread_create_arch(t); 
356
    thread_create_arch(t); 
357
 
357
 
358
    if (!(flags & THREAD_FLAG_NOATTACH))
358
    if (!(flags & THREAD_FLAG_NOATTACH))
359
        thread_attach(t, task);
359
        thread_attach(t, task);
360
 
360
 
361
    return t;
361
    return t;
362
}
362
}
363
 
363
 
364
/** Destroy thread memory structure
364
/** Destroy thread memory structure
365
 *
365
 *
366
 * Detach thread from all queues, cpus etc. and destroy it.
366
 * Detach thread from all queues, cpus etc. and destroy it.
367
 *
367
 *
368
 * Assume thread->lock is held!!
368
 * Assume thread->lock is held!!
369
 */
369
 */
370
void thread_destroy(thread_t *t)
370
void thread_destroy(thread_t *t)
371
{
371
{
372
    ASSERT(t->state == Exiting || t->state == Lingering);
372
    ASSERT(t->state == Exiting || t->state == Lingering);
373
    ASSERT(t->task);
373
    ASSERT(t->task);
374
    ASSERT(t->cpu);
374
    ASSERT(t->cpu);
375
 
375
 
376
    spinlock_lock(&t->cpu->lock);
376
    spinlock_lock(&t->cpu->lock);
377
    if (t->cpu->fpu_owner == t)
377
    if (t->cpu->fpu_owner == t)
378
        t->cpu->fpu_owner = NULL;
378
        t->cpu->fpu_owner = NULL;
379
    spinlock_unlock(&t->cpu->lock);
379
    spinlock_unlock(&t->cpu->lock);
380
 
380
 
381
    spinlock_unlock(&t->lock);
381
    spinlock_unlock(&t->lock);
382
 
382
 
383
    spinlock_lock(&threads_lock);
383
    spinlock_lock(&threads_lock);
384
    avltree_delete(&threads_tree, &t->threads_tree_node);
384
    avltree_delete(&threads_tree, &t->threads_tree_node);
385
    spinlock_unlock(&threads_lock);
385
    spinlock_unlock(&threads_lock);
386
 
386
 
387
    /*
387
    /*
388
     * Detach from the containing task.
388
     * Detach from the containing task.
389
     */
389
     */
390
    spinlock_lock(&t->task->lock);
390
    spinlock_lock(&t->task->lock);
391
    list_remove(&t->th_link);
391
    list_remove(&t->th_link);
392
    spinlock_unlock(&t->task->lock);   
392
    spinlock_unlock(&t->task->lock);   
393
 
393
 
394
    /*
394
    /*
395
     * t is guaranteed to be the very last thread of its task.
395
     * t is guaranteed to be the very last thread of its task.
396
     * It is safe to destroy the task.
396
     * It is safe to destroy the task.
397
     */
397
     */
398
    if (atomic_predec(&t->task->refcount) == 0)
398
    if (atomic_predec(&t->task->refcount) == 0)
399
        task_destroy(t->task);
399
        task_destroy(t->task);
400
   
400
   
401
    slab_free(thread_slab, t);
401
    slab_free(thread_slab, t);
402
}
402
}
403
 
403
 
404
/** Make the thread visible to the system.
404
/** Make the thread visible to the system.
405
 *
405
 *
406
 * Attach the thread structure to the current task and make it visible in the
406
 * Attach the thread structure to the current task and make it visible in the
407
 * threads_tree.
407
 * threads_tree.
408
 *
408
 *
409
 * @param t Thread to be attached to the task.
409
 * @param t Thread to be attached to the task.
410
 * @param task  Task to which the thread is to be attached.
410
 * @param task  Task to which the thread is to be attached.
411
 */
411
 */
412
void thread_attach(thread_t *t, task_t *task)
412
void thread_attach(thread_t *t, task_t *task)
413
{
413
{
414
    ipl_t ipl;
414
    ipl_t ipl;
415
 
415
 
416
    /*
416
    /*
417
     * Attach to the specified task.
417
     * Attach to the specified task.
418
     */
418
     */
419
    ipl = interrupts_disable();
419
    ipl = interrupts_disable();
420
    spinlock_lock(&task->lock);
420
    spinlock_lock(&task->lock);
421
    atomic_inc(&task->refcount);
421
    atomic_inc(&task->refcount);
422
    /* Must not count kbox thread into lifecount */
422
    /* Must not count kbox thread into lifecount */
423
    if (t->flags & THREAD_FLAG_USPACE)
423
    if (t->flags & THREAD_FLAG_USPACE)
424
        atomic_inc(&task->lifecount);
424
        atomic_inc(&task->lifecount);
425
    list_append(&t->th_link, &task->th_head);
425
    list_append(&t->th_link, &task->th_head);
426
    spinlock_unlock(&task->lock);
426
    spinlock_unlock(&task->lock);
427
 
427
 
428
    /*
428
    /*
429
     * Register this thread in the system-wide list.
429
     * Register this thread in the system-wide list.
430
     */
430
     */
431
    spinlock_lock(&threads_lock);
431
    spinlock_lock(&threads_lock);
432
    avltree_insert(&threads_tree, &t->threads_tree_node);
432
    avltree_insert(&threads_tree, &t->threads_tree_node);
433
    spinlock_unlock(&threads_lock);
433
    spinlock_unlock(&threads_lock);
434
   
434
   
435
    interrupts_restore(ipl);
435
    interrupts_restore(ipl);
436
}
436
}
437
 
437
 
438
/** Terminate thread.
438
/** Terminate thread.
439
 *
439
 *
440
 * End current thread execution and switch it to the exiting state. All pending
440
 * End current thread execution and switch it to the exiting state. All pending
441
 * timeouts are executed.
441
 * timeouts are executed.
442
 */
442
 */
443
void thread_exit(void)
443
void thread_exit(void)
444
{
444
{
445
    ipl_t ipl;
445
    ipl_t ipl;
446
 
446
 
447
    if (THREAD->flags & THREAD_FLAG_USPACE) {
447
    if (THREAD->flags & THREAD_FLAG_USPACE) {
448
        /* Generate udebug THREAD_E event */
448
        /* Generate udebug THREAD_E event */
449
        udebug_thread_e_event();
449
        udebug_thread_e_event();
450
 
450
 
451
        if (atomic_predec(&TASK->lifecount) == 0) {
451
        if (atomic_predec(&TASK->lifecount) == 0) {
452
            /*
452
            /*
453
             * We are the last userspace thread in the task that
453
             * We are the last userspace thread in the task that
454
             * still has not exited. With the exception of the
454
             * still has not exited. With the exception of the
455
             * moment the task was created, new userspace threads
455
             * moment the task was created, new userspace threads
456
             * can only be created by threads of the same task.
456
             * can only be created by threads of the same task.
457
             * We are safe to perform cleanup.
457
             * We are safe to perform cleanup.
458
             */
458
             */
459
            ipc_cleanup();
459
            ipc_cleanup();
460
            futex_cleanup();
460
            futex_cleanup();
461
            LOG("Cleanup of task %" PRIu64" completed.", TASK->taskid);
461
            LOG("Cleanup of task %" PRIu64" completed.", TASK->taskid);
462
        }
462
        }
463
    }
463
    }
464
 
464
 
465
restart:
465
restart:
466
    ipl = interrupts_disable();
466
    ipl = interrupts_disable();
467
    spinlock_lock(&THREAD->lock);
467
    spinlock_lock(&THREAD->lock);
468
    if (THREAD->timeout_pending) {
468
    if (THREAD->timeout_pending) {
469
        /* busy waiting for timeouts in progress */
469
        /* busy waiting for timeouts in progress */
470
        spinlock_unlock(&THREAD->lock);
470
        spinlock_unlock(&THREAD->lock);
471
        interrupts_restore(ipl);
471
        interrupts_restore(ipl);
472
        goto restart;
472
        goto restart;
473
    }
473
    }
474
   
474
   
475
    THREAD->state = Exiting;
475
    THREAD->state = Exiting;
476
    spinlock_unlock(&THREAD->lock);
476
    spinlock_unlock(&THREAD->lock);
477
    scheduler();
477
    scheduler();
478
 
478
 
479
    /* Not reached */
479
    /* Not reached */
480
    while (1)
480
    while (1)
481
        ;
481
        ;
482
}
482
}
483
 
483
 
484
 
484
 
485
/** Thread sleep
485
/** Thread sleep
486
 *
486
 *
487
 * Suspend execution of the current thread.
487
 * Suspend execution of the current thread.
488
 *
488
 *
489
 * @param sec Number of seconds to sleep.
489
 * @param sec Number of seconds to sleep.
490
 *
490
 *
491
 */
491
 */
492
void thread_sleep(uint32_t sec)
492
void thread_sleep(uint32_t sec)
493
{
493
{
494
    thread_usleep(sec * 1000000);
494
    thread_usleep(sec * 1000000);
495
}
495
}
496
 
496
 
497
/** Wait for another thread to exit.
497
/** Wait for another thread to exit.
498
 *
498
 *
499
 * @param t Thread to join on exit.
499
 * @param t Thread to join on exit.
500
 * @param usec Timeout in microseconds.
500
 * @param usec Timeout in microseconds.
501
 * @param flags Mode of operation.
501
 * @param flags Mode of operation.
502
 *
502
 *
503
 * @return An error code from errno.h or an error code from synch.h.
503
 * @return An error code from errno.h or an error code from synch.h.
504
 */
504
 */
505
int thread_join_timeout(thread_t *t, uint32_t usec, int flags)
505
int thread_join_timeout(thread_t *t, uint32_t usec, int flags)
506
{
506
{
507
    ipl_t ipl;
507
    ipl_t ipl;
508
    int rc;
508
    int rc;
509
 
509
 
510
    if (t == THREAD)
510
    if (t == THREAD)
511
        return EINVAL;
511
        return EINVAL;
512
 
512
 
513
    /*
513
    /*
514
     * Since thread join can only be called once on an undetached thread,
514
     * Since thread join can only be called once on an undetached thread,
515
     * the thread pointer is guaranteed to be still valid.
515
     * the thread pointer is guaranteed to be still valid.
516
     */
516
     */
517
   
517
   
518
    ipl = interrupts_disable();
518
    ipl = interrupts_disable();
519
    spinlock_lock(&t->lock);
519
    spinlock_lock(&t->lock);
520
    ASSERT(!t->detached);
520
    ASSERT(!t->detached);
521
    spinlock_unlock(&t->lock);
521
    spinlock_unlock(&t->lock);
522
    interrupts_restore(ipl);
522
    interrupts_restore(ipl);
523
   
523
   
524
    rc = waitq_sleep_timeout(&t->join_wq, usec, flags);
524
    rc = waitq_sleep_timeout(&t->join_wq, usec, flags);
525
   
525
   
526
    return rc; 
526
    return rc; 
527
}
527
}
528
 
528
 
529
/** Detach thread.
529
/** Detach thread.
530
 *
530
 *
531
 * Mark the thread as detached, if the thread is already in the Lingering
531
 * Mark the thread as detached, if the thread is already in the Lingering
532
 * state, deallocate its resources.
532
 * state, deallocate its resources.
533
 *
533
 *
534
 * @param t Thread to be detached.
534
 * @param t Thread to be detached.
535
 */
535
 */
536
void thread_detach(thread_t *t)
536
void thread_detach(thread_t *t)
537
{
537
{
538
    ipl_t ipl;
538
    ipl_t ipl;
539
 
539
 
540
    /*
540
    /*
541
     * Since the thread is expected not to be already detached,
541
     * Since the thread is expected not to be already detached,
542
     * pointer to it must be still valid.
542
     * pointer to it must be still valid.
543
     */
543
     */
544
    ipl = interrupts_disable();
544
    ipl = interrupts_disable();
545
    spinlock_lock(&t->lock);
545
    spinlock_lock(&t->lock);
546
    ASSERT(!t->detached);
546
    ASSERT(!t->detached);
547
    if (t->state == Lingering) {
547
    if (t->state == Lingering) {
548
        thread_destroy(t);  /* unlocks &t->lock */
548
        thread_destroy(t);  /* unlocks &t->lock */
549
        interrupts_restore(ipl);
549
        interrupts_restore(ipl);
550
        return;
550
        return;
551
    } else {
551
    } else {
552
        t->detached = true;
552
        t->detached = true;
553
    }
553
    }
554
    spinlock_unlock(&t->lock);
554
    spinlock_unlock(&t->lock);
555
    interrupts_restore(ipl);
555
    interrupts_restore(ipl);
556
}
556
}
557
 
557
 
558
/** Thread usleep
558
/** Thread usleep
559
 *
559
 *
560
 * Suspend execution of the current thread.
560
 * Suspend execution of the current thread.
561
 *
561
 *
562
 * @param usec Number of microseconds to sleep.
562
 * @param usec Number of microseconds to sleep.
563
 *
563
 *
564
 */
564
 */
565
void thread_usleep(uint32_t usec)
565
void thread_usleep(uint32_t usec)
566
{
566
{
567
    waitq_t wq;
567
    waitq_t wq;
568
                 
568
                 
569
    waitq_initialize(&wq);
569
    waitq_initialize(&wq);
570
 
570
 
571
    (void) waitq_sleep_timeout(&wq, usec, SYNCH_FLAGS_NON_BLOCKING);
571
    (void) waitq_sleep_timeout(&wq, usec, SYNCH_FLAGS_NON_BLOCKING);
572
}
572
}
573
 
573
 
574
/** Register thread out-of-context invocation
574
/** Register thread out-of-context invocation
575
 *
575
 *
576
 * Register a function and its argument to be executed
576
 * Register a function and its argument to be executed
577
 * on next context switch to the current thread.
577
 * on next context switch to the current thread.
578
 *
578
 *
579
 * @param call_me      Out-of-context function.
579
 * @param call_me      Out-of-context function.
580
 * @param call_me_with Out-of-context function argument.
580
 * @param call_me_with Out-of-context function argument.
581
 *
581
 *
582
 */
582
 */
583
void thread_register_call_me(void (* call_me)(void *), void *call_me_with)
583
void thread_register_call_me(void (* call_me)(void *), void *call_me_with)
584
{
584
{
585
    ipl_t ipl;
585
    ipl_t ipl;
586
   
586
   
587
    ipl = interrupts_disable();
587
    ipl = interrupts_disable();
588
    spinlock_lock(&THREAD->lock);
588
    spinlock_lock(&THREAD->lock);
589
    THREAD->call_me = call_me;
589
    THREAD->call_me = call_me;
590
    THREAD->call_me_with = call_me_with;
590
    THREAD->call_me_with = call_me_with;
591
    spinlock_unlock(&THREAD->lock);
591
    spinlock_unlock(&THREAD->lock);
592
    interrupts_restore(ipl);
592
    interrupts_restore(ipl);
593
}
593
}
594
 
594
 
595
static bool thread_walker(avltree_node_t *node, void *arg)
595
static bool thread_walker(avltree_node_t *node, void *arg)
596
{
596
{
597
    thread_t *t = avltree_get_instance(node, thread_t, threads_tree_node);
597
    thread_t *t = avltree_get_instance(node, thread_t, threads_tree_node);
598
   
598
   
599
    uint64_t cycles;
599
    uint64_t cycles;
600
    char suffix;
600
    char suffix;
601
    order(t->cycles, &cycles, &suffix);
601
    order(t->cycles, &cycles, &suffix);
602
 
602
 
603
#ifdef __32_BITS__
603
#ifdef __32_BITS__
604
    printf("%-6" PRIu64" %-10s %10p %-8s %10p %-3" PRIu32 " %10p %10p %9" PRIu64 "%c ",
604
    printf("%-6" PRIu64" %-10s %10p %-8s %10p %-3" PRIu32 " %10p %10p %9" PRIu64 "%c ",
605
        t->tid, t->name, t, thread_states[t->state], t->task,
605
        t->tid, t->name, t, thread_states[t->state], t->task,
606
        t->task->context, t->thread_code, t->kstack, cycles, suffix);
606
        t->task->context, t->thread_code, t->kstack, cycles, suffix);
607
#endif
607
#endif
608
 
608
 
609
#ifdef __64_BITS__
609
#ifdef __64_BITS__
610
    printf("%-6" PRIu64" %-10s %18p %-8s %18p %-3" PRIu32 " %18p %18p %9" PRIu64 "%c ",
610
    printf("%-6" PRIu64" %-10s %18p %-8s %18p %-3" PRIu32 " %18p %18p %9" PRIu64 "%c ",
611
        t->tid, t->name, t, thread_states[t->state], t->task,
611
        t->tid, t->name, t, thread_states[t->state], t->task,
612
        t->task->context, t->thread_code, t->kstack, cycles, suffix);
612
        t->task->context, t->thread_code, t->kstack, cycles, suffix);
613
#endif
613
#endif
614
           
614
           
615
    if (t->cpu)
615
    if (t->cpu)
616
        printf("%-4u", t->cpu->id);
616
        printf("%-4u", t->cpu->id);
617
    else
617
    else
618
        printf("none");
618
        printf("none");
619
           
619
           
620
    if (t->state == Sleeping) {
620
    if (t->state == Sleeping) {
621
#ifdef __32_BITS__
621
#ifdef __32_BITS__
622
        printf(" %10p", t->sleep_queue);
622
        printf(" %10p", t->sleep_queue);
623
#endif
623
#endif
624
 
624
 
625
#ifdef __64_BITS__
625
#ifdef __64_BITS__
626
        printf(" %18p", t->sleep_queue);
626
        printf(" %18p", t->sleep_queue);
627
#endif
627
#endif
628
    }
628
    }
629
           
629
           
630
    printf("\n");
630
    printf("\n");
631
 
631
 
632
    return true;
632
    return true;
633
}
633
}
634
 
634
 
635
/** Print list of threads debug info */
635
/** Print list of threads debug info */
636
void thread_print_list(void)
636
void thread_print_list(void)
637
{
637
{
638
    ipl_t ipl;
638
    ipl_t ipl;
639
   
639
   
640
    /* Messing with thread structures, avoid deadlock */
640
    /* Messing with thread structures, avoid deadlock */
641
    ipl = interrupts_disable();
641
    ipl = interrupts_disable();
642
    spinlock_lock(&threads_lock);
642
    spinlock_lock(&threads_lock);
643
 
643
 
644
#ifdef __32_BITS__  
644
#ifdef __32_BITS__  
645
    printf("tid    name       address    state    task       "
645
    printf("tid    name       address    state    task       "
646
        "ctx code       stack      cycles     cpu  "
646
        "ctx code       stack      cycles     cpu  "
647
        "waitqueue\n");
647
        "waitqueue\n");
648
    printf("------ ---------- ---------- -------- ---------- "
648
    printf("------ ---------- ---------- -------- ---------- "
649
        "--- ---------- ---------- ---------- ---- "
649
        "--- ---------- ---------- ---------- ---- "
650
        "----------\n");
650
        "----------\n");
651
#endif
651
#endif
652
 
652
 
653
#ifdef __64_BITS__
653
#ifdef __64_BITS__
654
    printf("tid    name       address            state    task               "
654
    printf("tid    name       address            state    task               "
655
        "ctx code               stack              cycles     cpu  "
655
        "ctx code               stack              cycles     cpu  "
656
        "waitqueue\n");
656
        "waitqueue\n");
657
    printf("------ ---------- ------------------ -------- ------------------ "
657
    printf("------ ---------- ------------------ -------- ------------------ "
658
        "--- ------------------ ------------------ ---------- ---- "
658
        "--- ------------------ ------------------ ---------- ---- "
659
        "------------------\n");
659
        "------------------\n");
660
#endif
660
#endif
661
 
661
 
662
    avltree_walk(&threads_tree, thread_walker, NULL);
662
    avltree_walk(&threads_tree, thread_walker, NULL);
663
 
663
 
664
    spinlock_unlock(&threads_lock);
664
    spinlock_unlock(&threads_lock);
665
    interrupts_restore(ipl);
665
    interrupts_restore(ipl);
666
}
666
}
667
 
667
 
668
/** Check whether thread exists.
668
/** Check whether thread exists.
669
 *
669
 *
670
 * Note that threads_lock must be already held and
670
 * Note that threads_lock must be already held and
671
 * interrupts must be already disabled.
671
 * interrupts must be already disabled.
672
 *
672
 *
673
 * @param t Pointer to thread.
673
 * @param t Pointer to thread.
674
 *
674
 *
675
 * @return True if thread t is known to the system, false otherwise.
675
 * @return True if thread t is known to the system, false otherwise.
676
 */
676
 */
677
bool thread_exists(thread_t *t)
677
bool thread_exists(thread_t *t)
678
{
678
{
679
    avltree_node_t *node;
679
    avltree_node_t *node;
680
 
680
 
681
    node = avltree_search(&threads_tree, (avltree_key_t) ((uintptr_t) t));
681
    node = avltree_search(&threads_tree, (avltree_key_t) ((uintptr_t) t));
682
   
682
   
683
    return node != NULL;
683
    return node != NULL;
684
}
684
}
685
 
685
 
686
 
-
 
687
/** Create new user task with 1 thread from image
-
 
688
 *
-
 
689
 * @param program_addr Address of program executable image.
-
 
690
 * @param name Program name.
-
 
691
 *
-
 
692
 * @return Initialized main thread of the task or NULL on error.
-
 
693
 */
-
 
694
thread_t *thread_create_program(void *program_addr, char *name)
-
 
695
{
-
 
696
    as_t *as;
-
 
697
    as_area_t *area;
-
 
698
    unsigned int rc;
-
 
699
    task_t *task;
-
 
700
    uspace_arg_t *kernel_uarg;
-
 
701
   
-
 
702
    kernel_uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t), 0);
-
 
703
    if (kernel_uarg == NULL)
-
 
704
        return NULL;
-
 
705
   
-
 
706
    kernel_uarg->uspace_entry =
-
 
707
        (void *) ((elf_header_t *) program_addr)->e_entry;
-
 
708
    kernel_uarg->uspace_stack = (void *) USTACK_ADDRESS;
-
 
709
    kernel_uarg->uspace_thread_function = NULL;
-
 
710
    kernel_uarg->uspace_thread_arg = NULL;
-
 
711
    kernel_uarg->uspace_uarg = NULL;
-
 
712
 
-
 
713
    as = as_create(0);
-
 
714
    if (as == NULL) {
-
 
715
        free(kernel_uarg);
-
 
716
        return NULL;
-
 
717
    }
-
 
718
 
-
 
719
    rc = elf_load((elf_header_t *) program_addr, as);
-
 
720
    if (rc != EE_OK) {
-
 
721
        free(kernel_uarg);
-
 
722
        as_destroy(as);
-
 
723
        return NULL;
-
 
724
    }
-
 
725
   
-
 
726
    /*
-
 
727
     * Create the data as_area.
-
 
728
     */
-
 
729
    area = as_area_create(as,
-
 
730
        AS_AREA_READ | AS_AREA_WRITE | AS_AREA_CACHEABLE,
-
 
731
        LOADED_PROG_STACK_PAGES_NO * PAGE_SIZE, USTACK_ADDRESS,
-
 
732
        AS_AREA_ATTR_NONE, &anon_backend, NULL);
-
 
733
    if (area == NULL) {
-
 
734
        free(kernel_uarg);
-
 
735
        as_destroy(as);
-
 
736
        return NULL;
-
 
737
    }
-
 
738
   
-
 
739
    task = task_create(as, name);
-
 
740
    if (task == NULL) {
-
 
741
        free(kernel_uarg);
-
 
742
        as_destroy(as);
-
 
743
        return NULL;
-
 
744
    }
-
 
745
   
-
 
746
    /*
-
 
747
     * Create the main thread.
-
 
748
     */
-
 
749
    return thread_create(uinit, kernel_uarg, task, THREAD_FLAG_USPACE,
-
 
750
        "uinit", false);
-
 
751
}
-
 
752
 
-
 
753
 
-
 
754
/** Update accounting of current thread.
686
/** Update accounting of current thread.
755
 *
687
 *
756
 * Note that thread_lock on THREAD must be already held and
688
 * Note that thread_lock on THREAD must be already held and
757
 * interrupts must be already disabled.
689
 * interrupts must be already disabled.
758
 *
690
 *
759
 */
691
 */
760
void thread_update_accounting(void)
692
void thread_update_accounting(void)
761
{
693
{
762
    uint64_t time = get_cycle();
694
    uint64_t time = get_cycle();
763
    THREAD->cycles += time - THREAD->last_cycle;
695
    THREAD->cycles += time - THREAD->last_cycle;
764
    THREAD->last_cycle = time;
696
    THREAD->last_cycle = time;
765
}
697
}
766
 
698
 
767
/** Process syscall to create new thread.
699
/** Process syscall to create new thread.
768
 *
700
 *
769
 */
701
 */
770
unative_t sys_thread_create(uspace_arg_t *uspace_uarg, char *uspace_name,
702
unative_t sys_thread_create(uspace_arg_t *uspace_uarg, char *uspace_name,
771
    thread_id_t *uspace_thread_id)
703
    thread_id_t *uspace_thread_id)
772
{
704
{
773
    thread_t *t;
705
    thread_t *t;
774
    char namebuf[THREAD_NAME_BUFLEN];
706
    char namebuf[THREAD_NAME_BUFLEN];
775
    uspace_arg_t *kernel_uarg;
707
    uspace_arg_t *kernel_uarg;
776
    int rc;
708
    int rc;
777
 
709
 
778
    rc = copy_from_uspace(namebuf, uspace_name, THREAD_NAME_BUFLEN);
710
    rc = copy_from_uspace(namebuf, uspace_name, THREAD_NAME_BUFLEN);
779
    if (rc != 0)
711
    if (rc != 0)
780
        return (unative_t) rc;
712
        return (unative_t) rc;
781
 
713
 
782
    /*
714
    /*
783
     * In case of failure, kernel_uarg will be deallocated in this function.
715
     * In case of failure, kernel_uarg will be deallocated in this function.
784
     * In case of success, kernel_uarg will be freed in uinit().
716
     * In case of success, kernel_uarg will be freed in uinit().
785
     */
717
     */
786
    kernel_uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t), 0);
718
    kernel_uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t), 0);
787
   
719
   
788
    rc = copy_from_uspace(kernel_uarg, uspace_uarg, sizeof(uspace_arg_t));
720
    rc = copy_from_uspace(kernel_uarg, uspace_uarg, sizeof(uspace_arg_t));
789
    if (rc != 0) {
721
    if (rc != 0) {
790
        free(kernel_uarg);
722
        free(kernel_uarg);
791
        return (unative_t) rc;
723
        return (unative_t) rc;
792
    }
724
    }
793
 
725
 
794
    t = thread_create(uinit, kernel_uarg, TASK,
726
    t = thread_create(uinit, kernel_uarg, TASK,
795
        THREAD_FLAG_USPACE | THREAD_FLAG_NOATTACH, namebuf, false);
727
        THREAD_FLAG_USPACE | THREAD_FLAG_NOATTACH, namebuf, false);
796
    if (t) {
728
    if (t) {
797
        if (uspace_thread_id != NULL) {
729
        if (uspace_thread_id != NULL) {
798
            int rc;
730
            int rc;
799
 
731
 
800
            rc = copy_to_uspace(uspace_thread_id, &t->tid,
732
            rc = copy_to_uspace(uspace_thread_id, &t->tid,
801
                sizeof(t->tid));
733
                sizeof(t->tid));
802
            if (rc != 0) {
734
            if (rc != 0) {
803
                /*
735
                /*
804
                 * We have encountered a failure, but the thread
736
                 * We have encountered a failure, but the thread
805
                 * has already been created. We need to undo its
737
                 * has already been created. We need to undo its
806
                 * creation now.
738
                 * creation now.
807
                 */
739
                 */
808
 
740
 
809
                /*
741
                /*
810
                 * The new thread structure is initialized, but
742
                 * The new thread structure is initialized, but
811
                 * is still not visible to the system.
743
                 * is still not visible to the system.
812
                 * We can safely deallocate it.
744
                 * We can safely deallocate it.
813
                 */
745
                 */
814
                slab_free(thread_slab, t);
746
                slab_free(thread_slab, t);
815
                free(kernel_uarg);
747
                free(kernel_uarg);
816
 
748
 
817
                return (unative_t) rc;
749
                return (unative_t) rc;
818
             }
750
             }
819
        }
751
        }
820
        thread_attach(t, TASK);
752
        thread_attach(t, TASK);
821
        thread_ready(t);
753
        thread_ready(t);
822
 
754
 
823
        /* Generate udebug THREAD_B event */
755
        /* Generate udebug THREAD_B event */
824
        udebug_thread_b_event(t);
756
        udebug_thread_b_event(t);
825
 
757
 
826
        return 0;
758
        return 0;
827
    } else
759
    } else
828
        free(kernel_uarg);
760
        free(kernel_uarg);
829
 
761
 
830
    return (unative_t) ENOMEM;
762
    return (unative_t) ENOMEM;
831
}
763
}
832
 
764
 
833
/** Process syscall to terminate thread.
765
/** Process syscall to terminate thread.
834
 *
766
 *
835
 */
767
 */
836
unative_t sys_thread_exit(int uspace_status)
768
unative_t sys_thread_exit(int uspace_status)
837
{
769
{
838
    thread_exit();
770
    thread_exit();
839
    /* Unreachable */
771
    /* Unreachable */
840
    return 0;
772
    return 0;
841
}
773
}
842
 
774
 
843
/** Syscall for getting TID.
775
/** Syscall for getting TID.
844
 *
776
 *
845
 * @param uspace_thread_id Userspace address of 8-byte buffer where to store
777
 * @param uspace_thread_id Userspace address of 8-byte buffer where to store
846
 * current thread ID.
778
 * current thread ID.
847
 *
779
 *
848
 * @return 0 on success or an error code from @ref errno.h.
780
 * @return 0 on success or an error code from @ref errno.h.
849
 */
781
 */
850
unative_t sys_thread_get_id(thread_id_t *uspace_thread_id)
782
unative_t sys_thread_get_id(thread_id_t *uspace_thread_id)
851
{
783
{
852
    /*
784
    /*
853
     * No need to acquire lock on THREAD because tid
785
     * No need to acquire lock on THREAD because tid
854
     * remains constant for the lifespan of the thread.
786
     * remains constant for the lifespan of the thread.
855
     */
787
     */
856
    return (unative_t) copy_to_uspace(uspace_thread_id, &THREAD->tid,
788
    return (unative_t) copy_to_uspace(uspace_thread_id, &THREAD->tid,
857
        sizeof(THREAD->tid));
789
        sizeof(THREAD->tid));
858
}
790
}
859
 
791
 
860
/** @}
792
/** @}
861
 */
793
 */
862
 
794