a7aadb518645bb48db767cdff32cb271e097d98d
[musl] / src / thread / pthread_create.c
1 #include "pthread_impl.h"
2 #include "stdio_impl.h"
3 #include <sys/mman.h>
4
5 static void dummy_0()
6 {
7 }
8 weak_alias(dummy_0, __acquire_ptc);
9 weak_alias(dummy_0, __release_ptc);
10 weak_alias(dummy_0, __pthread_tsd_run_dtors);
11
12 _Noreturn void pthread_exit(void *result)
13 {
14         pthread_t self = pthread_self();
15         int n;
16
17         self->result = result;
18
19         while (self->cancelbuf) {
20                 void (*f)(void *) = self->cancelbuf->__f;
21                 void *x = self->cancelbuf->__x;
22                 self->cancelbuf = self->cancelbuf->__next;
23                 f(x);
24         }
25
26         __pthread_tsd_run_dtors();
27
28         __lock(self->exitlock);
29
30         /* Mark this thread dead before decrementing count */
31         __lock(self->killlock);
32         self->dead = 1;
33         __unlock(self->killlock);
34
35         do n = libc.threads_minus_1;
36         while (n && a_cas(&libc.threads_minus_1, n, n-1)!=n);
37         if (!n) exit(0);
38
39         if (self->detached && self->map_base) {
40                 if (self->detached == 2)
41                         __syscall(SYS_set_tid_address, 0);
42                 __syscall(SYS_rt_sigprocmask, SIG_BLOCK,
43                         SIGALL_SET, 0, __SYSCALL_SSLEN);
44                 __unmapself(self->map_base, self->map_size);
45         }
46
47         for (;;) __syscall(SYS_exit, 0);
48 }
49
50 void __do_cleanup_push(struct __ptcb *cb)
51 {
52         struct pthread *self = pthread_self();
53         cb->__next = self->cancelbuf;
54         self->cancelbuf = cb;
55 }
56
57 void __do_cleanup_pop(struct __ptcb *cb)
58 {
59         __pthread_self()->cancelbuf = cb->__next;
60 }
61
62 static int start(void *p)
63 {
64         pthread_t self = p;
65         if (self->unblock_cancel)
66                 __syscall(SYS_rt_sigprocmask, SIG_UNBLOCK,
67                         SIGPT_SET, 0, __SYSCALL_SSLEN);
68         pthread_exit(self->start(self->start_arg));
69         return 0;
70 }
71
72 #define ROUND(x) (((x)+PAGE_SIZE-1)&-PAGE_SIZE)
73
74 /* pthread_key_create.c overrides this */
75 static const size_t dummy = 0;
76 weak_alias(dummy, __pthread_tsd_size);
77
78 static FILE *const dummy_file = 0;
79 weak_alias(dummy_file, __stdin_used);
80 weak_alias(dummy_file, __stdout_used);
81 weak_alias(dummy_file, __stderr_used);
82
83 static void init_file_lock(FILE *f)
84 {
85         if (f && f->lock<0) f->lock = 0;
86 }
87
88 void *__copy_tls(unsigned char *);
89
90 int pthread_create(pthread_t *restrict res, const pthread_attr_t *restrict attr, void *(*entry)(void *), void *restrict arg)
91 {
92         int ret;
93         size_t size = DEFAULT_STACK_SIZE + DEFAULT_GUARD_SIZE;
94         size_t guard = DEFAULT_GUARD_SIZE;
95         struct pthread *self = pthread_self(), *new;
96         unsigned char *map, *stack, *tsd;
97         unsigned flags = 0x7d8f00;
98
99         if (!self) return ENOSYS;
100         if (!libc.threaded) {
101                 for (FILE *f=libc.ofl_head; f; f=f->next)
102                         init_file_lock(f);
103                 init_file_lock(__stdin_used);
104                 init_file_lock(__stdout_used);
105                 init_file_lock(__stderr_used);
106                 libc.threaded = 1;
107         }
108
109         __acquire_ptc();
110
111         if (attr && attr->_a_stackaddr) {
112                 map = 0;
113                 tsd = (void *)(attr->_a_stackaddr-__pthread_tsd_size & -16);
114         } else {
115                 if (attr) {
116                         guard = ROUND(attr->_a_guardsize + DEFAULT_GUARD_SIZE);
117                         size = guard + ROUND(attr->_a_stacksize
118                                 + DEFAULT_STACK_SIZE + libc.tls_size);
119                 }
120                 size += __pthread_tsd_size;
121                 if (guard) {
122                         map = mmap(0, size, PROT_NONE, MAP_PRIVATE|MAP_ANON, -1, 0);
123                         if (map == MAP_FAILED) return EAGAIN;
124                         if (mprotect(map+guard, size-guard, PROT_READ|PROT_WRITE)) {
125                                 munmap(map, size);
126                                 return EAGAIN;
127                         }
128                 } else {
129                         map = mmap(0, size, PROT_READ|PROT_WRITE, MAP_PRIVATE|MAP_ANON, -1, 0);
130                         if (map == MAP_FAILED) return EAGAIN;
131                 }
132                 tsd = map + size - __pthread_tsd_size;
133         }
134         new = __copy_tls(stack = tsd - libc.tls_size);
135         new->map_base = map;
136         new->map_size = size;
137         new->pid = self->pid;
138         new->errno_ptr = &new->errno_val;
139         new->start = entry;
140         new->start_arg = arg;
141         new->self = new;
142         new->tsd = (void *)tsd;
143         if (attr && attr->_a_detach) {
144                 new->detached = 1;
145                 flags -= 0x200000;
146         }
147         new->unblock_cancel = self->cancel;
148         new->canary = self->canary;
149
150         a_inc(&libc.threads_minus_1);
151         ret = __clone(start, stack, flags, new, &new->tid, TP_ADJ(new), &new->tid);
152
153         __release_ptc();
154
155         if (ret < 0) {
156                 a_dec(&libc.threads_minus_1);
157                 munmap(map, size);
158                 return EAGAIN;
159         }
160         *res = new;
161         return 0;
162 }