c6a23955bdd6dde5b12ace70b74130bd2abf1c6d
[musl] / src / thread / pthread_create.c
1 #include "pthread_impl.h"
2
3 static void dummy_0()
4 {
5 }
6 weak_alias(dummy_0, __rsyscall_lock);
7 weak_alias(dummy_0, __rsyscall_unlock);
8
9 static void dummy_1(pthread_t self)
10 {
11 }
12 weak_alias(dummy_1, __pthread_tsd_run_dtors);
13
14 #ifdef __pthread_unwind_next
15 #undef __pthread_unwind_next
16 #define __pthread_unwind_next __pthread_unwind_next_3
17 #endif
18
19 void __pthread_unwind_next(struct __ptcb *cb)
20 {
21         pthread_t self = pthread_self();
22         int n;
23
24         if (cb->__next) {
25                 self->cancelbuf = cb->__next->__next;
26                 longjmp((void *)cb->__next->__jb, 1);
27         }
28
29         LOCK(&self->exitlock);
30
31         __pthread_tsd_run_dtors(self);
32
33         /* Mark this thread dead before decrementing count */
34         self->dead = 1;
35
36         do n = libc.threads_minus_1;
37         while (n && a_cas(&libc.threads_minus_1, n, n-1)!=n);
38         if (!n) exit(0);
39
40         if (self->detached && self->map_base) {
41                 __syscall(SYS_rt_sigprocmask, SIG_BLOCK, (long)(uint64_t[1]){-1},0,8);
42                 __unmapself(self->map_base, self->map_size);
43         }
44
45         __syscall(SYS_exit, 0);
46 }
47
48 static int start(void *p)
49 {
50         struct pthread *self = p;
51         if (self->unblock_cancel) {
52                 sigset_t set;
53                 sigemptyset(&set);
54                 sigaddset(&set, SIGCANCEL);
55                 __libc_sigprocmask(SIG_UNBLOCK, &set, 0);
56         }
57         pthread_exit(self->start(self->start_arg));
58         return 0;
59 }
60
61 int __uniclone(void *, int (*)(), void *);
62
63 #define ROUND(x) (((x)+PAGE_SIZE-1)&-PAGE_SIZE)
64
65 /* pthread_key_create.c overrides this */
66 static const size_t dummy = 0;
67 weak_alias(dummy, __pthread_tsd_size);
68
69 int pthread_create(pthread_t *res, const pthread_attr_t *attr, void *(*entry)(void *), void *arg)
70 {
71         int ret;
72         size_t size, guard;
73         struct pthread *self = pthread_self(), *new;
74         unsigned char *map, *stack, *tsd;
75         const pthread_attr_t default_attr = { 0 };
76
77         if (!self) return ENOSYS;
78         if (!libc.threaded) {
79                 sigset_t set;
80                 sigemptyset(&set);
81                 sigaddset(&set, SIGSYSCALL);
82                 sigaddset(&set, SIGCANCEL);
83                 __libc_sigprocmask(SIG_UNBLOCK, &set, 0);
84                 libc.threaded = 1;
85         }
86
87         if (!attr) attr = &default_attr;
88         guard = ROUND(attr->_a_guardsize + DEFAULT_GUARD_SIZE);
89         size = guard + ROUND(attr->_a_stacksize + DEFAULT_STACK_SIZE);
90         size += __pthread_tsd_size;
91         map = mmap(0, size, PROT_READ|PROT_WRITE|PROT_EXEC, MAP_PRIVATE|MAP_ANON, -1, 0);
92         if (!map) return EAGAIN;
93         if (guard) mprotect(map, guard, PROT_NONE);
94
95         tsd = map + size - __pthread_tsd_size;
96         new = (void *)(tsd - sizeof *new - PAGE_SIZE%sizeof *new);
97         new->map_base = map;
98         new->map_size = size;
99         new->pid = self->pid;
100         new->errno_ptr = &new->errno_val;
101         new->start = entry;
102         new->start_arg = arg;
103         new->self = new;
104         new->tsd = (void *)tsd;
105         new->detached = attr->_a_detach;
106         new->attr = *attr;
107         new->unblock_cancel = self->cancel;
108         memcpy(new->tlsdesc, self->tlsdesc, sizeof new->tlsdesc);
109         new->tlsdesc[1] = (uintptr_t)new;
110         stack = (void *)((uintptr_t)new-1 & ~(uintptr_t)15);
111
112         __rsyscall_lock();
113
114         a_inc(&libc.threads_minus_1);
115         ret = __uniclone(stack, start, new);
116
117         __rsyscall_unlock();
118
119         if (ret < 0) {
120                 a_dec(&libc.threads_minus_1);
121                 munmap(map, size);
122                 return EAGAIN;
123         }
124         *res = new;
125         return 0;
126 }
127
128 void pthread_exit(void *result)
129 {
130         struct pthread *self = pthread_self();
131         struct __ptcb cb = { .__next = self->cancelbuf };
132         self->result = result;
133         self->canceldisable = 1;
134         self->cancelasync = 0;
135         __pthread_unwind_next(&cb);
136 }