nsz Git - musl/blob - src/thread/cancel_impl.c

   1 #include "pthread_impl.h"
   2
   3 void __cancel()
   4 {
   5         pthread_t self = __pthread_self();
   6         self->cp_sp = 0;
   7         self->canceldisable = 1;
   8         self->cancelasync = 0;
   9         pthread_exit(PTHREAD_CANCELED);
  10 }
  11
  12 long __syscall_cp_asm(volatile void *, long, long, long, long, long, long, long);
  13
  14 long (__syscall_cp)(long nr, long u, long v, long w, long x, long y, long z)
  15 {
  16         pthread_t self;
  17         uintptr_t old_sp, old_ip;
  18         long r;
  19
  20         if (!libc.threaded || (self = __pthread_self())->canceldisable)
  21                 return __syscall(nr, u, v, w, x, y, z);
  22
  23         old_sp = self->cp_sp;
  24         old_ip = self->cp_ip;
  25         self->cp_sp = 0;
  26         self->cp_ip = 0;
  27         r = __syscall_cp_asm(&self->cp_sp, nr, u, v, w, x, y, z);
  28         self->cp_ip = old_ip;
  29         self->cp_sp = old_sp;
  30         if (r==-EINTR && nr!=SYS_close && self->cancel && !self->canceldisable)
  31                 __cancel();
  32         return r;
  33 }
  34
  35 static void _sigaddset(sigset_t *set, int sig)
  36 {
  37         unsigned s = sig-1;
  38         set->__bits[s/8/sizeof *set->__bits] |= 1UL<<(s&8*sizeof *set->__bits-1);
  39 }
  40
  41 static void cancel_handler(int sig, siginfo_t *si, void *ctx)
  42 {
  43         pthread_t self = __pthread_self();
  44         ucontext_t *uc = ctx;
  45         uintptr_t sp = ((uintptr_t *)&uc->uc_mcontext)[CANCEL_REG_SP];
  46         uintptr_t ip = ((uintptr_t *)&uc->uc_mcontext)[CANCEL_REG_IP];
  47
  48         if (!self->cancel || self->canceldisable) return;
  49
  50         _sigaddset(&uc->uc_sigmask, SIGCANCEL);
  51
  52         if (self->cancelasync || sp == self->cp_sp && ip <= self->cp_ip) {
  53                 self->canceldisable = 1;
  54                 pthread_sigmask(SIG_SETMASK, &uc->uc_sigmask, 0);
  55                 __cancel();
  56         }
  57
  58         if (self->cp_sp)
  59                 __syscall(SYS_tgkill, self->pid, self->tid, SIGCANCEL);
  60 }
  61
  62 void __testcancel()
  63 {
  64         pthread_t self = __pthread_self();
  65         if (self->cancel && !self->canceldisable)
  66                 __cancel();
  67 }
  68
  69 static void init_cancellation()
  70 {
  71         struct sigaction sa = {
  72                 .sa_flags = SA_SIGINFO | SA_RESTART,
  73                 .sa_sigaction = cancel_handler
  74         };
  75         sigfillset(&sa.sa_mask);
  76         __libc_sigaction(SIGCANCEL, &sa, 0);
  77 }
  78
  79 int pthread_cancel(pthread_t t)
  80 {
  81         static int init;
  82         if (!init) {
  83                 init_cancellation();
  84                 init = 1;
  85         }
  86         a_store(&t->cancel, 1);
  87         return pthread_kill(t, SIGCANCEL);
  88 }