171b3fa15SDavid Xu /*
271b3fa15SDavid Xu * Copyright (c) 2005 David Xu <davidxu@freebsd.org>
371b3fa15SDavid Xu * Copyright (c) 2003 Daniel M. Eischen <deischen@gdeb.com>
471b3fa15SDavid Xu * All rights reserved.
571b3fa15SDavid Xu *
671b3fa15SDavid Xu * Redistribution and use in source and binary forms, with or without
771b3fa15SDavid Xu * modification, are permitted provided that the following conditions
871b3fa15SDavid Xu * are met:
971b3fa15SDavid Xu * 1. Redistributions of source code must retain the above copyright
1071b3fa15SDavid Xu * notice, this list of conditions and the following disclaimer.
1171b3fa15SDavid Xu * 2. Redistributions in binary form must reproduce the above copyright
1271b3fa15SDavid Xu * notice, this list of conditions and the following disclaimer in the
1371b3fa15SDavid Xu * documentation and/or other materials provided with the distribution.
1471b3fa15SDavid Xu *
15d3b15642Szrj * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16d3b15642Szrj * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17d3b15642Szrj * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18d3b15642Szrj * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19d3b15642Szrj * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20d3b15642Szrj * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21d3b15642Szrj * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22d3b15642Szrj * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23d3b15642Szrj * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24d3b15642Szrj * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
2571b3fa15SDavid Xu *
2671b3fa15SDavid Xu * $FreeBSD: src/lib/libpthread/thread/thr_create.c,v 1.58 2004/10/23 23:28:36 davidxu Exp $
2771b3fa15SDavid Xu */
28fc71f871SDavid Xu
29fc71f871SDavid Xu #include "namespace.h"
3071b3fa15SDavid Xu #include <errno.h>
3171b3fa15SDavid Xu #include <stdlib.h>
3271b3fa15SDavid Xu #include <string.h>
3371b3fa15SDavid Xu #include <fcntl.h>
3471b3fa15SDavid Xu #include <unistd.h>
3571b3fa15SDavid Xu #include <stddef.h>
3671b3fa15SDavid Xu #include <sys/time.h>
3771b3fa15SDavid Xu #include <machine/reg.h>
389e2ee207SJoerg Sonnenberger #include <machine/tls.h>
3971b3fa15SDavid Xu #include <pthread.h>
4071b3fa15SDavid Xu #include <sys/signalvar.h>
410d9899e7SSepherosa Ziehau #include <sys/lwp.h>
42fc71f871SDavid Xu #include "un-namespace.h"
4371b3fa15SDavid Xu
4471b3fa15SDavid Xu #include "libc_private.h"
456be5672cSzrj #include "thr_private.h"
4671b3fa15SDavid Xu
47*940be950Szrj static int create_stack(pthread_attr_t pattr);
4871b3fa15SDavid Xu static void thread_start(void *);
4971b3fa15SDavid Xu
5071b3fa15SDavid Xu int
_pthread_create(pthread_t * __restrict thread,const pthread_attr_t * __restrict attr,void * (* start_routine)(void *),void * __restrict arg)51d33005aaSSascha Wildner _pthread_create(pthread_t * __restrict thread,
52d33005aaSSascha Wildner const pthread_attr_t * __restrict attr, void *(*start_routine) (void *),
53d33005aaSSascha Wildner void * __restrict arg)
5471b3fa15SDavid Xu {
55fbf2ef09SSimon Schubert struct lwp_params create_params;
5671b3fa15SDavid Xu void *stack;
5771b3fa15SDavid Xu sigset_t sigmask, oldsigmask;
58*940be950Szrj pthread_t curthread, new_thread;
593ae362f2SSepherosa Ziehau const cpu_set_t *cpumask = NULL;
603cd47da3SDavid Xu int ret = 0, locked;
6171b3fa15SDavid Xu
6271b3fa15SDavid Xu _thr_check_init();
6371b3fa15SDavid Xu
6471b3fa15SDavid Xu /*
6571b3fa15SDavid Xu * Tell libc and others now they need lock to protect their data.
6671b3fa15SDavid Xu */
6771b3fa15SDavid Xu if (_thr_isthreaded() == 0 && _thr_setthreaded(1))
6871b3fa15SDavid Xu return (EAGAIN);
6971b3fa15SDavid Xu
709e2ee207SJoerg Sonnenberger curthread = tls_get_curthread();
7171b3fa15SDavid Xu if ((new_thread = _thr_alloc(curthread)) == NULL)
7271b3fa15SDavid Xu return (EAGAIN);
7371b3fa15SDavid Xu
748979fd9cSzrj if (attr == NULL || *attr == NULL) {
7571b3fa15SDavid Xu /* Use the default thread attributes: */
7671b3fa15SDavid Xu new_thread->attr = _pthread_attr_default;
778979fd9cSzrj } else {
7871b3fa15SDavid Xu new_thread->attr = *(*attr);
798979fd9cSzrj }
8071b3fa15SDavid Xu if (new_thread->attr.sched_inherit == PTHREAD_INHERIT_SCHED) {
8171b3fa15SDavid Xu /* inherit scheduling contention scope */
8271b3fa15SDavid Xu if (curthread->attr.flags & PTHREAD_SCOPE_SYSTEM)
8371b3fa15SDavid Xu new_thread->attr.flags |= PTHREAD_SCOPE_SYSTEM;
8471b3fa15SDavid Xu else
8571b3fa15SDavid Xu new_thread->attr.flags &= ~PTHREAD_SCOPE_SYSTEM;
8671b3fa15SDavid Xu /*
8771b3fa15SDavid Xu * scheduling policy and scheduling parameters will be
8871b3fa15SDavid Xu * inherited in following code.
8971b3fa15SDavid Xu */
9071b3fa15SDavid Xu }
913ae362f2SSepherosa Ziehau if (new_thread->attr.flags & THR_CPUMASK)
923ae362f2SSepherosa Ziehau cpumask = &new_thread->attr.cpumask;
9371b3fa15SDavid Xu
9471b3fa15SDavid Xu if (create_stack(&new_thread->attr) != 0) {
9571b3fa15SDavid Xu /* Insufficient memory to create a stack: */
9671b3fa15SDavid Xu new_thread->terminated = 1;
9771b3fa15SDavid Xu _thr_free(curthread, new_thread);
9871b3fa15SDavid Xu return (EAGAIN);
9971b3fa15SDavid Xu }
10071b3fa15SDavid Xu /*
10171b3fa15SDavid Xu * Write a magic value to the thread structure
10271b3fa15SDavid Xu * to help identify valid ones:
10371b3fa15SDavid Xu */
10471b3fa15SDavid Xu new_thread->magic = THR_MAGIC;
10571b3fa15SDavid Xu new_thread->start_routine = start_routine;
10671b3fa15SDavid Xu new_thread->arg = arg;
10771b3fa15SDavid Xu new_thread->cancelflags = PTHREAD_CANCEL_ENABLE |
10871b3fa15SDavid Xu PTHREAD_CANCEL_DEFERRED;
10971b3fa15SDavid Xu /*
11071b3fa15SDavid Xu * Check if this thread is to inherit the scheduling
11171b3fa15SDavid Xu * attributes from its parent:
11271b3fa15SDavid Xu */
11371b3fa15SDavid Xu if (new_thread->attr.sched_inherit == PTHREAD_INHERIT_SCHED) {
11471b3fa15SDavid Xu /*
11571b3fa15SDavid Xu * Copy the scheduling attributes. Lock the scheduling
11671b3fa15SDavid Xu * lock to get consistent scheduling parameters.
11771b3fa15SDavid Xu */
11871b3fa15SDavid Xu THR_LOCK(curthread);
11971b3fa15SDavid Xu new_thread->base_priority = curthread->base_priority;
1206cec4916SSascha Wildner new_thread->attr.prio = curthread->attr.prio;
12171b3fa15SDavid Xu new_thread->attr.sched_policy = curthread->attr.sched_policy;
12271b3fa15SDavid Xu THR_UNLOCK(curthread);
12371b3fa15SDavid Xu } else {
12471b3fa15SDavid Xu /*
12571b3fa15SDavid Xu * Use just the thread priority, leaving the
12671b3fa15SDavid Xu * other scheduling attributes as their
12771b3fa15SDavid Xu * default values:
12871b3fa15SDavid Xu */
12971b3fa15SDavid Xu new_thread->base_priority = new_thread->attr.prio;
13071b3fa15SDavid Xu }
13171b3fa15SDavid Xu new_thread->active_priority = new_thread->base_priority;
13271b3fa15SDavid Xu
13371b3fa15SDavid Xu /* Initialize the mutex queue: */
13471b3fa15SDavid Xu TAILQ_INIT(&new_thread->mutexq);
13571b3fa15SDavid Xu
13671b3fa15SDavid Xu /* Initialise hooks in the thread structure: */
13771b3fa15SDavid Xu if (new_thread->attr.suspend == THR_CREATE_SUSPENDED)
138cb8b5efeSDavid Xu new_thread->flags = THR_FLAGS_NEED_SUSPEND;
139c9ad2203SDavid Xu
14071b3fa15SDavid Xu new_thread->state = PS_RUNNING;
141c9ad2203SDavid Xu
142c9ad2203SDavid Xu if (new_thread->attr.flags & PTHREAD_CREATE_DETACHED)
143c9ad2203SDavid Xu new_thread->tlflags |= TLFLAGS_DETACHED;
144c9ad2203SDavid Xu
14571b3fa15SDavid Xu /* Add the new thread. */
146c9ad2203SDavid Xu new_thread->refcount = 1;
14771b3fa15SDavid Xu _thr_link(curthread, new_thread);
14871b3fa15SDavid Xu /* Return thread pointer eariler so that new thread can use it. */
14971b3fa15SDavid Xu (*thread) = new_thread;
1503cd47da3SDavid Xu if (SHOULD_REPORT_EVENT(curthread, TD_CREATE)) {
1513cd47da3SDavid Xu THR_THREAD_LOCK(curthread, new_thread);
1523cd47da3SDavid Xu locked = 1;
1533cd47da3SDavid Xu } else
1543cd47da3SDavid Xu locked = 0;
15571b3fa15SDavid Xu /* Schedule the new thread. */
15671b3fa15SDavid Xu stack = (char *)new_thread->attr.stackaddr_attr +
15771b3fa15SDavid Xu new_thread->attr.stacksize_attr;
158fbf2ef09SSimon Schubert bzero(&create_params, sizeof(create_params));
159b44473afSSascha Wildner create_params.lwp_func = thread_start;
160b44473afSSascha Wildner create_params.lwp_arg = new_thread;
161b44473afSSascha Wildner create_params.lwp_stack = stack;
162b44473afSSascha Wildner create_params.lwp_tid1 = &new_thread->tid;
163a7b4dea6SSimon Schubert /*
164a7b4dea6SSimon Schubert * Thread created by thr_create() inherits currrent thread
165a7b4dea6SSimon Schubert * sigmask, however, before new thread setup itself correctly,
166a7b4dea6SSimon Schubert * it can not handle signal, so we should mask all signals here.
167a7b4dea6SSimon Schubert * We do this at the very last moment, so that we don't run
168a7b4dea6SSimon Schubert * into problems while we have all signals disabled.
169a7b4dea6SSimon Schubert */
170a7b4dea6SSimon Schubert SIGFILLSET(sigmask);
171a7b4dea6SSimon Schubert __sys_sigprocmask(SIG_SETMASK, &sigmask, &oldsigmask);
172a7b4dea6SSimon Schubert new_thread->sigmask = oldsigmask;
1733ae362f2SSepherosa Ziehau ret = lwp_create2(&create_params, cpumask);
17471b3fa15SDavid Xu __sys_sigprocmask(SIG_SETMASK, &oldsigmask, NULL);
17571b3fa15SDavid Xu if (ret != 0) {
176c9ad2203SDavid Xu if (!locked)
177c9ad2203SDavid Xu THR_THREAD_LOCK(curthread, new_thread);
178c9ad2203SDavid Xu new_thread->state = PS_DEAD;
179c9ad2203SDavid Xu new_thread->terminated = 1;
180fd4288bdSDavid Xu if (new_thread->flags & THR_FLAGS_NEED_SUSPEND) {
181fd4288bdSDavid Xu new_thread->cycle++;
18298247283SMatthew Dillon _thr_umtx_wake(&new_thread->cycle, 0);
183fd4288bdSDavid Xu }
1843cd47da3SDavid Xu THR_THREAD_UNLOCK(curthread, new_thread);
185c9ad2203SDavid Xu THREAD_LIST_LOCK(curthread);
186c9ad2203SDavid Xu _thread_active_threads--;
187c9ad2203SDavid Xu new_thread->tlflags |= TLFLAGS_DETACHED;
188c9ad2203SDavid Xu _thr_ref_delete_unlocked(curthread, new_thread);
189c9ad2203SDavid Xu THREAD_LIST_UNLOCK(curthread);
19078ed0a44SVenkatesh Srinivas (*thread) = NULL;
19171b3fa15SDavid Xu ret = EAGAIN;
1923cd47da3SDavid Xu } else if (locked) {
1933cd47da3SDavid Xu _thr_report_creation(curthread, new_thread);
1943cd47da3SDavid Xu THR_THREAD_UNLOCK(curthread, new_thread);
19571b3fa15SDavid Xu }
19671b3fa15SDavid Xu return (ret);
19771b3fa15SDavid Xu }
19871b3fa15SDavid Xu
19971b3fa15SDavid Xu static int
create_stack(pthread_attr_t pattr)200*940be950Szrj create_stack(pthread_attr_t pattr)
20171b3fa15SDavid Xu {
20271b3fa15SDavid Xu int ret;
20371b3fa15SDavid Xu
20471b3fa15SDavid Xu /* Check if a stack was specified in the thread attributes: */
20571b3fa15SDavid Xu if ((pattr->stackaddr_attr) != NULL) {
20671b3fa15SDavid Xu pattr->guardsize_attr = 0;
20771b3fa15SDavid Xu pattr->flags |= THR_STACK_USER;
20871b3fa15SDavid Xu ret = 0;
20971b3fa15SDavid Xu }
21071b3fa15SDavid Xu else
21171b3fa15SDavid Xu ret = _thr_stack_alloc(pattr);
21271b3fa15SDavid Xu return (ret);
21371b3fa15SDavid Xu }
21471b3fa15SDavid Xu
21571b3fa15SDavid Xu static void
thread_start(void * arg)21671b3fa15SDavid Xu thread_start(void *arg)
21771b3fa15SDavid Xu {
218*940be950Szrj pthread_t curthread = (pthread_t)arg;
21971b3fa15SDavid Xu
2209e2ee207SJoerg Sonnenberger tls_set_tcb(curthread->tcb);
22171b3fa15SDavid Xu
22271b3fa15SDavid Xu /* Thread was created with all signals blocked, unblock them. */
22371b3fa15SDavid Xu __sys_sigprocmask(SIG_SETMASK, &curthread->sigmask, NULL);
22471b3fa15SDavid Xu
225fd4288bdSDavid Xu THR_LOCK(curthread);
226fd4288bdSDavid Xu THR_UNLOCK(curthread);
227fd4288bdSDavid Xu
22871b3fa15SDavid Xu if (curthread->flags & THR_FLAGS_NEED_SUSPEND)
22971b3fa15SDavid Xu _thr_suspend_check(curthread);
230721505deSMatthew Dillon _libc_thr_init();
23171b3fa15SDavid Xu
23271b3fa15SDavid Xu /* Run the current thread's start routine with argument: */
233fc71f871SDavid Xu _pthread_exit(curthread->start_routine(curthread->arg));
23471b3fa15SDavid Xu
23571b3fa15SDavid Xu /* This point should never be reached. */
23671b3fa15SDavid Xu PANIC("Thread has resumed after exit");
23771b3fa15SDavid Xu }
2385a1048c8SDavid Xu
2395a1048c8SDavid Xu __strong_reference(_pthread_create, pthread_create);
240