| /* | 
 |  *  linux/arch/parisc/kernel/signal.c: Architecture-specific signal | 
 |  *  handling support. | 
 |  * | 
 |  *  Copyright (C) 2000 David Huggins-Daines <dhd@debian.org> | 
 |  *  Copyright (C) 2000 Linuxcare, Inc. | 
 |  * | 
 |  *  Based on the ia64, i386, and alpha versions. | 
 |  * | 
 |  *  Like the IA-64, we are a recent enough port (we are *starting* | 
 |  *  with glibc2.2) that we do not need to support the old non-realtime | 
 |  *  Linux signals.  Therefore we don't.  HP/UX signals will go in | 
 |  *  arch/parisc/hpux/signal.c when we figure out how to do them. | 
 |  */ | 
 |  | 
 | #include <linux/sched.h> | 
 | #include <linux/mm.h> | 
 | #include <linux/smp.h> | 
 | #include <linux/kernel.h> | 
 | #include <linux/signal.h> | 
 | #include <linux/errno.h> | 
 | #include <linux/wait.h> | 
 | #include <linux/ptrace.h> | 
 | #include <linux/unistd.h> | 
 | #include <linux/stddef.h> | 
 | #include <linux/compat.h> | 
 | #include <linux/elf.h> | 
 | #include <asm/ucontext.h> | 
 | #include <asm/rt_sigframe.h> | 
 | #include <asm/uaccess.h> | 
 | #include <asm/pgalloc.h> | 
 | #include <asm/cacheflush.h> | 
 | #include <asm/asm-offsets.h> | 
 |  | 
 | #ifdef CONFIG_COMPAT | 
 | #include <linux/compat.h> | 
 | #include "signal32.h" | 
 | #endif | 
 |  | 
 | #define DEBUG_SIG 0  | 
 | #define DEBUG_SIG_LEVEL 2 | 
 |  | 
 | #if DEBUG_SIG | 
 | #define DBG(LEVEL, ...) \ | 
 |         ((DEBUG_SIG_LEVEL >= LEVEL) \ | 
 | 	? printk(__VA_ARGS__) : (void) 0) | 
 | #else | 
 | #define DBG(LEVEL, ...) | 
 | #endif | 
 | 	 | 
 |  | 
 | #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP))) | 
 |  | 
 | /* gcc will complain if a pointer is cast to an integer of different | 
 |  * size.  If you really need to do this (and we do for an ELF32 user | 
 |  * application in an ELF64 kernel) then you have to do a cast to an | 
 |  * integer of the same size first.  The A() macro accomplishes | 
 |  * this. */ | 
 | #define A(__x)	((unsigned long)(__x)) | 
 |  | 
 | /* | 
 |  * Atomically swap in the new signal mask, and wait for a signal. | 
 |  */ | 
 | #ifdef CONFIG_64BIT | 
 | #include "sys32.h" | 
 | #endif | 
 |  | 
 | /* | 
 |  * Do a signal return - restore sigcontext. | 
 |  */ | 
 |  | 
 | /* Trampoline for calling rt_sigreturn() */ | 
 | #define INSN_LDI_R25_0	 0x34190000 /* ldi  0,%r25 (in_syscall=0) */ | 
 | #define INSN_LDI_R25_1	 0x34190002 /* ldi  1,%r25 (in_syscall=1) */ | 
 | #define INSN_LDI_R20	 0x3414015a /* ldi  __NR_rt_sigreturn,%r20 */ | 
 | #define INSN_BLE_SR2_R0  0xe4008200 /* be,l 0x100(%sr2,%r0),%sr0,%r31 */ | 
 | #define INSN_NOP	 0x08000240 /* nop */ | 
 | /* For debugging */ | 
 | #define INSN_DIE_HORRIBLY 0x68000ccc /* stw %r0,0x666(%sr0,%r0) */ | 
 |  | 
 | static long | 
 | restore_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs) | 
 | { | 
 | 	long err = 0; | 
 |  | 
 | 	err |= __copy_from_user(regs->gr, sc->sc_gr, sizeof(regs->gr)); | 
 | 	err |= __copy_from_user(regs->fr, sc->sc_fr, sizeof(regs->fr)); | 
 | 	err |= __copy_from_user(regs->iaoq, sc->sc_iaoq, sizeof(regs->iaoq)); | 
 | 	err |= __copy_from_user(regs->iasq, sc->sc_iasq, sizeof(regs->iasq)); | 
 | 	err |= __get_user(regs->sar, &sc->sc_sar); | 
 | 	DBG(2,"restore_sigcontext: iaoq is 0x%#lx / 0x%#lx\n",  | 
 | 			regs->iaoq[0],regs->iaoq[1]); | 
 | 	DBG(2,"restore_sigcontext: r28 is %ld\n", regs->gr[28]); | 
 | 	return err; | 
 | } | 
 |  | 
 | void | 
 | sys_rt_sigreturn(struct pt_regs *regs, int in_syscall) | 
 | { | 
 | 	struct rt_sigframe __user *frame; | 
 | 	struct siginfo si; | 
 | 	sigset_t set; | 
 | 	unsigned long usp = (regs->gr[30] & ~(0x01UL)); | 
 | 	unsigned long sigframe_size = PARISC_RT_SIGFRAME_SIZE; | 
 | #ifdef CONFIG_64BIT | 
 | 	compat_sigset_t compat_set; | 
 | 	struct compat_rt_sigframe __user * compat_frame; | 
 | 	 | 
 | 	if (is_compat_task()) | 
 | 		sigframe_size = PARISC_RT_SIGFRAME_SIZE32; | 
 | #endif | 
 |  | 
 |  | 
 | 	/* Unwind the user stack to get the rt_sigframe structure. */ | 
 | 	frame = (struct rt_sigframe __user *) | 
 | 		(usp - sigframe_size); | 
 | 	DBG(2,"sys_rt_sigreturn: frame is %p\n", frame); | 
 |  | 
 | #ifdef CONFIG_64BIT | 
 | 	compat_frame = (struct compat_rt_sigframe __user *)frame; | 
 | 	 | 
 | 	if (is_compat_task()) { | 
 | 		DBG(2,"sys_rt_sigreturn: ELF32 process.\n"); | 
 | 		if (__copy_from_user(&compat_set, &compat_frame->uc.uc_sigmask, sizeof(compat_set))) | 
 | 			goto give_sigsegv; | 
 | 		sigset_32to64(&set,&compat_set); | 
 | 	} else | 
 | #endif | 
 | 	{ | 
 | 		if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set))) | 
 | 			goto give_sigsegv; | 
 | 	} | 
 | 		 | 
 | 	sigdelsetmask(&set, ~_BLOCKABLE); | 
 | 	spin_lock_irq(¤t->sighand->siglock); | 
 | 	current->blocked = set; | 
 | 	recalc_sigpending(); | 
 | 	spin_unlock_irq(¤t->sighand->siglock); | 
 |  | 
 | 	/* Good thing we saved the old gr[30], eh? */ | 
 | #ifdef CONFIG_64BIT | 
 | 	if (is_compat_task()) { | 
 | 		DBG(1,"sys_rt_sigreturn: compat_frame->uc.uc_mcontext 0x%p\n", | 
 | 				&compat_frame->uc.uc_mcontext); | 
 | // FIXME: Load upper half from register file | 
 | 		if (restore_sigcontext32(&compat_frame->uc.uc_mcontext,  | 
 | 					&compat_frame->regs, regs)) | 
 | 			goto give_sigsegv; | 
 | 		DBG(1,"sys_rt_sigreturn: usp %#08lx stack 0x%p\n",  | 
 | 				usp, &compat_frame->uc.uc_stack); | 
 | 		if (do_sigaltstack32(&compat_frame->uc.uc_stack, NULL, usp) == -EFAULT) | 
 | 			goto give_sigsegv; | 
 | 	} else | 
 | #endif | 
 | 	{ | 
 | 		DBG(1,"sys_rt_sigreturn: frame->uc.uc_mcontext 0x%p\n", | 
 | 				&frame->uc.uc_mcontext); | 
 | 		if (restore_sigcontext(&frame->uc.uc_mcontext, regs)) | 
 | 			goto give_sigsegv; | 
 | 		DBG(1,"sys_rt_sigreturn: usp %#08lx stack 0x%p\n",  | 
 | 				usp, &frame->uc.uc_stack); | 
 | 		if (do_sigaltstack(&frame->uc.uc_stack, NULL, usp) == -EFAULT) | 
 | 			goto give_sigsegv; | 
 | 	} | 
 | 		 | 
 |  | 
 |  | 
 | 	/* If we are on the syscall path IAOQ will not be restored, and | 
 | 	 * if we are on the interrupt path we must not corrupt gr31. | 
 | 	 */ | 
 | 	if (in_syscall) | 
 | 		regs->gr[31] = regs->iaoq[0]; | 
 | #if DEBUG_SIG | 
 | 	DBG(1,"sys_rt_sigreturn: returning to %#lx, DUMPING REGS:\n", regs->iaoq[0]); | 
 | 	show_regs(regs); | 
 | #endif | 
 | 	return; | 
 |  | 
 | give_sigsegv: | 
 | 	DBG(1,"sys_rt_sigreturn: Sending SIGSEGV\n"); | 
 | 	si.si_signo = SIGSEGV; | 
 | 	si.si_errno = 0; | 
 | 	si.si_code = SI_KERNEL; | 
 | 	si.si_pid = current->pid; | 
 | 	si.si_uid = current->uid; | 
 | 	si.si_addr = &frame->uc; | 
 | 	force_sig_info(SIGSEGV, &si, current); | 
 | 	return; | 
 | } | 
 |  | 
 | /* | 
 |  * Set up a signal frame. | 
 |  */ | 
 |  | 
 | static inline void __user * | 
 | get_sigframe(struct k_sigaction *ka, unsigned long sp, size_t frame_size) | 
 | { | 
 | 	/*FIXME: ELF32 vs. ELF64 has different frame_size, but since we | 
 | 	  don't use the parameter it doesn't matter */ | 
 |  | 
 | 	DBG(1,"get_sigframe: ka = %#lx, sp = %#lx, frame_size = %#lx\n", | 
 | 			(unsigned long)ka, sp, frame_size); | 
 | 	 | 
 | 	if ((ka->sa.sa_flags & SA_ONSTACK) != 0 && ! sas_ss_flags(sp)) | 
 | 		sp = current->sas_ss_sp; /* Stacks grow up! */ | 
 |  | 
 | 	DBG(1,"get_sigframe: Returning sp = %#lx\n", (unsigned long)sp); | 
 | 	return (void __user *) sp; /* Stacks grow up.  Fun. */ | 
 | } | 
 |  | 
 | static long | 
 | setup_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs, int in_syscall) | 
 | 		  | 
 | { | 
 | 	unsigned long flags = 0; | 
 | 	long err = 0; | 
 |  | 
 | 	if (on_sig_stack((unsigned long) sc)) | 
 | 		flags |= PARISC_SC_FLAG_ONSTACK; | 
 | 	if (in_syscall) { | 
 | 		flags |= PARISC_SC_FLAG_IN_SYSCALL; | 
 | 		/* regs->iaoq is undefined in the syscall return path */ | 
 | 		err |= __put_user(regs->gr[31], &sc->sc_iaoq[0]); | 
 | 		err |= __put_user(regs->gr[31]+4, &sc->sc_iaoq[1]); | 
 | 		err |= __put_user(regs->sr[3], &sc->sc_iasq[0]); | 
 | 		err |= __put_user(regs->sr[3], &sc->sc_iasq[1]); | 
 | 		DBG(1,"setup_sigcontext: iaoq %#lx / %#lx (in syscall)\n", | 
 | 			regs->gr[31], regs->gr[31]+4); | 
 | 	} else { | 
 | 		err |= __copy_to_user(sc->sc_iaoq, regs->iaoq, sizeof(regs->iaoq)); | 
 | 		err |= __copy_to_user(sc->sc_iasq, regs->iasq, sizeof(regs->iasq)); | 
 | 		DBG(1,"setup_sigcontext: iaoq %#lx / %#lx (not in syscall)\n",  | 
 | 			regs->iaoq[0], regs->iaoq[1]); | 
 | 	} | 
 |  | 
 | 	err |= __put_user(flags, &sc->sc_flags); | 
 | 	err |= __copy_to_user(sc->sc_gr, regs->gr, sizeof(regs->gr)); | 
 | 	err |= __copy_to_user(sc->sc_fr, regs->fr, sizeof(regs->fr)); | 
 | 	err |= __put_user(regs->sar, &sc->sc_sar); | 
 | 	DBG(1,"setup_sigcontext: r28 is %ld\n", regs->gr[28]); | 
 |  | 
 | 	return err; | 
 | } | 
 |  | 
 | static long | 
 | setup_rt_frame(int sig, struct k_sigaction *ka, siginfo_t *info, | 
 | 	       sigset_t *set, struct pt_regs *regs, int in_syscall) | 
 | { | 
 | 	struct rt_sigframe __user *frame; | 
 | 	unsigned long rp, usp; | 
 | 	unsigned long haddr, sigframe_size; | 
 | 	int err = 0; | 
 | #ifdef CONFIG_64BIT | 
 | 	compat_int_t compat_val; | 
 | 	struct compat_rt_sigframe __user * compat_frame; | 
 | 	compat_sigset_t compat_set; | 
 | #endif | 
 | 	 | 
 | 	usp = (regs->gr[30] & ~(0x01UL)); | 
 | 	/*FIXME: frame_size parameter is unused, remove it. */ | 
 | 	frame = get_sigframe(ka, usp, sizeof(*frame)); | 
 |  | 
 | 	DBG(1,"SETUP_RT_FRAME: START\n"); | 
 | 	DBG(1,"setup_rt_frame: frame %p info %p\n", frame, info); | 
 |  | 
 | 	 | 
 | #ifdef CONFIG_64BIT | 
 |  | 
 | 	compat_frame = (struct compat_rt_sigframe __user *)frame; | 
 | 	 | 
 | 	if (is_compat_task()) { | 
 | 		DBG(1,"setup_rt_frame: frame->info = 0x%p\n", &compat_frame->info); | 
 | 		err |= copy_siginfo_to_user32(&compat_frame->info, info); | 
 | 		DBG(1,"SETUP_RT_FRAME: 1\n"); | 
 | 		compat_val = (compat_int_t)current->sas_ss_sp; | 
 | 		err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_sp); | 
 | 		DBG(1,"SETUP_RT_FRAME: 2\n"); | 
 | 		compat_val = (compat_int_t)current->sas_ss_size; | 
 | 		err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_size); | 
 | 		DBG(1,"SETUP_RT_FRAME: 3\n"); | 
 | 		compat_val = sas_ss_flags(regs->gr[30]);		 | 
 | 		err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_flags);		 | 
 | 		DBG(1,"setup_rt_frame: frame->uc = 0x%p\n", &compat_frame->uc); | 
 | 		DBG(1,"setup_rt_frame: frame->uc.uc_mcontext = 0x%p\n", &compat_frame->uc.uc_mcontext); | 
 | 		err |= setup_sigcontext32(&compat_frame->uc.uc_mcontext,  | 
 | 					&compat_frame->regs, regs, in_syscall); | 
 | 		sigset_64to32(&compat_set,set); | 
 | 		err |= __copy_to_user(&compat_frame->uc.uc_sigmask, &compat_set, sizeof(compat_set)); | 
 | 	} else | 
 | #endif | 
 | 	{	 | 
 | 		DBG(1,"setup_rt_frame: frame->info = 0x%p\n", &frame->info); | 
 | 		err |= copy_siginfo_to_user(&frame->info, info); | 
 | 		err |= __put_user(current->sas_ss_sp, &frame->uc.uc_stack.ss_sp); | 
 | 		err |= __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size); | 
 | 		err |= __put_user(sas_ss_flags(regs->gr[30]), | 
 | 				  &frame->uc.uc_stack.ss_flags); | 
 | 		DBG(1,"setup_rt_frame: frame->uc = 0x%p\n", &frame->uc); | 
 | 		DBG(1,"setup_rt_frame: frame->uc.uc_mcontext = 0x%p\n", &frame->uc.uc_mcontext); | 
 | 		err |= setup_sigcontext(&frame->uc.uc_mcontext, regs, in_syscall); | 
 | 		/* FIXME: Should probably be converted aswell for the compat case */ | 
 | 		err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set)); | 
 | 	} | 
 | 	 | 
 | 	if (err) | 
 | 		goto give_sigsegv; | 
 |  | 
 | 	/* Set up to return from userspace.  If provided, use a stub | 
 | 	   already in userspace. The first words of tramp are used to | 
 | 	   save the previous sigrestartblock trampoline that might be | 
 | 	   on the stack. We start the sigreturn trampoline at  | 
 | 	   SIGRESTARTBLOCK_TRAMP+X. */ | 
 | 	err |= __put_user(in_syscall ? INSN_LDI_R25_1 : INSN_LDI_R25_0, | 
 | 			&frame->tramp[SIGRESTARTBLOCK_TRAMP+0]); | 
 | 	err |= __put_user(INSN_LDI_R20,  | 
 | 			&frame->tramp[SIGRESTARTBLOCK_TRAMP+1]); | 
 | 	err |= __put_user(INSN_BLE_SR2_R0,  | 
 | 			&frame->tramp[SIGRESTARTBLOCK_TRAMP+2]); | 
 | 	err |= __put_user(INSN_NOP, &frame->tramp[SIGRESTARTBLOCK_TRAMP+3]); | 
 |  | 
 | #if DEBUG_SIG | 
 | 	/* Assert that we're flushing in the correct space... */ | 
 | 	{ | 
 | 		int sid; | 
 | 		asm ("mfsp %%sr3,%0" : "=r" (sid)); | 
 | 		DBG(1,"setup_rt_frame: Flushing 64 bytes at space %#x offset %p\n", | 
 | 		       sid, frame->tramp); | 
 | 	} | 
 | #endif | 
 |  | 
 | 	flush_user_dcache_range((unsigned long) &frame->tramp[0], | 
 | 			   (unsigned long) &frame->tramp[TRAMP_SIZE]); | 
 | 	flush_user_icache_range((unsigned long) &frame->tramp[0], | 
 | 			   (unsigned long) &frame->tramp[TRAMP_SIZE]); | 
 |  | 
 | 	/* TRAMP Words 0-4, Lenght 5 = SIGRESTARTBLOCK_TRAMP | 
 | 	 * TRAMP Words 5-9, Length 4 = SIGRETURN_TRAMP | 
 | 	 * So the SIGRETURN_TRAMP is at the end of SIGRESTARTBLOCK_TRAMP | 
 | 	 */ | 
 | 	rp = (unsigned long) &frame->tramp[SIGRESTARTBLOCK_TRAMP]; | 
 |  | 
 | 	if (err) | 
 | 		goto give_sigsegv; | 
 |  | 
 | 	haddr = A(ka->sa.sa_handler); | 
 | 	/* The sa_handler may be a pointer to a function descriptor */ | 
 | #ifdef CONFIG_64BIT | 
 | 	if (is_compat_task()) { | 
 | #endif | 
 | 		if (haddr & PA_PLABEL_FDESC) { | 
 | 			Elf32_Fdesc fdesc; | 
 | 			Elf32_Fdesc __user *ufdesc = (Elf32_Fdesc __user *)A(haddr & ~3); | 
 |  | 
 | 			err = __copy_from_user(&fdesc, ufdesc, sizeof(fdesc)); | 
 |  | 
 | 			if (err) | 
 | 				goto give_sigsegv; | 
 |  | 
 | 			haddr = fdesc.addr; | 
 | 			regs->gr[19] = fdesc.gp; | 
 | 		} | 
 | #ifdef CONFIG_64BIT | 
 | 	} else { | 
 | 		Elf64_Fdesc fdesc; | 
 | 		Elf64_Fdesc __user *ufdesc = (Elf64_Fdesc __user *)A(haddr & ~3); | 
 | 		 | 
 | 		err = __copy_from_user(&fdesc, ufdesc, sizeof(fdesc)); | 
 | 		 | 
 | 		if (err) | 
 | 			goto give_sigsegv; | 
 | 		 | 
 | 		haddr = fdesc.addr; | 
 | 		regs->gr[19] = fdesc.gp; | 
 | 		DBG(1,"setup_rt_frame: 64 bit signal, exe=%#lx, r19=%#lx, in_syscall=%d\n", | 
 | 		     haddr, regs->gr[19], in_syscall); | 
 | 	} | 
 | #endif | 
 |  | 
 | 	/* The syscall return path will create IAOQ values from r31. | 
 | 	 */ | 
 | 	sigframe_size = PARISC_RT_SIGFRAME_SIZE; | 
 | #ifdef CONFIG_64BIT | 
 | 	if (is_compat_task()) | 
 | 		sigframe_size = PARISC_RT_SIGFRAME_SIZE32; | 
 | #endif | 
 | 	if (in_syscall) { | 
 | 		regs->gr[31] = haddr; | 
 | #ifdef CONFIG_64BIT | 
 | 		if (!test_thread_flag(TIF_32BIT)) | 
 | 			sigframe_size |= 1; | 
 | #endif | 
 | 	} else { | 
 | 		unsigned long psw = USER_PSW; | 
 | #ifdef CONFIG_64BIT | 
 | 		if (!test_thread_flag(TIF_32BIT)) | 
 | 			psw |= PSW_W; | 
 | #endif | 
 |  | 
 | 		/* If we are singlestepping, arrange a trap to be delivered | 
 | 		   when we return to userspace. Note the semantics -- we | 
 | 		   should trap before the first insn in the handler is | 
 | 		   executed. Ref: | 
 | 			http://sources.redhat.com/ml/gdb/2004-11/msg00245.html | 
 | 		 */ | 
 | 		if (pa_psw(current)->r) { | 
 | 			pa_psw(current)->r = 0; | 
 | 			psw |= PSW_R; | 
 | 			mtctl(-1, 0); | 
 | 		} | 
 |  | 
 | 		regs->gr[0] = psw; | 
 | 		regs->iaoq[0] = haddr | 3; | 
 | 		regs->iaoq[1] = regs->iaoq[0] + 4; | 
 | 	} | 
 |  | 
 | 	regs->gr[2]  = rp;                /* userland return pointer */ | 
 | 	regs->gr[26] = sig;               /* signal number */ | 
 | 	 | 
 | #ifdef CONFIG_64BIT | 
 | 	if (is_compat_task()) { | 
 | 		regs->gr[25] = A(&compat_frame->info); /* siginfo pointer */ | 
 | 		regs->gr[24] = A(&compat_frame->uc);   /* ucontext pointer */ | 
 | 	} else | 
 | #endif | 
 | 	{		 | 
 | 		regs->gr[25] = A(&frame->info); /* siginfo pointer */ | 
 | 		regs->gr[24] = A(&frame->uc);   /* ucontext pointer */ | 
 | 	} | 
 | 	 | 
 | 	DBG(1,"setup_rt_frame: making sigreturn frame: %#lx + %#lx = %#lx\n", | 
 | 	       regs->gr[30], sigframe_size, | 
 | 	       regs->gr[30] + sigframe_size); | 
 | 	/* Raise the user stack pointer to make a proper call frame. */ | 
 | 	regs->gr[30] = (A(frame) + sigframe_size); | 
 |  | 
 |  | 
 | 	DBG(1,"setup_rt_frame: sig deliver (%s,%d) frame=0x%p sp=%#lx iaoq=%#lx/%#lx rp=%#lx\n", | 
 | 	       current->comm, current->pid, frame, regs->gr[30], | 
 | 	       regs->iaoq[0], regs->iaoq[1], rp); | 
 |  | 
 | 	return 1; | 
 |  | 
 | give_sigsegv: | 
 | 	DBG(1,"setup_rt_frame: sending SIGSEGV\n"); | 
 | 	force_sigsegv(sig, current); | 
 | 	return 0; | 
 | } | 
 |  | 
 | /* | 
 |  * OK, we're invoking a handler. | 
 |  */	 | 
 |  | 
 | static long | 
 | handle_signal(unsigned long sig, siginfo_t *info, struct k_sigaction *ka, | 
 | 		sigset_t *oldset, struct pt_regs *regs, int in_syscall) | 
 | { | 
 | 	DBG(1,"handle_signal: sig=%ld, ka=%p, info=%p, oldset=%p, regs=%p\n", | 
 | 	       sig, ka, info, oldset, regs); | 
 | 	 | 
 | 	/* Set up the stack frame */ | 
 | 	if (!setup_rt_frame(sig, ka, info, oldset, regs, in_syscall)) | 
 | 		return 0; | 
 |  | 
 | 	spin_lock_irq(¤t->sighand->siglock); | 
 | 	sigorsets(¤t->blocked,¤t->blocked,&ka->sa.sa_mask); | 
 | 	if (!(ka->sa.sa_flags & SA_NODEFER)) | 
 | 		sigaddset(¤t->blocked,sig); | 
 | 	recalc_sigpending(); | 
 | 	spin_unlock_irq(¤t->sighand->siglock); | 
 | 	return 1; | 
 | } | 
 |  | 
 | static inline void | 
 | syscall_restart(struct pt_regs *regs, struct k_sigaction *ka) | 
 | { | 
 | 	/* Check the return code */ | 
 | 	switch (regs->gr[28]) { | 
 | 	case -ERESTART_RESTARTBLOCK: | 
 | 		current_thread_info()->restart_block.fn = | 
 | 			do_no_restart_syscall; | 
 | 	case -ERESTARTNOHAND: | 
 | 		DBG(1,"ERESTARTNOHAND: returning -EINTR\n"); | 
 | 		regs->gr[28] = -EINTR; | 
 | 		break; | 
 |  | 
 | 	case -ERESTARTSYS: | 
 | 		if (!(ka->sa.sa_flags & SA_RESTART)) { | 
 | 			DBG(1,"ERESTARTSYS: putting -EINTR\n"); | 
 | 			regs->gr[28] = -EINTR; | 
 | 			break; | 
 | 		} | 
 | 		/* fallthrough */ | 
 | 	case -ERESTARTNOINTR: | 
 | 		/* A syscall is just a branch, so all | 
 | 		 * we have to do is fiddle the return pointer. | 
 | 		 */ | 
 | 		regs->gr[31] -= 8; /* delayed branching */ | 
 | 		/* Preserve original r28. */ | 
 | 		regs->gr[28] = regs->orig_r28; | 
 | 		break; | 
 | 	} | 
 | } | 
 |  | 
 | static inline void | 
 | insert_restart_trampoline(struct pt_regs *regs) | 
 | { | 
 | 	switch(regs->gr[28]) { | 
 | 	case -ERESTART_RESTARTBLOCK: { | 
 | 		/* Restart the system call - no handlers present */ | 
 | 		unsigned int *usp = (unsigned int *)regs->gr[30]; | 
 |  | 
 | 		/* Setup a trampoline to restart the syscall | 
 | 		 * with __NR_restart_syscall | 
 | 		 * | 
 | 		 *  0: <return address (orig r31)> | 
 | 		 *  4: <2nd half for 64-bit> | 
 | 		 *  8: ldw 0(%sp), %r31 | 
 | 		 * 12: be 0x100(%sr2, %r0) | 
 | 		 * 16: ldi __NR_restart_syscall, %r20 | 
 | 		 */ | 
 | #ifdef CONFIG_64BIT | 
 | 		put_user(regs->gr[31] >> 32, &usp[0]); | 
 | 		put_user(regs->gr[31] & 0xffffffff, &usp[1]); | 
 | 		put_user(0x0fc010df, &usp[2]); | 
 | #else | 
 | 		put_user(regs->gr[31], &usp[0]); | 
 | 		put_user(0x0fc0109f, &usp[2]); | 
 | #endif | 
 | 		put_user(0xe0008200, &usp[3]); | 
 | 		put_user(0x34140000, &usp[4]); | 
 |  | 
 | 		/* Stack is 64-byte aligned, and we only need | 
 | 		 * to flush 1 cache line. | 
 | 		 * Flushing one cacheline is cheap. | 
 | 		 * "sync" on bigger (> 4 way) boxes is not. | 
 | 		 */ | 
 | 		flush_icache_range(regs->gr[30], regs->gr[30] + 4); | 
 |  | 
 | 		regs->gr[31] = regs->gr[30] + 8; | 
 | 		/* Preserve original r28. */ | 
 | 		regs->gr[28] = regs->orig_r28; | 
 |  | 
 | 		return; | 
 | 	} | 
 | 	case -ERESTARTNOHAND: | 
 | 	case -ERESTARTSYS: | 
 | 	case -ERESTARTNOINTR: { | 
 | 		/* Hooray for delayed branching.  We don't | 
 | 		 * have to restore %r20 (the system call | 
 | 		 * number) because it gets loaded in the delay | 
 | 		 * slot of the branch external instruction. | 
 | 		 */ | 
 | 		regs->gr[31] -= 8; | 
 | 		/* Preserve original r28. */ | 
 | 		regs->gr[28] = regs->orig_r28; | 
 |  | 
 | 		return; | 
 | 	} | 
 | 	default: | 
 | 		break; | 
 | 	} | 
 | } | 
 |  | 
 | /* | 
 |  * Note that 'init' is a special process: it doesn't get signals it doesn't | 
 |  * want to handle. Thus you cannot kill init even with a SIGKILL even by | 
 |  * mistake. | 
 |  * | 
 |  * We need to be able to restore the syscall arguments (r21-r26) to | 
 |  * restart syscalls.  Thus, the syscall path should save them in the | 
 |  * pt_regs structure (it's okay to do so since they are caller-save | 
 |  * registers).  As noted below, the syscall number gets restored for | 
 |  * us due to the magic of delayed branching. | 
 |  */ | 
 | asmlinkage void | 
 | do_signal(struct pt_regs *regs, long in_syscall) | 
 | { | 
 | 	siginfo_t info; | 
 | 	struct k_sigaction ka; | 
 | 	int signr; | 
 | 	sigset_t *oldset; | 
 |  | 
 | 	DBG(1,"\ndo_signal: oldset=0x%p, regs=0x%p, sr7 %#lx, in_syscall=%d\n", | 
 | 	       oldset, regs, regs->sr[7], in_syscall); | 
 |  | 
 | 	/* Everyone else checks to see if they are in kernel mode at | 
 | 	   this point and exits if that's the case.  I'm not sure why | 
 | 	   we would be called in that case, but for some reason we | 
 | 	   are. */ | 
 |  | 
 | 	if (test_thread_flag(TIF_RESTORE_SIGMASK)) | 
 | 		oldset = ¤t->saved_sigmask; | 
 | 	else | 
 | 		oldset = ¤t->blocked; | 
 |  | 
 | 	DBG(1,"do_signal: oldset %08lx / %08lx\n",  | 
 | 		oldset->sig[0], oldset->sig[1]); | 
 |  | 
 |  | 
 | 	/* May need to force signal if handle_signal failed to deliver */ | 
 | 	while (1) { | 
 | 	   | 
 | 		signr = get_signal_to_deliver(&info, &ka, regs, NULL); | 
 | 		DBG(3,"do_signal: signr = %d, regs->gr[28] = %ld\n", signr, regs->gr[28]);  | 
 | 	 | 
 | 		if (signr <= 0) | 
 | 		  break; | 
 | 		 | 
 | 		/* Restart a system call if necessary. */ | 
 | 		if (in_syscall) | 
 | 			syscall_restart(regs, &ka); | 
 |  | 
 | 		/* Whee!  Actually deliver the signal.  If the | 
 | 		   delivery failed, we need to continue to iterate in | 
 | 		   this loop so we can deliver the SIGSEGV... */ | 
 | 		if (handle_signal(signr, &info, &ka, oldset, | 
 | 				  regs, in_syscall)) { | 
 | 			DBG(1,KERN_DEBUG "do_signal: Exit (success), regs->gr[28] = %ld\n", | 
 | 				regs->gr[28]); | 
 | 			if (test_thread_flag(TIF_RESTORE_SIGMASK)) | 
 | 				clear_thread_flag(TIF_RESTORE_SIGMASK); | 
 | 			return; | 
 | 		} | 
 | 	} | 
 | 	/* end of while(1) looping forever if we can't force a signal */ | 
 |  | 
 | 	/* Did we come from a system call? */ | 
 | 	if (in_syscall) | 
 | 		insert_restart_trampoline(regs); | 
 | 	 | 
 | 	DBG(1,"do_signal: Exit (not delivered), regs->gr[28] = %ld\n",  | 
 | 		regs->gr[28]); | 
 |  | 
 | 	if (test_thread_flag(TIF_RESTORE_SIGMASK)) { | 
 | 		clear_thread_flag(TIF_RESTORE_SIGMASK); | 
 | 		sigprocmask(SIG_SETMASK, ¤t->saved_sigmask, NULL); | 
 | 	} | 
 |  | 
 | 	return; | 
 | } | 
 |  | 
 | void do_notify_resume(struct pt_regs *regs, long in_syscall) | 
 | { | 
 | 	if (test_thread_flag(TIF_SIGPENDING) || | 
 | 	    test_thread_flag(TIF_RESTORE_SIGMASK)) | 
 | 		do_signal(regs, in_syscall); | 
 | } |