12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166 |
- #define __FORCE_GLIBC
- #include <features.h>
- #include <errno.h>
- #include <netdb.h> /* for h_errno */
- #include <stddef.h>
- #include <stdio.h>
- #include <stdlib.h>
- #include <string.h>
- #include <unistd.h>
- #include <fcntl.h>
- #include <sys/wait.h>
- #include <sys/resource.h>
- #include "pthread.h"
- #include "internals.h"
- #include "spinlock.h"
- #include "restart.h"
- #include "debug.h"
- #include <signal.h>
- #include <sys/types.h>
- #include <sys/syscall.h>
- extern __typeof(sigaction) __libc_sigaction;
- libpthread_hidden_proto(waitpid)
- libpthread_hidden_proto(raise)
- extern int _errno;
- extern int _h_errno;
- struct _pthread_descr_struct __pthread_initial_thread = {
- &__pthread_initial_thread,
- &__pthread_initial_thread,
- NULL,
- NULL,
- PTHREAD_THREADS_MAX,
- 0,
- 0,
- &__pthread_handles[0].h_lock,
- 0,
- NULL,
- NULL,
- 0,
- 0,
- 0,
- NULL,
- 0,
- NULL,
- NULL,
- 0,
- 0,
- 0,
- &_errno,
- 0,
- &_h_errno,
- 0,
- NULL,
- 0,
- PTHREAD_START_ARGS_INITIALIZER,
- {NULL},
- {NULL},
- 0,
- NULL,
- 0,
- &__pthread_initial_thread,
- 0,
- 0,
- {{{0, }}, 0, NULL},
- __ATOMIC_INITIALIZER,
- 0,
- 0,
- 0,
- NULL,
- NULL,
- NULL,
- 0
- #ifdef __UCLIBC_HAS_XLOCALE__
- ,
- &__global_locale_data,
- #endif
- };
- #define manager_thread (&__pthread_manager_thread)
- struct _pthread_descr_struct __pthread_manager_thread = {
- NULL,
- NULL,
- NULL,
- NULL,
- 0,
- 0,
- 0,
- &__pthread_handles[1].h_lock,
- 0,
- NULL,
- NULL,
- 0,
- 0,
- 0,
- NULL,
- 0,
- NULL,
- NULL,
- 0,
- 0,
- 0,
- &__pthread_manager_thread.p_errno,
- 0,
- NULL,
- 0,
- NULL,
- 0,
- PTHREAD_START_ARGS_INITIALIZER,
- {NULL},
- {NULL},
- 0,
- NULL,
- 0,
- &__pthread_manager_thread,
- 1,
- 0,
- {{{0, }}, 0, NULL},
- __ATOMIC_INITIALIZER,
- 0,
- 0,
- 0,
- NULL,
- NULL,
- NULL,
- 0
- #ifdef __UCLIBC_HAS_XLOCALE__
- ,
- &__global_locale_data,
- #endif
- };
- pthread_descr __pthread_main_thread = &__pthread_initial_thread;
- char *__pthread_initial_thread_bos = NULL;
- #ifndef __ARCH_USE_MMU__
- char *__pthread_initial_thread_tos = NULL;
- #endif
- int __pthread_manager_request = -1;
- int __pthread_manager_reader;
- char *__pthread_manager_thread_bos = NULL;
- char *__pthread_manager_thread_tos = NULL;
- int __pthread_exit_requested = 0;
- int __pthread_exit_code = 0;
- const int __pthread_threads_max = PTHREAD_THREADS_MAX;
- const int __pthread_sizeof_handle = sizeof(struct pthread_handle_struct);
- const int __pthread_offsetof_descr = offsetof(struct pthread_handle_struct, h_descr);
- const int __pthread_offsetof_pid = offsetof(struct _pthread_descr_struct,
- p_pid);
- const int __linuxthreads_pthread_sizeof_descr
- = sizeof(struct _pthread_descr_struct);
- const int __linuxthreads_initial_report_events;
- const char __linuxthreads_version[] = VERSION;
- static void pthread_onexit_process(int retcode, void *arg);
- static void pthread_handle_sigcancel(int sig);
- static void pthread_handle_sigrestart(int sig);
- static void pthread_handle_sigdebug(int sig);
- int __pthread_timedsuspend_new(pthread_descr self, const struct timespec *abstime);
- #ifndef __NR_rt_sigaction
- static int current_rtmin = -1;
- static int current_rtmax = -1;
- int __pthread_sig_restart = SIGUSR1;
- int __pthread_sig_cancel = SIGUSR2;
- int __pthread_sig_debug;
- #else
- #if __SIGRTMAX - __SIGRTMIN >= 3
- static int current_rtmin = __SIGRTMIN + 3;
- static int current_rtmax = __SIGRTMAX;
- int __pthread_sig_restart = __SIGRTMIN;
- int __pthread_sig_cancel = __SIGRTMIN + 1;
- int __pthread_sig_debug = __SIGRTMIN + 2;
- void (*__pthread_restart)(pthread_descr) = __pthread_restart_new;
- void (*__pthread_suspend)(pthread_descr) = __pthread_wait_for_restart_signal;
- int (*__pthread_timedsuspend)(pthread_descr, const struct timespec *) = __pthread_timedsuspend_new;
- #else
- static int current_rtmin = __SIGRTMIN;
- static int current_rtmax = __SIGRTMAX;
- int __pthread_sig_restart = SIGUSR1;
- int __pthread_sig_cancel = SIGUSR2;
- int __pthread_sig_debug;
- void (*__pthread_restart)(pthread_descr) = __pthread_restart_old;
- void (*__pthread_suspend)(pthread_descr) = __pthread_suspend_old;
- int (*__pthread_timedsuspend)(pthread_descr, const struct timespec *) = __pthread_timedsuspend_old;
- #endif
- int __libc_current_sigrtmin (void)
- {
- return current_rtmin;
- }
- int __libc_current_sigrtmax (void)
- {
- return current_rtmax;
- }
- int __libc_allocate_rtsig (int high);
- int __libc_allocate_rtsig (int high)
- {
- if (current_rtmin == -1 || current_rtmin > current_rtmax)
-
- return -1;
- return high ? current_rtmin++ : current_rtmax--;
- }
- #endif
- static void pthread_initialize(void) __attribute__((constructor));
- libpthread_hidden_proto(pthread_attr_destroy)
- libpthread_hidden_proto(pthread_attr_init)
- libpthread_hidden_proto(pthread_attr_getdetachstate)
- libpthread_hidden_proto(pthread_attr_setdetachstate)
- libpthread_hidden_proto(pthread_attr_getinheritsched)
- libpthread_hidden_proto(pthread_attr_setinheritsched)
- libpthread_hidden_proto(pthread_attr_setschedparam)
- libpthread_hidden_proto(pthread_attr_getschedparam)
- libpthread_hidden_proto(pthread_attr_getschedpolicy)
- libpthread_hidden_proto(pthread_attr_setschedpolicy)
- libpthread_hidden_proto(pthread_attr_getscope)
- libpthread_hidden_proto(pthread_attr_setscope)
- libpthread_hidden_proto(pthread_exit)
- libpthread_hidden_proto(pthread_equal)
- libpthread_hidden_proto(pthread_self)
- libpthread_hidden_proto(pthread_getschedparam)
- libpthread_hidden_proto(pthread_setschedparam)
- libpthread_hidden_proto(pthread_setcancelstate)
- libpthread_hidden_proto(pthread_setcanceltype)
- libpthread_hidden_proto(_pthread_cleanup_push_defer)
- libpthread_hidden_proto(_pthread_cleanup_pop_restore)
- libpthread_hidden_proto(pthread_cond_broadcast)
- libpthread_hidden_proto(pthread_cond_destroy)
- libpthread_hidden_proto(pthread_cond_init)
- libpthread_hidden_proto(pthread_cond_signal)
- libpthread_hidden_proto(pthread_cond_wait)
- libpthread_hidden_proto(pthread_cond_timedwait)
- libpthread_hidden_proto(pthread_condattr_destroy)
- libpthread_hidden_proto(pthread_condattr_init)
- struct pthread_functions __pthread_functions =
- {
- #if !(USE_TLS && HAVE___THREAD)
- .ptr_pthread_internal_tsd_set = __pthread_internal_tsd_set,
- .ptr_pthread_internal_tsd_get = __pthread_internal_tsd_get,
- .ptr_pthread_internal_tsd_address = __pthread_internal_tsd_address,
- #endif
- .ptr_pthread_attr_destroy = pthread_attr_destroy,
- .ptr_pthread_attr_init = pthread_attr_init,
- .ptr_pthread_attr_getdetachstate = pthread_attr_getdetachstate,
- .ptr_pthread_attr_setdetachstate = pthread_attr_setdetachstate,
- .ptr_pthread_attr_getinheritsched = pthread_attr_getinheritsched,
- .ptr_pthread_attr_setinheritsched = pthread_attr_setinheritsched,
- .ptr_pthread_attr_getschedparam = pthread_attr_getschedparam,
- .ptr_pthread_attr_setschedparam = pthread_attr_setschedparam,
- .ptr_pthread_attr_getschedpolicy = pthread_attr_getschedpolicy,
- .ptr_pthread_attr_setschedpolicy = pthread_attr_setschedpolicy,
- .ptr_pthread_attr_getscope = pthread_attr_getscope,
- .ptr_pthread_attr_setscope = pthread_attr_setscope,
- .ptr_pthread_condattr_destroy = pthread_condattr_destroy,
- .ptr_pthread_condattr_init = pthread_condattr_init,
- .ptr_pthread_cond_broadcast = pthread_cond_broadcast,
- .ptr_pthread_cond_destroy = pthread_cond_destroy,
- .ptr_pthread_cond_init = pthread_cond_init,
- .ptr_pthread_cond_signal = pthread_cond_signal,
- .ptr_pthread_cond_wait = pthread_cond_wait,
- .ptr_pthread_cond_timedwait = pthread_cond_timedwait,
- .ptr_pthread_equal = pthread_equal,
- .ptr___pthread_exit = pthread_exit,
- .ptr_pthread_getschedparam = pthread_getschedparam,
- .ptr_pthread_setschedparam = pthread_setschedparam,
- .ptr_pthread_mutex_destroy = __pthread_mutex_destroy,
- .ptr_pthread_mutex_init = __pthread_mutex_init,
- .ptr_pthread_mutex_lock = __pthread_mutex_lock,
- .ptr_pthread_mutex_trylock = __pthread_mutex_trylock,
- .ptr_pthread_mutex_unlock = __pthread_mutex_unlock,
- .ptr_pthread_self = pthread_self,
- .ptr_pthread_setcancelstate = pthread_setcancelstate,
- .ptr_pthread_setcanceltype = pthread_setcanceltype,
- .ptr__pthread_cleanup_push_defer = __pthread_cleanup_push_defer,
- .ptr__pthread_cleanup_pop_restore = __pthread_cleanup_pop_restore,
- };
- #ifdef SHARED
- # define ptr_pthread_functions &__pthread_functions
- #else
- # define ptr_pthread_functions NULL
- #endif
- static int *__libc_multiple_threads_ptr;
-
- void __pthread_initialize_minimal(void)
- {
-
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(&__pthread_initial_thread, 0);
- #endif
- __libc_multiple_threads_ptr = __libc_pthread_init (ptr_pthread_functions);
- }
- static void pthread_initialize(void)
- {
- struct sigaction sa;
- sigset_t mask;
- #ifdef __ARCH_USE_MMU__
- struct rlimit limit;
- rlim_t max_stack;
- #endif
-
- if (__pthread_initial_thread_bos != NULL) return;
- #ifdef TEST_FOR_COMPARE_AND_SWAP
-
- __pthread_has_cas = compare_and_swap_is_available();
- #endif
-
- __pthread_initial_thread_bos =
- (char *)(((long)CURRENT_STACK_FRAME - 2 * STACK_SIZE) & ~(STACK_SIZE - 1));
-
- __pthread_initial_thread.p_pid = getpid();
-
- #ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(&__pthread_initial_thread, 0);
- #endif
-
- __pthread_initial_thread.p_errnop = &_errno;
- __pthread_initial_thread.p_h_errnop = &_h_errno;
- #ifdef __UCLIBC_HAS_XLOCALE__
-
- __pthread_initial_thread.locale = __curlocale_var;
- #endif
- {
- FILE *fp;
- _stdio_user_locking = 0;
- for (fp = _stdio_openlist; fp != NULL; fp = fp->__nextopen) {
- if (fp->__user_locking != 1) {
- fp->__user_locking = 0;
- }
- }
- }
-
- #ifdef __ARCH_USE_MMU__
-
- getrlimit(RLIMIT_STACK, &limit);
- max_stack = STACK_SIZE - 2 * getpagesize();
- if (limit.rlim_cur > max_stack) {
- limit.rlim_cur = max_stack;
- setrlimit(RLIMIT_STACK, &limit);
- }
- #else
-
- __pthread_initial_thread_tos =
- (char *)(((long)CURRENT_STACK_FRAME + getpagesize()) & ~(getpagesize() - 1));
- __pthread_initial_thread_bos = (char *) 1;
- PDEBUG("initial thread stack bounds: bos=%p, tos=%p\n",
- __pthread_initial_thread_bos, __pthread_initial_thread_tos);
- #endif
-
- sa.sa_handler = pthread_handle_sigrestart;
- sigemptyset(&sa.sa_mask);
- sa.sa_flags = 0;
- __libc_sigaction(__pthread_sig_restart, &sa, NULL);
- sa.sa_handler = pthread_handle_sigcancel;
- sigaddset(&sa.sa_mask, __pthread_sig_restart);
-
- __libc_sigaction(__pthread_sig_cancel, &sa, NULL);
- if (__pthread_sig_debug > 0) {
- sa.sa_handler = pthread_handle_sigdebug;
- sigemptyset(&sa.sa_mask);
-
- __libc_sigaction(__pthread_sig_debug, &sa, NULL);
- }
-
- sigemptyset(&mask);
- sigaddset(&mask, __pthread_sig_restart);
- sigprocmask(SIG_BLOCK, &mask, NULL);
-
- sigdelset(&mask, __pthread_sig_restart);
- sigaddset(&mask, __pthread_sig_cancel);
- sigprocmask(SIG_UNBLOCK, &mask, NULL);
-
-
- on_exit(pthread_onexit_process, NULL);
- }
- void __pthread_initialize(void);
- void __pthread_initialize(void)
- {
- pthread_initialize();
- }
- int __pthread_initialize_manager(void)
- {
- int manager_pipe[2];
- int pid;
- int report_events;
- struct pthread_request request;
- *__libc_multiple_threads_ptr = 1;
-
- if (__pthread_initial_thread_bos == NULL) pthread_initialize();
-
- __pthread_manager_thread_bos = malloc(THREAD_MANAGER_STACK_SIZE);
- if (__pthread_manager_thread_bos == NULL) return -1;
- __pthread_manager_thread_tos =
- __pthread_manager_thread_bos + THREAD_MANAGER_STACK_SIZE;
-
- NOMMU_INITIAL_THREAD_BOUNDS(__pthread_manager_thread_tos,__pthread_manager_thread_bos);
- PDEBUG("manager stack: size=%d, bos=%p, tos=%p\n", THREAD_MANAGER_STACK_SIZE,
- __pthread_manager_thread_bos, __pthread_manager_thread_tos);
- #if 0
- PDEBUG("initial stack: estimate bos=%p, tos=%p\n",
- __pthread_initial_thread_bos, __pthread_initial_thread_tos);
- #endif
-
- if (pipe(manager_pipe) == -1) {
- free(__pthread_manager_thread_bos);
- return -1;
- }
-
- pid = 0;
- #ifdef USE_TLS
- if (__linuxthreads_initial_report_events != 0)
- THREAD_SETMEM (((pthread_descr) NULL), p_report_events,
- __linuxthreads_initial_report_events);
- report_events = THREAD_GETMEM (((pthread_descr) NULL), p_report_events);
- #else
- if (__linuxthreads_initial_report_events != 0)
- __pthread_initial_thread.p_report_events
- = __linuxthreads_initial_report_events;
- report_events = __pthread_initial_thread.p_report_events;
- #endif
- if (__builtin_expect (report_events, 0))
- {
-
- int idx = __td_eventword (TD_CREATE);
- uint32_t mask = __td_eventmask (TD_CREATE);
- if ((mask & (__pthread_threads_events.event_bits[idx]
- | __pthread_initial_thread.p_eventbuf.eventmask.event_bits[idx]))
- != 0)
- {
- __pthread_lock(__pthread_manager_thread.p_lock, NULL);
- #ifdef __ia64__
- pid = __clone2(__pthread_manager_event,
- (void **) __pthread_manager_thread_tos,
- THREAD_MANAGER_STACK_SIZE,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND,
- (void *)(long)manager_pipe[0]);
- #else
- pid = clone(__pthread_manager_event,
- (void **) __pthread_manager_thread_tos,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND,
- (void *)(long)manager_pipe[0]);
- #endif
- if (pid != -1)
- {
-
- __pthread_manager_thread.p_eventbuf.eventdata =
- &__pthread_manager_thread;
- __pthread_manager_thread.p_eventbuf.eventnum = TD_CREATE;
- __pthread_last_event = &__pthread_manager_thread;
- __pthread_manager_thread.p_tid = 2* PTHREAD_THREADS_MAX + 1;
- __pthread_manager_thread.p_pid = pid;
-
- __linuxthreads_create_event ();
- }
-
- __pthread_unlock(__pthread_manager_thread.p_lock);
- }
- }
- if (pid == 0) {
- #ifdef __ia64__
- pid = __clone2(__pthread_manager, (void **) __pthread_manager_thread_tos,
- THREAD_MANAGER_STACK_SIZE,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND,
- (void *)(long)manager_pipe[0]);
- #else
- pid = clone(__pthread_manager, (void **) __pthread_manager_thread_tos,
- CLONE_VM | CLONE_FS | CLONE_FILES | CLONE_SIGHAND,
- (void *)(long)manager_pipe[0]);
- #endif
- }
- if (pid == -1) {
- free(__pthread_manager_thread_bos);
- __libc_close(manager_pipe[0]);
- __libc_close(manager_pipe[1]);
- return -1;
- }
- __pthread_manager_request = manager_pipe[1];
- __pthread_manager_reader = manager_pipe[0];
- __pthread_manager_thread.p_tid = 2* PTHREAD_THREADS_MAX + 1;
- __pthread_manager_thread.p_pid = pid;
-
- if (__pthread_threads_debug && __pthread_sig_debug > 0)
- {
- raise(__pthread_sig_debug);
-
- __pthread_wait_for_restart_signal(thread_self());
- }
-
- PDEBUG("send REQ_DEBUG to manager thread\n");
- request.req_kind = REQ_DEBUG;
- TEMP_FAILURE_RETRY(__libc_write(__pthread_manager_request,
- (char *) &request, sizeof(request)));
- return 0;
- }
- int pthread_create(pthread_t *thread, const pthread_attr_t *attr,
- void * (*start_routine)(void *), void *arg)
- {
- pthread_descr self = thread_self();
- struct pthread_request request;
- if (__pthread_manager_request < 0) {
- if (__pthread_initialize_manager() < 0) return EAGAIN;
- }
- request.req_thread = self;
- request.req_kind = REQ_CREATE;
- request.req_args.create.attr = attr;
- request.req_args.create.fn = start_routine;
- request.req_args.create.arg = arg;
- sigprocmask(SIG_SETMASK, (const sigset_t *) NULL,
- &request.req_args.create.mask);
- PDEBUG("write REQ_CREATE to manager thread\n");
- TEMP_FAILURE_RETRY(__libc_write(__pthread_manager_request,
- (char *) &request, sizeof(request)));
- PDEBUG("before suspend(self)\n");
- suspend(self);
- PDEBUG("after suspend(self)\n");
- if (THREAD_GETMEM(self, p_retcode) == 0)
- *thread = (pthread_t) THREAD_GETMEM(self, p_retval);
- return THREAD_GETMEM(self, p_retcode);
- }
- pthread_t pthread_self(void)
- {
- pthread_descr self = thread_self();
- return THREAD_GETMEM(self, p_tid);
- }
- libpthread_hidden_def (pthread_self)
- int pthread_equal(pthread_t thread1, pthread_t thread2)
- {
- return thread1 == thread2;
- }
- libpthread_hidden_def (pthread_equal)
- #ifndef THREAD_SELF
- pthread_descr __pthread_find_self(void)
- {
- char * sp = CURRENT_STACK_FRAME;
- pthread_handle h;
-
- h = __pthread_handles + 2;
- while (! (sp <= (char *) h->h_descr && sp >= h->h_bottom)) h++;
- #ifdef DEBUG_PT
- if (h->h_descr == NULL) {
- printf("*** %s ERROR descriptor is NULL!!!!! ***\n\n", __FUNCTION__);
- _exit(1);
- }
- #endif
- return h->h_descr;
- }
- #else
- static pthread_descr thread_self_stack(void)
- {
- char *sp = CURRENT_STACK_FRAME;
- pthread_handle h;
- if (sp >= __pthread_manager_thread_bos && sp < __pthread_manager_thread_tos)
- return manager_thread;
- h = __pthread_handles + 2;
- # ifdef USE_TLS
- while (h->h_descr == NULL
- || ! (sp <= (char *) h->h_descr->p_stackaddr && sp >= h->h_bottom))
- h++;
- # else
- while (! (sp <= (char *) h->h_descr && sp >= h->h_bottom))
- h++;
- # endif
- return h->h_descr;
- }
- #endif
- int pthread_setschedparam(pthread_t thread, int policy,
- const struct sched_param *param)
- {
- pthread_handle handle = thread_handle(thread);
- pthread_descr th;
- __pthread_lock(&handle->h_lock, NULL);
- if (invalid_handle(handle, thread)) {
- __pthread_unlock(&handle->h_lock);
- return ESRCH;
- }
- th = handle->h_descr;
- if (sched_setscheduler(th->p_pid, policy, param) == -1) {
- __pthread_unlock(&handle->h_lock);
- return errno;
- }
- th->p_priority = policy == SCHED_OTHER ? 0 : param->sched_priority;
- __pthread_unlock(&handle->h_lock);
- if (__pthread_manager_request >= 0)
- __pthread_manager_adjust_prio(th->p_priority);
- return 0;
- }
- libpthread_hidden_def(pthread_setschedparam)
- int pthread_getschedparam(pthread_t thread, int *policy,
- struct sched_param *param)
- {
- pthread_handle handle = thread_handle(thread);
- int pid, pol;
- __pthread_lock(&handle->h_lock, NULL);
- if (invalid_handle(handle, thread)) {
- __pthread_unlock(&handle->h_lock);
- return ESRCH;
- }
- pid = handle->h_descr->p_pid;
- __pthread_unlock(&handle->h_lock);
- pol = sched_getscheduler(pid);
- if (pol == -1) return errno;
- if (sched_getparam(pid, param) == -1) return errno;
- *policy = pol;
- return 0;
- }
- libpthread_hidden_def(pthread_getschedparam)
- static void pthread_onexit_process(int retcode, void *arg attribute_unused)
- {
- struct pthread_request request;
- pthread_descr self = thread_self();
- if (__pthread_manager_request >= 0) {
- request.req_thread = self;
- request.req_kind = REQ_PROCESS_EXIT;
- request.req_args.exit.code = retcode;
- TEMP_FAILURE_RETRY(__libc_write(__pthread_manager_request,
- (char *) &request, sizeof(request)));
- suspend(self);
-
- if (self == __pthread_main_thread) {
- waitpid(__pthread_manager_thread.p_pid, NULL, __WCLONE);
-
- __pthread_manager_thread_bos = __pthread_manager_thread_tos = NULL;
- }
- }
- }
- static void pthread_handle_sigrestart(int sig)
- {
- pthread_descr self = thread_self();
- THREAD_SETMEM(self, p_signal, sig);
- if (THREAD_GETMEM(self, p_signal_jmp) != NULL)
- siglongjmp(*THREAD_GETMEM(self, p_signal_jmp), 1);
- }
- static void pthread_handle_sigcancel(int sig)
- {
- pthread_descr self = thread_self();
- sigjmp_buf * jmpbuf;
- if (self == &__pthread_manager_thread)
- {
- #ifdef THREAD_SELF
-
- pthread_descr real_self = thread_self_stack();
- if (real_self == &__pthread_manager_thread)
- {
- __pthread_manager_sighandler(sig);
- return;
- }
-
- self = real_self;
- # ifdef INIT_THREAD_SELF
- INIT_THREAD_SELF(self, self->p_nr);
- # endif
- #else
- __pthread_manager_sighandler(sig);
- return;
- #endif
- }
- if (__builtin_expect (__pthread_exit_requested, 0)) {
-
- if (self == __pthread_main_thread) {
- #ifdef USE_TLS
- waitpid(__pthread_manager_thread->p_pid, NULL, __WCLONE);
- #else
- waitpid(__pthread_manager_thread.p_pid, NULL, __WCLONE);
- #endif
- }
- _exit(__pthread_exit_code);
- }
- if (__builtin_expect (THREAD_GETMEM(self, p_canceled), 0)
- && THREAD_GETMEM(self, p_cancelstate) == PTHREAD_CANCEL_ENABLE) {
- if (THREAD_GETMEM(self, p_canceltype) == PTHREAD_CANCEL_ASYNCHRONOUS)
- __pthread_do_exit(PTHREAD_CANCELED, CURRENT_STACK_FRAME);
- jmpbuf = THREAD_GETMEM(self, p_cancel_jmp);
- if (jmpbuf != NULL) {
- THREAD_SETMEM(self, p_cancel_jmp, NULL);
- siglongjmp(*jmpbuf, 1);
- }
- }
- }
- static void pthread_handle_sigdebug(int sig attribute_unused)
- {
-
- }
- void __pthread_reset_main_thread(void)
- {
- pthread_descr self = thread_self();
- if (__pthread_manager_request != -1) {
-
- free(__pthread_manager_thread_bos);
- __pthread_manager_thread_bos = __pthread_manager_thread_tos = NULL;
-
- __libc_close(__pthread_manager_request);
- __libc_close(__pthread_manager_reader);
- __pthread_manager_request = __pthread_manager_reader = -1;
- }
-
- THREAD_SETMEM(self, p_pid, getpid());
-
- __pthread_main_thread = self;
- THREAD_SETMEM(self, p_nextlive, self);
- THREAD_SETMEM(self, p_prevlive, self);
-
- THREAD_SETMEM(self, p_errnop, &_errno);
- THREAD_SETMEM(self, p_h_errnop, &_h_errno);
- }
- void __pthread_kill_other_threads_np(void)
- {
- struct sigaction sa;
-
- pthread_onexit_process(0, NULL);
-
- __pthread_reset_main_thread();
-
- sigemptyset(&sa.sa_mask);
- sa.sa_flags = 0;
- sa.sa_handler = SIG_DFL;
- __libc_sigaction(__pthread_sig_restart, &sa, NULL);
- __libc_sigaction(__pthread_sig_cancel, &sa, NULL);
- if (__pthread_sig_debug > 0)
- __libc_sigaction(__pthread_sig_debug, &sa, NULL);
- }
- weak_alias (__pthread_kill_other_threads_np, pthread_kill_other_threads_np)
- static int current_level;
- int __pthread_setconcurrency(int level)
- {
-
- current_level = level;
- return 0;
- }
- weak_alias (__pthread_setconcurrency, pthread_setconcurrency)
- int __pthread_getconcurrency(void)
- {
- return current_level;
- }
- weak_alias (__pthread_getconcurrency, pthread_getconcurrency)
- void __pthread_wait_for_restart_signal(pthread_descr self)
- {
- sigset_t mask;
- sigprocmask(SIG_SETMASK, NULL, &mask);
- sigdelset(&mask, __pthread_sig_restart);
- THREAD_SETMEM(self, p_signal, 0);
- do {
- sigsuspend(&mask);
- } while (THREAD_GETMEM(self, p_signal) !=__pthread_sig_restart);
- READ_MEMORY_BARRIER();
- }
- #ifndef __NR_rt_sigaction
- void __pthread_restart_old(pthread_descr th)
- {
- if (atomic_increment(&th->p_resume_count) == -1)
- kill(th->p_pid, __pthread_sig_restart);
- }
- void __pthread_suspend_old(pthread_descr self)
- {
- if (atomic_decrement(&self->p_resume_count) <= 0)
- __pthread_wait_for_restart_signal(self);
- }
- int
- __pthread_timedsuspend_old(pthread_descr self, const struct timespec *abstime)
- {
- sigset_t unblock, initial_mask;
- int was_signalled = 0;
- sigjmp_buf jmpbuf;
- if (atomic_decrement(&self->p_resume_count) == 0) {
-
- if (sigsetjmp(jmpbuf, 1) == 0) {
- THREAD_SETMEM(self, p_signal_jmp, &jmpbuf);
- THREAD_SETMEM(self, p_signal, 0);
-
- sigemptyset(&unblock);
- sigaddset(&unblock, __pthread_sig_restart);
- sigprocmask(SIG_UNBLOCK, &unblock, &initial_mask);
- while (1) {
- struct timeval now;
- struct timespec reltime;
-
- gettimeofday (&now, NULL);
- reltime.tv_nsec = abstime->tv_nsec - now.tv_usec * 1000;
- reltime.tv_sec = abstime->tv_sec - now.tv_sec;
- if (reltime.tv_nsec < 0) {
- reltime.tv_nsec += 1000000000;
- reltime.tv_sec -= 1;
- }
-
- if (reltime.tv_sec < 0 || __libc_nanosleep(&reltime, NULL) == 0)
- break;
- }
-
- sigprocmask(SIG_SETMASK, &initial_mask, NULL);
- was_signalled = 0;
- } else {
- was_signalled = 1;
- }
- THREAD_SETMEM(self, p_signal_jmp, NULL);
- }
-
- if (!was_signalled) {
- if (atomic_increment(&self->p_resume_count) != -1) {
- __pthread_wait_for_restart_signal(self);
- atomic_decrement(&self->p_resume_count);
-
- return 1;
- }
-
- return 0;
- }
-
- return 1;
- }
- #endif
- #ifdef __NR_rt_sigaction
- void __pthread_restart_new(pthread_descr th)
- {
-
- WRITE_MEMORY_BARRIER();
- kill(th->p_pid, __pthread_sig_restart);
- }
- int __pthread_timedsuspend_new(pthread_descr self, const struct timespec *abstime)
- {
- sigset_t unblock, initial_mask;
- int was_signalled = 0;
- sigjmp_buf jmpbuf;
- if (sigsetjmp(jmpbuf, 1) == 0) {
- THREAD_SETMEM(self, p_signal_jmp, &jmpbuf);
- THREAD_SETMEM(self, p_signal, 0);
-
- sigemptyset(&unblock);
- sigaddset(&unblock, __pthread_sig_restart);
- sigprocmask(SIG_UNBLOCK, &unblock, &initial_mask);
- while (1) {
- struct timeval now;
- struct timespec reltime;
-
- gettimeofday (&now, NULL);
- reltime.tv_nsec = abstime->tv_nsec - now.tv_usec * 1000;
- reltime.tv_sec = abstime->tv_sec - now.tv_sec;
- if (reltime.tv_nsec < 0) {
- reltime.tv_nsec += 1000000000;
- reltime.tv_sec -= 1;
- }
-
- if (reltime.tv_sec < 0 || __libc_nanosleep(&reltime, NULL) == 0)
- break;
- }
-
- sigprocmask(SIG_SETMASK, &initial_mask, NULL);
- was_signalled = 0;
- } else {
- was_signalled = 1;
- }
- THREAD_SETMEM(self, p_signal_jmp, NULL);
-
- READ_MEMORY_BARRIER();
- return was_signalled;
- }
- #endif
- #ifdef DEBUG_PT
- #include <stdarg.h>
- void __pthread_message(char * fmt, ...)
- {
- char buffer[1024];
- va_list args;
- sprintf(buffer, "%05d : ", getpid());
- va_start(args, fmt);
- vsnprintf(buffer + 8, sizeof(buffer) - 8, fmt, args);
- va_end(args);
- TEMP_FAILURE_RETRY(__libc_write(2, buffer, strlen(buffer)));
- }
- #endif
- #ifndef __PIC__
- extern const int __pthread_provide_wrappers;
- static const int *const __pthread_require_wrappers =
- &__pthread_provide_wrappers;
- #endif
|