| /* | 
 |  * Copyright (C) 2004 PathScale, Inc | 
 |  * Copyright (C) 2004 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com) | 
 |  * Licensed under the GPL | 
 |  */ | 
 |  | 
 | #include <stdlib.h> | 
 | #include <stdarg.h> | 
 | #include <errno.h> | 
 | #include <signal.h> | 
 | #include <strings.h> | 
 | #include "as-layout.h" | 
 | #include "kern_util.h" | 
 | #include "os.h" | 
 | #include "process.h" | 
 | #include "sysdep/barrier.h" | 
 | #include "sysdep/sigcontext.h" | 
 | #include "user.h" | 
 |  | 
 | /* Copied from linux/compiler-gcc.h since we can't include it directly */ | 
 | #define barrier() __asm__ __volatile__("": : :"memory") | 
 |  | 
 | void (*sig_info[NSIG])(int, struct uml_pt_regs *) = { | 
 | 	[SIGTRAP]	= relay_signal, | 
 | 	[SIGFPE]	= relay_signal, | 
 | 	[SIGILL]	= relay_signal, | 
 | 	[SIGWINCH]	= winch, | 
 | 	[SIGBUS]	= bus_handler, | 
 | 	[SIGSEGV]	= segv_handler, | 
 | 	[SIGIO]		= sigio_handler, | 
 | 	[SIGVTALRM]	= timer_handler }; | 
 |  | 
 | static void sig_handler_common(int sig, struct sigcontext *sc) | 
 | { | 
 | 	struct uml_pt_regs r; | 
 | 	int save_errno = errno; | 
 |  | 
 | 	r.is_user = 0; | 
 | 	if (sig == SIGSEGV) { | 
 | 		/* For segfaults, we want the data from the sigcontext. */ | 
 | 		copy_sc(&r, sc); | 
 | 		GET_FAULTINFO_FROM_SC(r.faultinfo, sc); | 
 | 	} | 
 |  | 
 | 	/* enable signals if sig isn't IRQ signal */ | 
 | 	if ((sig != SIGIO) && (sig != SIGWINCH) && (sig != SIGVTALRM)) | 
 | 		unblock_signals(); | 
 |  | 
 | 	(*sig_info[sig])(sig, &r); | 
 |  | 
 | 	errno = save_errno; | 
 | } | 
 |  | 
 | /* | 
 |  * These are the asynchronous signals.  SIGPROF is excluded because we want to | 
 |  * be able to profile all of UML, not just the non-critical sections.  If | 
 |  * profiling is not thread-safe, then that is not my problem.  We can disable | 
 |  * profiling when SMP is enabled in that case. | 
 |  */ | 
 | #define SIGIO_BIT 0 | 
 | #define SIGIO_MASK (1 << SIGIO_BIT) | 
 |  | 
 | #define SIGVTALRM_BIT 1 | 
 | #define SIGVTALRM_MASK (1 << SIGVTALRM_BIT) | 
 |  | 
 | static int signals_enabled; | 
 | static unsigned int signals_pending; | 
 |  | 
 | void sig_handler(int sig, struct sigcontext *sc) | 
 | { | 
 | 	int enabled; | 
 |  | 
 | 	enabled = signals_enabled; | 
 | 	if (!enabled && (sig == SIGIO)) { | 
 | 		signals_pending |= SIGIO_MASK; | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	block_signals(); | 
 |  | 
 | 	sig_handler_common(sig, sc); | 
 |  | 
 | 	set_signals(enabled); | 
 | } | 
 |  | 
 | static void real_alarm_handler(struct sigcontext *sc) | 
 | { | 
 | 	struct uml_pt_regs regs; | 
 |  | 
 | 	if (sc != NULL) | 
 | 		copy_sc(®s, sc); | 
 | 	regs.is_user = 0; | 
 | 	unblock_signals(); | 
 | 	timer_handler(SIGVTALRM, ®s); | 
 | } | 
 |  | 
 | void alarm_handler(int sig, struct sigcontext *sc) | 
 | { | 
 | 	int enabled; | 
 |  | 
 | 	enabled = signals_enabled; | 
 | 	if (!signals_enabled) { | 
 | 		signals_pending |= SIGVTALRM_MASK; | 
 | 		return; | 
 | 	} | 
 |  | 
 | 	block_signals(); | 
 |  | 
 | 	real_alarm_handler(sc); | 
 | 	set_signals(enabled); | 
 | } | 
 |  | 
 | void timer_init(void) | 
 | { | 
 | 	set_handler(SIGVTALRM, (__sighandler_t) alarm_handler, | 
 | 		    SA_ONSTACK | SA_RESTART, SIGUSR1, SIGIO, SIGWINCH, -1); | 
 | } | 
 |  | 
 | void set_sigstack(void *sig_stack, int size) | 
 | { | 
 | 	stack_t stack = ((stack_t) { .ss_flags	= 0, | 
 | 				     .ss_sp	= (__ptr_t) sig_stack, | 
 | 				     .ss_size 	= size - sizeof(void *) }); | 
 |  | 
 | 	if (sigaltstack(&stack, NULL) != 0) | 
 | 		panic("enabling signal stack failed, errno = %d\n", errno); | 
 | } | 
 |  | 
 | static void (*handlers[_NSIG])(int sig, struct sigcontext *sc); | 
 |  | 
 | void handle_signal(int sig, struct sigcontext *sc) | 
 | { | 
 | 	unsigned long pending = 1UL << sig; | 
 |  | 
 | 	do { | 
 | 		int nested, bail; | 
 |  | 
 | 		/* | 
 | 		 * pending comes back with one bit set for each | 
 | 		 * interrupt that arrived while setting up the stack, | 
 | 		 * plus a bit for this interrupt, plus the zero bit is | 
 | 		 * set if this is a nested interrupt. | 
 | 		 * If bail is true, then we interrupted another | 
 | 		 * handler setting up the stack.  In this case, we | 
 | 		 * have to return, and the upper handler will deal | 
 | 		 * with this interrupt. | 
 | 		 */ | 
 | 		bail = to_irq_stack(&pending); | 
 | 		if (bail) | 
 | 			return; | 
 |  | 
 | 		nested = pending & 1; | 
 | 		pending &= ~1; | 
 |  | 
 | 		while ((sig = ffs(pending)) != 0){ | 
 | 			sig--; | 
 | 			pending &= ~(1 << sig); | 
 | 			(*handlers[sig])(sig, sc); | 
 | 		} | 
 |  | 
 | 		/* | 
 | 		 * Again, pending comes back with a mask of signals | 
 | 		 * that arrived while tearing down the stack.  If this | 
 | 		 * is non-zero, we just go back, set up the stack | 
 | 		 * again, and handle the new interrupts. | 
 | 		 */ | 
 | 		if (!nested) | 
 | 			pending = from_irq_stack(nested); | 
 | 	} while (pending); | 
 | } | 
 |  | 
 | extern void hard_handler(int sig); | 
 |  | 
 | void set_handler(int sig, void (*handler)(int), int flags, ...) | 
 | { | 
 | 	struct sigaction action; | 
 | 	va_list ap; | 
 | 	sigset_t sig_mask; | 
 | 	int mask; | 
 |  | 
 | 	handlers[sig] = (void (*)(int, struct sigcontext *)) handler; | 
 | 	action.sa_handler = hard_handler; | 
 |  | 
 | 	sigemptyset(&action.sa_mask); | 
 |  | 
 | 	va_start(ap, flags); | 
 | 	while ((mask = va_arg(ap, int)) != -1) | 
 | 		sigaddset(&action.sa_mask, mask); | 
 | 	va_end(ap); | 
 |  | 
 | 	if (sig == SIGSEGV) | 
 | 		flags |= SA_NODEFER; | 
 |  | 
 | 	action.sa_flags = flags; | 
 | 	action.sa_restorer = NULL; | 
 | 	if (sigaction(sig, &action, NULL) < 0) | 
 | 		panic("sigaction failed - errno = %d\n", errno); | 
 |  | 
 | 	sigemptyset(&sig_mask); | 
 | 	sigaddset(&sig_mask, sig); | 
 | 	if (sigprocmask(SIG_UNBLOCK, &sig_mask, NULL) < 0) | 
 | 		panic("sigprocmask failed - errno = %d\n", errno); | 
 | } | 
 |  | 
 | int change_sig(int signal, int on) | 
 | { | 
 | 	sigset_t sigset; | 
 |  | 
 | 	sigemptyset(&sigset); | 
 | 	sigaddset(&sigset, signal); | 
 | 	if (sigprocmask(on ? SIG_UNBLOCK : SIG_BLOCK, &sigset, NULL) < 0) | 
 | 		return -errno; | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | void block_signals(void) | 
 | { | 
 | 	signals_enabled = 0; | 
 | 	/* | 
 | 	 * This must return with signals disabled, so this barrier | 
 | 	 * ensures that writes are flushed out before the return. | 
 | 	 * This might matter if gcc figures out how to inline this and | 
 | 	 * decides to shuffle this code into the caller. | 
 | 	 */ | 
 | 	barrier(); | 
 | } | 
 |  | 
 | void unblock_signals(void) | 
 | { | 
 | 	int save_pending; | 
 |  | 
 | 	if (signals_enabled == 1) | 
 | 		return; | 
 |  | 
 | 	/* | 
 | 	 * We loop because the IRQ handler returns with interrupts off.  So, | 
 | 	 * interrupts may have arrived and we need to re-enable them and | 
 | 	 * recheck signals_pending. | 
 | 	 */ | 
 | 	while (1) { | 
 | 		/* | 
 | 		 * Save and reset save_pending after enabling signals.  This | 
 | 		 * way, signals_pending won't be changed while we're reading it. | 
 | 		 */ | 
 | 		signals_enabled = 1; | 
 |  | 
 | 		/* | 
 | 		 * Setting signals_enabled and reading signals_pending must | 
 | 		 * happen in this order. | 
 | 		 */ | 
 | 		barrier(); | 
 |  | 
 | 		save_pending = signals_pending; | 
 | 		if (save_pending == 0) | 
 | 			return; | 
 |  | 
 | 		signals_pending = 0; | 
 |  | 
 | 		/* | 
 | 		 * We have pending interrupts, so disable signals, as the | 
 | 		 * handlers expect them off when they are called.  They will | 
 | 		 * be enabled again above. | 
 | 		 */ | 
 |  | 
 | 		signals_enabled = 0; | 
 |  | 
 | 		/* | 
 | 		 * Deal with SIGIO first because the alarm handler might | 
 | 		 * schedule, leaving the pending SIGIO stranded until we come | 
 | 		 * back here. | 
 | 		 */ | 
 | 		if (save_pending & SIGIO_MASK) | 
 | 			sig_handler_common(SIGIO, NULL); | 
 |  | 
 | 		if (save_pending & SIGVTALRM_MASK) | 
 | 			real_alarm_handler(NULL); | 
 | 	} | 
 | } | 
 |  | 
 | int get_signals(void) | 
 | { | 
 | 	return signals_enabled; | 
 | } | 
 |  | 
 | int set_signals(int enable) | 
 | { | 
 | 	int ret; | 
 | 	if (signals_enabled == enable) | 
 | 		return enable; | 
 |  | 
 | 	ret = signals_enabled; | 
 | 	if (enable) | 
 | 		unblock_signals(); | 
 | 	else block_signals(); | 
 |  | 
 | 	return ret; | 
 | } |