Index: fusl/src/thread/pthread_cancel.c |
diff --git a/fusl/src/thread/pthread_cancel.c b/fusl/src/thread/pthread_cancel.c |
new file mode 100644 |
index 0000000000000000000000000000000000000000..a21c386697c3e399c6c86e18d6be56c77a05d284 |
--- /dev/null |
+++ b/fusl/src/thread/pthread_cancel.c |
@@ -0,0 +1,96 @@ |
+#define _GNU_SOURCE |
+#include <string.h> |
+#include "pthread_impl.h" |
+#include "syscall.h" |
+#include "libc.h" |
+ |
+__attribute__((__visibility__("hidden"))) |
+long __cancel(), __syscall_cp_asm(), __syscall_cp_c(); |
+ |
+long __cancel() |
+{ |
+ pthread_t self = __pthread_self(); |
+ if (self->canceldisable == PTHREAD_CANCEL_ENABLE || self->cancelasync) |
+ pthread_exit(PTHREAD_CANCELED); |
+ self->canceldisable = PTHREAD_CANCEL_DISABLE; |
+ return -ECANCELED; |
+} |
+ |
+long __syscall_cp_asm(volatile void *, syscall_arg_t, |
+ syscall_arg_t, syscall_arg_t, syscall_arg_t, |
+ syscall_arg_t, syscall_arg_t, syscall_arg_t); |
+ |
+long __syscall_cp_c(syscall_arg_t nr, |
+ syscall_arg_t u, syscall_arg_t v, syscall_arg_t w, |
+ syscall_arg_t x, syscall_arg_t y, syscall_arg_t z) |
+{ |
+ pthread_t self; |
+ long r; |
+ int st; |
+ |
+ if ((st=(self=__pthread_self())->canceldisable) |
+ && (st==PTHREAD_CANCEL_DISABLE || nr==SYS_close)) |
+ return __syscall(nr, u, v, w, x, y, z); |
+ |
+ r = __syscall_cp_asm(&self->cancel, nr, u, v, w, x, y, z); |
+ if (r==-EINTR && nr!=SYS_close && self->cancel && |
+ self->canceldisable != PTHREAD_CANCEL_DISABLE) |
+ r = __cancel(); |
+ return r; |
+} |
+ |
+static void _sigaddset(sigset_t *set, int sig) |
+{ |
+ unsigned s = sig-1; |
+ set->__bits[s/8/sizeof *set->__bits] |= 1UL<<(s&8*sizeof *set->__bits-1); |
+} |
+ |
+__attribute__((__visibility__("hidden"))) |
+extern const char __cp_begin[1], __cp_end[1], __cp_cancel[1]; |
+ |
+static void cancel_handler(int sig, siginfo_t *si, void *ctx) |
+{ |
+ pthread_t self = __pthread_self(); |
+ ucontext_t *uc = ctx; |
+ uintptr_t pc = uc->uc_mcontext.MC_PC; |
+ |
+ a_barrier(); |
+ if (!self->cancel || self->canceldisable == PTHREAD_CANCEL_DISABLE) return; |
+ |
+ _sigaddset(&uc->uc_sigmask, SIGCANCEL); |
+ |
+ if (self->cancelasync || pc >= (uintptr_t)__cp_begin && pc < (uintptr_t)__cp_end) { |
+ uc->uc_mcontext.MC_PC = (uintptr_t)__cp_cancel; |
+ return; |
+ } |
+ |
+ __syscall(SYS_tkill, self->tid, SIGCANCEL); |
+} |
+ |
+void __testcancel() |
+{ |
+ pthread_t self = __pthread_self(); |
+ if (self->cancel && !self->canceldisable) |
+ __cancel(); |
+} |
+ |
+static void init_cancellation() |
+{ |
+ struct sigaction sa = { |
+ .sa_flags = SA_SIGINFO | SA_RESTART, |
+ .sa_sigaction = cancel_handler |
+ }; |
+ memset(&sa.sa_mask, -1, _NSIG/8); |
+ __libc_sigaction(SIGCANCEL, &sa, 0); |
+} |
+ |
+int pthread_cancel(pthread_t t) |
+{ |
+ static int init; |
+ if (!init) { |
+ init_cancellation(); |
+ init = 1; |
+ } |
+ a_store(&t->cancel, 1); |
+ return pthread_kill(t, SIGCANCEL); |
+} |