Subversion Repositories HelenOS-historic

Rev

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

Rev 1113 Rev 1129
1
/*
1
/*
2
 * Copyright (C) 2006 Jakub Jermar
2
 * Copyright (C) 2006 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 <thread.h>
29
#include <thread.h>
30
#include <libc.h>
30
#include <libc.h>
31
#include <stdlib.h>
31
#include <stdlib.h>
32
#include <arch/faddr.h>
32
#include <arch/faddr.h>
33
#include <kernel/proc/uarg.h>
33
#include <kernel/proc/uarg.h>
34
#include <psthread.h>
34
#include <psthread.h>
-
 
35
#include <string.h>
35
 
36
 
36
#include <stdio.h>
37
#include <stdio.h>
37
void * __make_tls(void)
-
 
38
{
-
 
39
    psthread_data_t *pt;
-
 
40
 
38
 
-
 
39
extern char _tdata_start;
-
 
40
extern char _tdata_end;
-
 
41
extern char _tbss_start;
-
 
42
extern char _tbss_end;
-
 
43
 
-
 
44
/** Create Thread Local storage area, return pointer to TCB(ThreadControlBlock)
-
 
45
 *
-
 
46
 * !! The code requires, that sections .tdata and .tbss are adjacent.
41
    pt = malloc(sizeof(psthread_data_t));
47
 *    It may be changed in the future.
-
 
48
 */
-
 
49
tcb_t * __make_tls(void)
-
 
50
{
-
 
51
    void *data;
42
    pt->self = pt;
52
    tcb_t *tcb;
-
 
53
    size_t tls_size = &_tbss_end - &_tdata_start;
-
 
54
   
-
 
55
    tcb = __alloc_tls(&data, tls_size);
-
 
56
   
-
 
57
    memcpy(data, &_tdata_start, &_tdata_end - &_tdata_start);
-
 
58
    memset(data + (&_tbss_start-&_tdata_start), &_tbss_end-&_tbss_start, 0);
43
 
59
 
44
    return pt;
60
    return tcb;
45
}
61
}
46
 
62
 
47
void __free_tls(void *tls)
63
void __free_tls(tcb_t *tcb)
48
{
64
{
-
 
65
    size_t tls_size = &_tbss_end - &_tdata_start;
49
    free(tls);
66
    __free_tls_arch(tcb, tls_size);
50
}
67
}
51
 
68
 
52
/** Main thread function.
69
/** Main thread function.
53
 *
70
 *
54
 * This function is called from __thread_entry() and is used
71
 * This function is called from __thread_entry() and is used
55
 * to call the thread's implementing function and perform cleanup
72
 * to call the thread's implementing function and perform cleanup
56
 * and exit when thread returns back. Do not call this function
73
 * and exit when thread returns back. Do not call this function
57
 * directly.
74
 * directly.
58
 *
75
 *
59
 * @param uarg Pointer to userspace argument structure.
76
 * @param uarg Pointer to userspace argument structure.
60
 */
77
 */
61
void __thread_main(uspace_arg_t *uarg)
78
void __thread_main(uspace_arg_t *uarg)
62
{
79
{
-
 
80
    tcb_t *tcb;
63
    /* This should initialize the area according to TLS specicification */
81
    /* This should initialize the area according to TLS specicification */
64
    __tls_set(__make_tls());
82
    tcb = __make_tls();
-
 
83
    __tcb_set(tcb);
-
 
84
    psthread_setup(tcb);
65
 
85
 
66
    uarg->uspace_thread_function(uarg->uspace_thread_arg);
86
    uarg->uspace_thread_function(uarg->uspace_thread_arg);
67
    free(uarg->uspace_stack);
87
    free(uarg->uspace_stack);
68
    free(uarg);
88
    free(uarg);
69
 
89
 
-
 
90
    psthread_teardown(tcb->pst_data);
70
    __free_tls(__tls_get());
91
    __free_tls(tcb);
71
 
92
 
72
    thread_exit(0);
93
    thread_exit(0);
73
}
94
}
74
 
95
 
75
/** Create userspace thread.
96
/** Create userspace thread.
76
 *
97
 *
77
 * This function creates new userspace thread and allocates userspace
98
 * This function creates new userspace thread and allocates userspace
78
 * stack and userspace argument structure for it.
99
 * stack and userspace argument structure for it.
79
 *
100
 *
80
 * @param function Function implementing the thread.
101
 * @param function Function implementing the thread.
81
 * @param arg Argument to be passed to thread.
102
 * @param arg Argument to be passed to thread.
82
 * @param name Symbolic name of the thread.
103
 * @param name Symbolic name of the thread.
83
 *
104
 *
84
 * @param TID of the new thread on success or -1 on failure.
105
 * @param TID of the new thread on success or -1 on failure.
85
 */
106
 */
86
int thread_create(void (* function)(void *), void *arg, char *name)
107
int thread_create(void (* function)(void *), void *arg, char *name)
87
{
108
{
88
    char *stack;
109
    char *stack;
89
    uspace_arg_t *uarg;
110
    uspace_arg_t *uarg;
90
 
111
 
91
    stack = (char *) malloc(getpagesize());
112
    stack = (char *) malloc(getpagesize());
92
    if (!stack)
113
    if (!stack)
93
        return -1;
114
        return -1;
94
       
115
       
95
    uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t));
116
    uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t));
96
    if (!uarg) {
117
    if (!uarg) {
97
        free(stack);
118
        free(stack);
98
        return -1;
119
        return -1;
99
    }
120
    }
100
   
121
   
101
    uarg->uspace_entry = (void *) FADDR(__thread_entry);
122
    uarg->uspace_entry = (void *) FADDR(__thread_entry);
102
    uarg->uspace_stack = (void *) stack;
123
    uarg->uspace_stack = (void *) stack;
103
    uarg->uspace_thread_function = function;
124
    uarg->uspace_thread_function = function;
104
    uarg->uspace_thread_arg = arg;
125
    uarg->uspace_thread_arg = arg;
105
    uarg->uspace_uarg = uarg;
126
    uarg->uspace_uarg = uarg;
106
   
127
   
107
    return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name);
128
    return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name);
108
}
129
}
109
 
130
 
110
/** Terminate current thread.
131
/** Terminate current thread.
111
 *
132
 *
112
 * @param stat Exit status. Currently not used.
133
 * @param stat Exit status. Currently not used.
113
 */
134
 */
114
void thread_exit(int status)
135
void thread_exit(int status)
115
{
136
{
116
    __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
137
    __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
117
}
138
}
118
 
139