123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122 |
- #include <assert.h>
- #include <errno.h>
- #include <sched.h>
- #include <stddef.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <unistd.h>
- #include <sys/poll.h> /* for poll */
- #include <sys/mman.h> /* for mmap */
- #include <sys/param.h>
- #include <sys/time.h>
- #include <sys/wait.h> /* for waitpid macros */
- #include <locale.h> /* for __uselocale */
- #include <resolv.h> /* for __resp */
- #include "pthread.h"
- #include "internals.h"
- #include "spinlock.h"
- #include "restart.h"
- #include "semaphore.h"
- #include <not-cancel.h>
- const int __linuxthreads_pthread_threads_max = PTHREAD_THREADS_MAX;
- #ifndef THREAD_SELF
- int __pthread_nonstandard_stacks;
- #endif
- __volatile__ int __pthread_handles_num = 2;
- __volatile__ int __pthread_threads_debug;
- __volatile__ td_thr_events_t __pthread_threads_events;
- __volatile__ pthread_descr __pthread_last_event;
- static pthread_descr manager_thread;
- #if FLOATING_STACKS
- # define thread_segment(seq) NULL
- #else
- static __inline__ pthread_descr thread_segment(int seg)
- {
- # ifdef _STACK_GROWS_UP
- return (pthread_descr)(THREAD_STACK_START_ADDRESS + (seg - 1) * STACK_SIZE)
- + 1;
- # else
- return (pthread_descr)(THREAD_STACK_START_ADDRESS - (seg - 1) * STACK_SIZE)
- - 1;
- # endif
- }
- #endif
- static __volatile__ int terminated_children;
- static int main_thread_exiting;
- static pthread_t pthread_threads_counter;
- static int pthread_handle_create(pthread_t *thread, const pthread_attr_t *attr,
- void * (*start_routine)(void *), void *arg,
- sigset_t *mask, int father_pid,
- int report_events,
- td_thr_events_t *event_maskp);
- static void pthread_handle_free(pthread_t th_id);
- static void pthread_handle_exit(pthread_descr issuing_thread, int exitcode)
- __attribute__ ((noreturn));
- static void pthread_reap_children(void);
- static void pthread_kill_all_threads(int sig, int main_thread_also);
- static void pthread_for_each_thread(void *arg,
- void (*fn)(void *, pthread_descr));
- int
- __attribute__ ((noreturn))
- __pthread_manager(void *arg)
- {
- pthread_descr self = manager_thread = arg;
- int reqfd = __pthread_manager_reader;
- struct pollfd ufd;
- sigset_t manager_mask;
- int n;
- struct pthread_request request;
-
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(self, 1);
- #endif
- #if !(USE_TLS && HAVE___THREAD)
-
- self->p_errnop = &self->p_errno;
- self->p_h_errnop = &self->p_h_errno;
- #endif
-
- __sigfillset(&manager_mask);
- sigdelset(&manager_mask, __pthread_sig_cancel);
- sigdelset(&manager_mask, SIGTRAP);
- if (__pthread_threads_debug && __pthread_sig_debug > 0)
- sigdelset(&manager_mask, __pthread_sig_debug);
- sigprocmask(SIG_SETMASK, &manager_mask, NULL);
-
- __pthread_manager_adjust_prio(__pthread_main_thread->p_priority);
-
- n = TEMP_FAILURE_RETRY(read_not_cancel(reqfd, (char *)&request,
- sizeof(request)));
- ASSERT(n == sizeof(request) && request.req_kind == REQ_DEBUG);
- ufd.fd = reqfd;
- ufd.events = POLLIN;
-
- while(1) {
- n = __poll(&ufd, 1, 2000);
-
- if (getppid() == 1) {
- pthread_kill_all_threads(SIGKILL, 0);
- _exit(0);
- }
-
- if (terminated_children) {
- terminated_children = 0;
- pthread_reap_children();
- }
-
- if (n == 1 && (ufd.revents & POLLIN)) {
- n = TEMP_FAILURE_RETRY(read_not_cancel(reqfd, (char *)&request,
- sizeof(request)));
- #ifdef DEBUG
- if (n < 0) {
- char d[64];
- write(STDERR_FILENO, d, snprintf(d, sizeof(d), "*** read err %m\n"));
- } else if (n != sizeof(request)) {
- write(STDERR_FILENO, "*** short read in manager\n", 26);
- }
- #endif
- switch(request.req_kind) {
- case REQ_CREATE:
- request.req_thread->p_retcode =
- pthread_handle_create((pthread_t *) &request.req_thread->p_retval,
- request.req_args.create.attr,
- request.req_args.create.fn,
- request.req_args.create.arg,
- &request.req_args.create.mask,
- request.req_thread->p_pid,
- request.req_thread->p_report_events,
- &request.req_thread->p_eventbuf.eventmask);
- restart(request.req_thread);
- break;
- case REQ_FREE:
- pthread_handle_free(request.req_args.free.thread_id);
- break;
- case REQ_PROCESS_EXIT:
- pthread_handle_exit(request.req_thread,
- request.req_args.exit.code);
-
- break;
- case REQ_MAIN_THREAD_EXIT:
- main_thread_exiting = 1;
-
- pthread_reap_children();
- if (__pthread_main_thread->p_nextlive == __pthread_main_thread) {
- restart(__pthread_main_thread);
-
- }
- break;
- case REQ_POST:
- sem_post(request.req_args.post);
- break;
- case REQ_DEBUG:
-
- if (__pthread_threads_debug && __pthread_sig_debug > 0)
- raise(__pthread_sig_debug);
- break;
- case REQ_KICK:
-
- break;
- case REQ_FOR_EACH_THREAD:
- pthread_for_each_thread(request.req_args.for_each.arg,
- request.req_args.for_each.fn);
- restart(request.req_thread);
- break;
- }
- }
- }
- }
- int __pthread_manager_event(void *arg)
- {
- pthread_descr self = arg;
-
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(self, 1);
- #endif
-
- __pthread_lock (THREAD_GETMEM(self, p_lock), NULL);
-
- __pthread_unlock (THREAD_GETMEM(self, p_lock));
- return __pthread_manager(arg);
- }
- static int
- __attribute__ ((noreturn))
- pthread_start_thread(void *arg)
- {
- pthread_descr self = (pthread_descr) arg;
- struct pthread_request request;
- void * outcome;
- #if HP_TIMING_AVAIL
- hp_timing_t tmpclock;
- #endif
-
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(self, self->p_nr);
- #endif
- #if HP_TIMING_AVAIL
- HP_TIMING_NOW (tmpclock);
- THREAD_SETMEM (self, p_cpuclock_offset, tmpclock);
- #endif
-
- THREAD_SETMEM(self, p_pid, __getpid());
-
- sigprocmask(SIG_SETMASK, &self->p_start_args.mask, NULL);
-
- if (THREAD_GETMEM(self, p_start_args.schedpolicy) >= 0)
-
- __sched_setscheduler(THREAD_GETMEM(self, p_pid),
- THREAD_GETMEM(self, p_start_args.schedpolicy),
- &self->p_start_args.schedparam);
- else if (manager_thread->p_priority > 0)
-
- {
- struct sched_param default_params;
- default_params.sched_priority = 0;
- __sched_setscheduler(THREAD_GETMEM(self, p_pid),
- SCHED_OTHER, &default_params);
- }
- #if !(USE_TLS && HAVE___THREAD)
-
- __uselocale (LC_GLOBAL_LOCALE);
- #else
-
- __resp = &self->p_res;
- #endif
-
- if (__pthread_threads_debug && __pthread_sig_debug > 0) {
- request.req_thread = self;
- request.req_kind = REQ_DEBUG;
- TEMP_FAILURE_RETRY(write_not_cancel(__pthread_manager_request,
- (char *) &request, sizeof(request)));
- suspend(self);
- }
-
- outcome = self->p_start_args.start_routine(THREAD_GETMEM(self,
- p_start_args.arg));
-
- __pthread_do_exit(outcome, CURRENT_STACK_FRAME);
- }
- static int
- __attribute__ ((noreturn))
- pthread_start_thread_event(void *arg)
- {
- pthread_descr self = (pthread_descr) arg;
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(self, self->p_nr);
- #endif
-
- THREAD_SETMEM(self, p_pid, __getpid());
-
- __pthread_lock (THREAD_GETMEM(self, p_lock), NULL);
-
- __pthread_unlock (THREAD_GETMEM(self, p_lock));
-
- pthread_start_thread (arg);
- }
- #if defined USE_TLS && !FLOATING_STACKS
- # error "TLS can only work with floating stacks"
- #endif
- static int pthread_allocate_stack(const pthread_attr_t *attr,
- pthread_descr default_new_thread,
- int pagesize,
- char ** out_new_thread,
- char ** out_new_thread_bottom,
- char ** out_guardaddr,
- size_t * out_guardsize,
- size_t * out_stacksize)
- {
- pthread_descr new_thread;
- char * new_thread_bottom;
- char * guardaddr;
- size_t stacksize, guardsize;
- #ifdef USE_TLS
-
- assert (default_new_thread == NULL);
- #endif
- if (attr != NULL && attr->__stackaddr_set)
- {
- #ifdef _STACK_GROWS_UP
-
- # ifdef USE_TLS
-
- new_thread = (pthread_descr) attr->__stackaddr;
- new_thread_bottom = (char *) new_thread;
- # else
- new_thread = (pthread_descr) attr->__stackaddr;
- new_thread_bottom = (char *) (new_thread + 1);
- # endif
- guardaddr = attr->__stackaddr + attr->__stacksize;
- guardsize = 0;
- #else
-
- # ifdef USE_TLS
- new_thread = (pthread_descr) attr->__stackaddr;
- # else
- new_thread =
- (pthread_descr) ((long)(attr->__stackaddr) & -sizeof(void *)) - 1;
- # endif
- new_thread_bottom = (char *) attr->__stackaddr - attr->__stacksize;
- guardaddr = new_thread_bottom;
- guardsize = 0;
- #endif
- #ifndef THREAD_SELF
- __pthread_nonstandard_stacks = 1;
- #endif
- #ifndef USE_TLS
-
- memset (new_thread, '\0', sizeof (*new_thread));
- #endif
- stacksize = attr->__stacksize;
- }
- else
- {
- #ifdef NEED_SEPARATE_REGISTER_STACK
- const size_t granularity = 2 * pagesize;
-
- #else
- const size_t granularity = pagesize;
- #endif
- void *map_addr;
-
- #if FLOATING_STACKS
- if (attr != NULL)
- {
- guardsize = page_roundup (attr->__guardsize, granularity);
- stacksize = __pthread_max_stacksize - guardsize;
- stacksize = MIN (stacksize,
- page_roundup (attr->__stacksize, granularity));
- }
- else
- {
- guardsize = granularity;
- stacksize = __pthread_max_stacksize - guardsize;
- }
- map_addr = mmap(NULL, stacksize + guardsize,
- PROT_READ | PROT_WRITE | PROT_EXEC,
- MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
- if (map_addr == MAP_FAILED)
-
- return -1;
- # ifdef NEED_SEPARATE_REGISTER_STACK
- guardaddr = map_addr + stacksize / 2;
- if (guardsize > 0)
- mprotect (guardaddr, guardsize, PROT_NONE);
- new_thread_bottom = (char *) map_addr;
- # ifdef USE_TLS
- new_thread = ((pthread_descr) (new_thread_bottom + stacksize
- + guardsize));
- # else
- new_thread = ((pthread_descr) (new_thread_bottom + stacksize
- + guardsize)) - 1;
- # endif
- # elif _STACK_GROWS_DOWN
- guardaddr = map_addr;
- if (guardsize > 0)
- mprotect (guardaddr, guardsize, PROT_NONE);
- new_thread_bottom = (char *) map_addr + guardsize;
- # ifdef USE_TLS
- new_thread = ((pthread_descr) (new_thread_bottom + stacksize));
- # else
- new_thread = ((pthread_descr) (new_thread_bottom + stacksize)) - 1;
- # endif
- # elif _STACK_GROWS_UP
- guardaddr = map_addr + stacksize;
- if (guardsize > 0)
- mprotect (guardaddr, guardsize, PROT_NONE);
- new_thread = (pthread_descr) map_addr;
- # ifdef USE_TLS
- new_thread_bottom = (char *) new_thread;
- # else
- new_thread_bottom = (char *) (new_thread + 1);
- # endif
- # else
- # error You must define a stack direction
- # endif
- #else
- # if !defined NEED_SEPARATE_REGISTER_STACK && defined _STACK_GROWS_DOWN
- void *res_addr;
- # endif
- if (attr != NULL)
- {
- guardsize = page_roundup (attr->__guardsize, granularity);
- stacksize = STACK_SIZE - guardsize;
- stacksize = MIN (stacksize,
- page_roundup (attr->__stacksize, granularity));
- }
- else
- {
- guardsize = granularity;
- stacksize = STACK_SIZE - granularity;
- }
- # ifdef NEED_SEPARATE_REGISTER_STACK
- new_thread = default_new_thread;
- new_thread_bottom = (char *) (new_thread + 1) - stacksize - guardsize;
-
-
- map_addr = (caddr_t)((char *)(new_thread + 1) - stacksize / 2);
- res_addr = mmap(map_addr, stacksize / 2,
- PROT_READ | PROT_WRITE | PROT_EXEC,
- MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
- if (res_addr != map_addr)
- {
-
- if (res_addr != MAP_FAILED)
- munmap(res_addr, stacksize / 2);
- return -1;
- }
-
- map_addr = (caddr_t)new_thread_bottom;
- res_addr = mmap(map_addr, stacksize/2,
- PROT_READ | PROT_WRITE | PROT_EXEC,
- MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
- if (res_addr != map_addr)
- {
- if (res_addr != MAP_FAILED)
- munmap(res_addr, stacksize / 2);
- munmap((caddr_t)((char *)(new_thread + 1) - stacksize/2),
- stacksize/2);
- return -1;
- }
- guardaddr = new_thread_bottom + stacksize/2;
-
- # else
- # ifdef _STACK_GROWS_DOWN
- new_thread = default_new_thread;
- new_thread_bottom = (char *) (new_thread + 1) - stacksize;
- map_addr = new_thread_bottom - guardsize;
- res_addr = mmap(map_addr, stacksize + guardsize,
- PROT_READ | PROT_WRITE | PROT_EXEC,
- MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
- if (res_addr != map_addr)
- {
-
- if (res_addr != MAP_FAILED)
- munmap (res_addr, stacksize + guardsize);
- return -1;
- }
-
- guardaddr = map_addr;
- if (guardsize > 0)
- mprotect (guardaddr, guardsize, PROT_NONE);
- # else
-
- new_thread = (pthread_descr)((unsigned long)default_new_thread &~ (STACK_SIZE - 1));
- map_addr = mmap(new_thread, stacksize + guardsize,
- PROT_READ | PROT_WRITE | PROT_EXEC,
- MAP_FIXED | MAP_PRIVATE | MAP_ANONYMOUS, -1, 0);
- if (map_addr == MAP_FAILED)
- return -1;
- new_thread_bottom = map_addr + sizeof(*new_thread);
- guardaddr = map_addr + stacksize;
- if (guardsize > 0)
- mprotect (guardaddr, guardsize, PROT_NONE);
- # endif
- # endif
- #endif
- }
- *out_new_thread = (char *) new_thread;
- *out_new_thread_bottom = new_thread_bottom;
- *out_guardaddr = guardaddr;
- *out_guardsize = guardsize;
- #ifdef NEED_SEPARATE_REGISTER_STACK
- *out_stacksize = stacksize / 2;
- #else
- *out_stacksize = stacksize;
- #endif
- return 0;
- }
- static int pthread_handle_create(pthread_t *thread, const pthread_attr_t *attr,
- void * (*start_routine)(void *), void *arg,
- sigset_t * mask, int father_pid,
- int report_events,
- td_thr_events_t *event_maskp)
- {
- size_t sseg;
- int pid;
- pthread_descr new_thread;
- char *stack_addr;
- char * new_thread_bottom;
- pthread_t new_thread_id;
- char *guardaddr = NULL;
- size_t guardsize = 0, stksize = 0;
- int pagesize = __getpagesize();
- int saved_errno = 0;
- #ifdef USE_TLS
- new_thread = _dl_allocate_tls (NULL);
- if (new_thread == NULL)
- return EAGAIN;
- # if defined(TLS_DTV_AT_TP)
-
- new_thread = (pthread_descr) ((char *) new_thread - TLS_PRE_TCB_SIZE);
- # endif
- #else
-
- new_thread = NULL;
- #endif
-
- if (attr != NULL && attr->__schedpolicy != SCHED_OTHER && geteuid () != 0)
- return EPERM;
-
- for (sseg = 2; ; sseg++)
- {
- if (sseg >= PTHREAD_THREADS_MAX)
- {
- #ifdef USE_TLS
- # if defined(TLS_DTV_AT_TP)
- new_thread = (pthread_descr) ((char *) new_thread + TLS_PRE_TCB_SIZE);
- # endif
- _dl_deallocate_tls (new_thread, true);
- #endif
- return EAGAIN;
- }
- if (__pthread_handles[sseg].h_descr != NULL)
- continue;
- if (pthread_allocate_stack(attr, thread_segment(sseg),
- pagesize, &stack_addr, &new_thread_bottom,
- &guardaddr, &guardsize, &stksize) == 0)
- {
- #ifdef USE_TLS
- new_thread->p_stackaddr = stack_addr;
- #else
- new_thread = (pthread_descr) stack_addr;
- #endif
- break;
- #ifndef __ARCH_USE_MMU__
- } else {
-
- return EAGAIN;
- #endif
- }
- }
- __pthread_handles_num++;
-
- pthread_threads_counter += PTHREAD_THREADS_MAX;
- new_thread_id = sseg + pthread_threads_counter;
-
- #if !defined USE_TLS || !TLS_DTV_AT_TP
- new_thread->p_header.data.tcb = new_thread;
- new_thread->p_header.data.self = new_thread;
- #endif
- #if TLS_MULTIPLE_THREADS_IN_TCB || !defined USE_TLS || !TLS_DTV_AT_TP
- new_thread->p_multiple_threads = 1;
- #endif
- new_thread->p_tid = new_thread_id;
- new_thread->p_lock = &(__pthread_handles[sseg].h_lock);
- new_thread->p_cancelstate = PTHREAD_CANCEL_ENABLE;
- new_thread->p_canceltype = PTHREAD_CANCEL_DEFERRED;
- #if !(USE_TLS && HAVE___THREAD)
- new_thread->p_errnop = &new_thread->p_errno;
- new_thread->p_h_errnop = &new_thread->p_h_errno;
- new_thread->p_resp = &new_thread->p_res;
- #endif
- new_thread->p_guardaddr = guardaddr;
- new_thread->p_guardsize = guardsize;
- new_thread->p_nr = sseg;
- new_thread->p_inheritsched = attr ? attr->__inheritsched : 0;
- new_thread->p_alloca_cutoff = stksize / 4 > __MAX_ALLOCA_CUTOFF
- ? __MAX_ALLOCA_CUTOFF : stksize / 4;
-
- __pthread_init_lock(&__pthread_handles[sseg].h_lock);
- __pthread_handles[sseg].h_descr = new_thread;
- __pthread_handles[sseg].h_bottom = new_thread_bottom;
-
- new_thread->p_start_args.schedpolicy = -1;
- if (attr != NULL) {
- new_thread->p_detached = attr->__detachstate;
- new_thread->p_userstack = attr->__stackaddr_set;
- switch(attr->__inheritsched) {
- case PTHREAD_EXPLICIT_SCHED:
- new_thread->p_start_args.schedpolicy = attr->__schedpolicy;
- memcpy (&new_thread->p_start_args.schedparam, &attr->__schedparam,
- sizeof (struct sched_param));
- break;
- case PTHREAD_INHERIT_SCHED:
- new_thread->p_start_args.schedpolicy = __sched_getscheduler(father_pid);
- __sched_getparam(father_pid, &new_thread->p_start_args.schedparam);
- break;
- }
- new_thread->p_priority =
- new_thread->p_start_args.schedparam.sched_priority;
- }
-
- new_thread->p_start_args.start_routine = start_routine;
- new_thread->p_start_args.arg = arg;
- new_thread->p_start_args.mask = *mask;
-
- *thread = new_thread_id;
-
- __pthread_manager_adjust_prio(new_thread->p_priority);
-
- pid = 0;
- if (report_events)
- {
-
- int idx = __td_eventword (TD_CREATE);
- uint32_t mask = __td_eventmask (TD_CREATE);
- if ((mask & (__pthread_threads_events.event_bits[idx]
- | event_maskp->event_bits[idx])) != 0)
- {
-
- __pthread_lock(new_thread->p_lock, NULL);
-
- #ifdef NEED_SEPARATE_REGISTER_STACK
-
- pid = __clone2(pthread_start_thread_event,
- (void **)new_thread_bottom,
- (char *)stack_addr - new_thread_bottom,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #elif _STACK_GROWS_UP
- pid = __clone(pthread_start_thread_event, (void *) new_thread_bottom,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #else
- pid = __clone(pthread_start_thread_event, stack_addr,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #endif
- saved_errno = errno;
- if (pid != -1)
- {
-
- new_thread->p_eventbuf.eventdata = new_thread;
- new_thread->p_eventbuf.eventnum = TD_CREATE;
- __pthread_last_event = new_thread;
-
- new_thread->p_pid = pid;
-
- __linuxthreads_create_event ();
-
- __pthread_unlock(new_thread->p_lock);
- }
- }
- }
- if (pid == 0)
- {
- #ifdef NEED_SEPARATE_REGISTER_STACK
- pid = __clone2(pthread_start_thread,
- (void **)new_thread_bottom,
- (char *)stack_addr - new_thread_bottom,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #elif _STACK_GROWS_UP
- pid = __clone(pthread_start_thread, (void *) new_thread_bottom,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #else
- pid = __clone(pthread_start_thread, stack_addr,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND | CLONE_SYSVSEM |
- __pthread_sig_cancel, new_thread);
- #endif
- saved_errno = errno;
- }
-
- if (pid == -1) {
-
- if (attr == NULL || !attr->__stackaddr_set)
- {
- #ifdef NEED_SEPARATE_REGISTER_STACK
- size_t stacksize = ((char *)(new_thread->p_guardaddr)
- - new_thread_bottom);
- munmap((caddr_t)new_thread_bottom,
- 2 * stacksize + new_thread->p_guardsize);
- #elif _STACK_GROWS_UP
- # ifdef USE_TLS
- size_t stacksize = guardaddr - stack_addr;
- munmap(stack_addr, stacksize + guardsize);
- # else
- size_t stacksize = guardaddr - (char *)new_thread;
- munmap(new_thread, stacksize + guardsize);
- # endif
- #else
- # ifdef USE_TLS
- size_t stacksize = stack_addr - new_thread_bottom;
- # else
- size_t stacksize = (char *)(new_thread+1) - new_thread_bottom;
- # endif
- munmap(new_thread_bottom - guardsize, guardsize + stacksize);
- #endif
- }
- #ifdef USE_TLS
- # if defined(TLS_DTV_AT_TP)
- new_thread = (pthread_descr) ((char *) new_thread + TLS_PRE_TCB_SIZE);
- # endif
- _dl_deallocate_tls (new_thread, true);
- #endif
- __pthread_handles[sseg].h_descr = NULL;
- __pthread_handles[sseg].h_bottom = NULL;
- __pthread_handles_num--;
- return saved_errno;
- }
-
- new_thread->p_prevlive = __pthread_main_thread;
- new_thread->p_nextlive = __pthread_main_thread->p_nextlive;
- __pthread_main_thread->p_nextlive->p_prevlive = new_thread;
- __pthread_main_thread->p_nextlive = new_thread;
-
- new_thread->p_pid = pid;
- return 0;
- }
- static void pthread_free(pthread_descr th)
- {
- pthread_handle handle;
- pthread_readlock_info *iter, *next;
- ASSERT(th->p_exited);
-
- handle = thread_handle(th->p_tid);
- __pthread_lock(&handle->h_lock, NULL);
- handle->h_descr = NULL;
- handle->h_bottom = (char *)(-1L);
- __pthread_unlock(&handle->h_lock);
- #ifdef FREE_THREAD
- FREE_THREAD(th, th->p_nr);
- #endif
-
- __pthread_handles_num--;
-
- for (iter = th->p_readlock_list; iter != NULL; iter = next)
- {
- next = iter->pr_next;
- free(iter);
- }
- for (iter = th->p_readlock_free; iter != NULL; iter = next)
- {
- next = iter->pr_next;
- free(iter);
- }
-
- if (!th->p_userstack)
- {
- size_t guardsize = th->p_guardsize;
-
- char *guardaddr = th->p_guardaddr;
- #ifdef _STACK_GROWS_UP
- # ifdef USE_TLS
- size_t stacksize = guardaddr - th->p_stackaddr;
- guardaddr = th->p_stackaddr;
- # else
- size_t stacksize = guardaddr - (char *)th;
- guardaddr = (char *)th;
- # endif
- #else
-
- # ifdef USE_TLS
- size_t stacksize = th->p_stackaddr - guardaddr - guardsize;
- # else
- size_t stacksize = (char *)(th+1) - guardaddr - guardsize;
- # endif
- # ifdef NEED_SEPARATE_REGISTER_STACK
-
- guardaddr -= stacksize;
- stacksize *= 2;
- # endif
- #endif
-
- munmap(guardaddr, stacksize + guardsize);
- }
- #ifdef USE_TLS
- # if defined(TLS_DTV_AT_TP)
- th = (pthread_descr) ((char *) th + TLS_PRE_TCB_SIZE);
- # endif
- _dl_deallocate_tls (th, true);
- #endif
- }
- static void pthread_exited(pid_t pid)
- {
- pthread_descr th;
- int detached;
-
- for (th = __pthread_main_thread->p_nextlive;
- th != __pthread_main_thread;
- th = th->p_nextlive) {
- if (th->p_pid == pid) {
-
- th->p_nextlive->p_prevlive = th->p_prevlive;
- th->p_prevlive->p_nextlive = th->p_nextlive;
-
- __pthread_lock(th->p_lock, NULL);
- th->p_exited = 1;
-
- if (th->p_report_events)
- {
-
- int idx = __td_eventword (TD_REAP);
- uint32_t mask = __td_eventmask (TD_REAP);
- if ((mask & (__pthread_threads_events.event_bits[idx]
- | th->p_eventbuf.eventmask.event_bits[idx])) != 0)
- {
-
- th->p_eventbuf.eventnum = TD_REAP;
- th->p_eventbuf.eventdata = th;
- __pthread_last_event = th;
-
- __linuxthreads_reap_event();
- }
- }
- detached = th->p_detached;
- __pthread_unlock(th->p_lock);
- if (detached)
- pthread_free(th);
- break;
- }
- }
-
- if (main_thread_exiting &&
- __pthread_main_thread->p_nextlive == __pthread_main_thread) {
- restart(__pthread_main_thread);
-
- }
- }
- static void pthread_reap_children(void)
- {
- pid_t pid;
- int status;
- while ((pid = waitpid_not_cancel(-1, &status, WNOHANG | __WCLONE)) > 0) {
- pthread_exited(pid);
- if (WIFSIGNALED(status)) {
-
- pthread_kill_all_threads(WTERMSIG(status), 1);
- _exit(0);
- }
- }
- }
- static void pthread_handle_free(pthread_t th_id)
- {
- pthread_handle handle = thread_handle(th_id);
- pthread_descr th;
- __pthread_lock(&handle->h_lock, NULL);
- if (nonexisting_handle(handle, th_id)) {
-
- __pthread_unlock(&handle->h_lock);
- return;
- }
- th = handle->h_descr;
- if (th->p_exited) {
- __pthread_unlock(&handle->h_lock);
- pthread_free(th);
- } else {
-
- th->p_detached = 1;
- __pthread_unlock(&handle->h_lock);
- }
- }
- static void pthread_kill_all_threads(int sig, int main_thread_also)
- {
- pthread_descr th;
- for (th = __pthread_main_thread->p_nextlive;
- th != __pthread_main_thread;
- th = th->p_nextlive) {
- kill(th->p_pid, sig);
- }
- if (main_thread_also) {
- kill(__pthread_main_thread->p_pid, sig);
- }
- }
- static void pthread_for_each_thread(void *arg,
- void (*fn)(void *, pthread_descr))
- {
- pthread_descr th;
- for (th = __pthread_main_thread->p_nextlive;
- th != __pthread_main_thread;
- th = th->p_nextlive) {
- fn(arg, th);
- }
- fn(arg, __pthread_main_thread);
- }
- static void pthread_handle_exit(pthread_descr issuing_thread, int exitcode)
- {
- pthread_descr th;
- __pthread_exit_requested = 1;
- __pthread_exit_code = exitcode;
-
- __flockfilelist();
-
- for (th = issuing_thread->p_nextlive;
- th != issuing_thread;
- th = th->p_nextlive) {
- kill(th->p_pid, __pthread_sig_cancel);
- }
-
- for (th = issuing_thread->p_nextlive;
- th != issuing_thread;
- th = th->p_nextlive) {
- waitpid(th->p_pid, NULL, __WCLONE);
- }
- __fresetlockfiles();
- restart(issuing_thread);
- _exit(0);
- }
- void __pthread_manager_sighandler(int sig)
- {
- int kick_manager = terminated_children == 0 && main_thread_exiting;
- terminated_children = 1;
-
- if (kick_manager) {
- struct pthread_request request;
- request.req_thread = 0;
- request.req_kind = REQ_KICK;
- TEMP_FAILURE_RETRY(write_not_cancel(__pthread_manager_request,
- (char *) &request, sizeof(request)));
- }
- }
- void __pthread_manager_adjust_prio(int thread_prio)
- {
- struct sched_param param;
- if (thread_prio <= manager_thread->p_priority) return;
- param.sched_priority =
- thread_prio < __sched_get_priority_max(SCHED_FIFO)
- ? thread_prio + 1 : thread_prio;
- __sched_setscheduler(manager_thread->p_pid, SCHED_FIFO, ¶m);
- manager_thread->p_priority = thread_prio;
- }
|