X-Git-Url: http://nsz.repo.hu/git/?a=blobdiff_plain;f=src%2Ftime%2Ftimer_create.c;h=cd32c945b6a8702cfcd5e3f28bb16c72f9b4deee;hb=b1dfb734a45d4f74c7a24c5f07d37f7e74451802;hp=f596b0fe5f430b593193ce132a613b1eca0f8f98;hpb=8b625e45ff27ae6604ced1039d6c28293b60380a;p=musl diff --git a/src/time/timer_create.c b/src/time/timer_create.c index f596b0fe..cd32c945 100644 --- a/src/time/timer_create.c +++ b/src/time/timer_create.c @@ -1,5 +1,8 @@ #include +#include +#include #include "pthread_impl.h" +#include "atomic.h" struct ksigevent { union sigval sigev_value; @@ -13,67 +16,52 @@ struct start_args { struct sigevent *sev; }; -static void dummy_1(pthread_t self) +static void dummy_0() { } -weak_alias(dummy_1, __pthread_tsd_run_dtors); +weak_alias(dummy_0, __pthread_tsd_run_dtors); static void cleanup_fromsig(void *p) { pthread_t self = __pthread_self(); - __pthread_tsd_run_dtors(self); + __pthread_tsd_run_dtors(); self->cancel = 0; self->cancelbuf = 0; self->canceldisable = 0; self->cancelasync = 0; - self->unblock_cancel = 0; + __reset_tls(); longjmp(p, 1); } -static void timer_handler(int sig, siginfo_t *si, void *ctx) -{ - pthread_t self = __pthread_self(); - jmp_buf jb; - void (*notify)(union sigval) = (void (*)(union sigval))self->start; - union sigval val = { .sival_ptr = self->start_arg }; - - if (!setjmp(jb) && si->si_code == SI_TIMER) { - pthread_cleanup_push(cleanup_fromsig, jb); - notify(val); - pthread_cleanup_pop(1); - } -} - -static void install_handler() -{ - struct sigaction sa = { - .sa_sigaction = timer_handler, - .sa_flags = SA_SIGINFO | SA_RESTART - }; - __libc_sigaction(SIGTIMER, &sa, 0); - __syscall(SYS_rt_sigprocmask, SIG_UNBLOCK, SIGTIMER_SET, 0, 8); -} - static void *start(void *arg) { pthread_t self = __pthread_self(); struct start_args *args = arg; + jmp_buf jb; - /* Reuse no-longer-needed thread structure fields to avoid - * needing the timer address in the signal handler. */ - self->start = (void *(*)(void *))args->sev->sigev_notify_function; - self->start_arg = args->sev->sigev_value.sival_ptr; - self->result = (void *)-1; + void (*notify)(union sigval) = args->sev->sigev_notify_function; + union sigval val = args->sev->sigev_value; pthread_barrier_wait(&args->b); - __wait(&self->delete_timer, 0, 0, 1); - __syscall(SYS_timer_delete, self->result); + if (self->cancel) + return 0; + for (;;) { + siginfo_t si; + while (sigwaitinfo(SIGTIMER_SET, &si) < 0); + if (si.si_code == SI_TIMER && !setjmp(jb)) { + pthread_cleanup_push(cleanup_fromsig, jb); + notify(val); + pthread_cleanup_pop(1); + } + if (self->timer_id < 0) break; + } + __syscall(SYS_timer_delete, self->timer_id & INT_MAX); return 0; } -int timer_create(clockid_t clk, struct sigevent *evp, timer_t *res) +int timer_create(clockid_t clk, struct sigevent *restrict evp, timer_t *restrict res) { - static pthread_once_t once = PTHREAD_ONCE_INIT; + volatile static int init = 0; pthread_t td; pthread_attr_t attr; int r; @@ -85,19 +73,27 @@ int timer_create(clockid_t clk, struct sigevent *evp, timer_t *res) switch (evp ? evp->sigev_notify : SIGEV_SIGNAL) { case SIGEV_NONE: case SIGEV_SIGNAL: + case SIGEV_THREAD_ID: if (evp) { ksev.sigev_value = evp->sigev_value; ksev.sigev_signo = evp->sigev_signo; ksev.sigev_notify = evp->sigev_notify; - ksev.sigev_tid = 0; + if (evp->sigev_notify == SIGEV_THREAD_ID) + ksev.sigev_tid = evp->sigev_notify_thread_id; + else + ksev.sigev_tid = 0; ksevp = &ksev; } if (syscall(SYS_timer_create, clk, ksevp, &timerid) < 0) return -1; - *res = (void *)timerid; + *res = (void *)(intptr_t)timerid; break; case SIGEV_THREAD: - pthread_once(&once, install_handler); + if (!init) { + struct sigaction sa = { .sa_handler = SIG_DFL }; + __libc_sigaction(SIGTIMER, &sa, 0); + a_store(&init, 1); + } if (evp->sigev_notify_attributes) attr = *evp->sigev_notify_attributes; else @@ -105,26 +101,28 @@ int timer_create(clockid_t clk, struct sigevent *evp, timer_t *res) pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED); pthread_barrier_init(&args.b, 0, 2); args.sev = evp; - sigfillset(&set); - pthread_sigmask(SIG_BLOCK, &set, &set); + + __block_app_sigs(&set); + __syscall(SYS_rt_sigprocmask, SIG_BLOCK, SIGTIMER_SET, 0, _NSIG/8); r = pthread_create(&td, &attr, start, &args); - pthread_sigmask(SIG_SETMASK, &set, 0); + __restore_sigs(&set); if (r) { errno = r; return -1; } + ksev.sigev_value.sival_ptr = 0; ksev.sigev_signo = SIGTIMER; - ksev.sigev_notify = 4; /* SIGEV_THREAD_ID */ + ksev.sigev_notify = SIGEV_THREAD_ID; ksev.sigev_tid = td->tid; - r = syscall(SYS_timer_create, clk, &ksev, &timerid); - pthread_barrier_wait(&args.b); - if (r < 0) { - pthread_cancel(td); - return -1; + if (syscall(SYS_timer_create, clk, &ksev, &timerid) < 0) { + timerid = -1; + td->cancel = 1; } - td->result = (void *)timerid; - *res = td; + td->timer_id = timerid; + pthread_barrier_wait(&args.b); + if (timerid < 0) return -1; + *res = (void *)(INTPTR_MIN | (uintptr_t)td>>1); break; default: errno = EINVAL;