WebSVN – HelenOS-historic – Diff – /uspace/trunk/libc/generic/thread.c


/*
 * Copyright (C) 2006 Jakub Jermar
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 *
 * - Redistributions of source code must retain the above copyright
 *   notice, this list of conditions and the following disclaimer.
 * - Redistributions in binary form must reproduce the above copyright
 *   notice, this list of conditions and the following disclaimer in the
 *   documentation and/or other materials provided with the distribution.
 * - The name of the author may not be used to endorse or promote products
 *   derived from this software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
 
#include <thread.h>
#include <libc.h>
#include <stdlib.h>
#include <arch/faddr.h>
#include <kernel/proc/uarg.h>
#include <psthread.h>
#include <string.h>
 
#include <stdio.h>
 
 
#ifndef THREAD_INITIAL_STACK_PAGES_NO
#define THREAD_INITIAL_STACK_PAGES_NO 1
#endif
 
 
extern char _tdata_start;
extern char _tdata_end;
extern char _tbss_start;
extern char _tbss_end;
 
/** Create Thread Local storage area, return pointer to TCB(ThreadControlBlock)
 *
 * !! The code requires, that sections .tdata and .tbss are adjacent.
 *    It may be changed in the future.
 */
tcb_t * __make_tls(void)
{
    void *data;
    tcb_t *tcb;
    size_t tls_size = &_tbss_end - &_tdata_start;
   
    tcb = __alloc_tls(&data, tls_size);
   
    memcpy(data, &_tdata_start, &_tdata_end - &_tdata_start);
    memset(data + (&_tbss_start-&_tdata_start), &_tbss_end-&_tbss_start, 0);
 
    return tcb;
}
 
void __free_tls(tcb_t *tcb)
{
    size_t tls_size = &_tbss_end - &_tdata_start;
    __free_tls_arch(tcb, tls_size);
}
 
/** Main thread function.
 *
 * This function is called from __thread_entry() and is used
 * to call the thread's implementing function and perform cleanup
 * and exit when thread returns back. Do not call this function
 * directly.
 *
 * @param uarg Pointer to userspace argument structure.
 */
void __thread_main(uspace_arg_t *uarg)
{
    tcb_t *tcb;
    /* This should initialize the area according to TLS specicification */
    tcb = __make_tls();
    __tcb_set(tcb);
    psthread_setup(tcb);
 
    uarg->uspace_thread_function(uarg->uspace_thread_arg);
    free(uarg->uspace_stack);
    free(uarg);
 
    psthread_teardown(tcb->pst_data);
    __free_tls(tcb);
 
    thread_exit(0);
}
 
/** Create userspace thread.
 *
 * This function creates new userspace thread and allocates userspace
 * stack and userspace argument structure for it.
 *
 * @param function Function implementing the thread.
 * @param arg Argument to be passed to thread.
 * @param name Symbolic name of the thread.
 *
 * @param TID of the new thread on success or -1 on failure.
 */
int thread_create(void (* function)(void *), void *arg, char *name)
{
    char *stack;
    uspace_arg_t *uarg;
 
    stack = (char *) malloc(getpagesize()*THREAD_INITIAL_STACK_PAGES_NO);
    if (!stack)
        return -1;
       
    uarg = (uspace_arg_t *) malloc(sizeof(uspace_arg_t));
    if (!uarg) {
        free(stack);
        return -1;
    }
   
    uarg->uspace_entry = (void *) FADDR(__thread_entry);
    uarg->uspace_stack = (void *) stack;
    uarg->uspace_thread_function = function;
    uarg->uspace_thread_arg = arg;
    uarg->uspace_uarg = uarg;
   
    return __SYSCALL2(SYS_THREAD_CREATE, (sysarg_t) uarg, (sysarg_t) name);
}
 
/** Terminate current thread.
 *
 * @param stat Exit status. Currently not used.
 */
void thread_exit(int status)
{
    __SYSCALL1(SYS_THREAD_EXIT, (sysarg_t) status);
}
 

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

Subversion Repositories HelenOS-historic

(root)/uspace/trunk/libc/generic/thread.c – Rev 1129 → 1167