| /* | 
 |  * Copyright (C) 2003 PathScale, Inc. | 
 |  * Licensed under the GPL | 
 |  */ | 
 |  | 
 | #include "linux/stddef.h" | 
 | #include "linux/errno.h" | 
 | #include "linux/personality.h" | 
 | #include "linux/ptrace.h" | 
 | #include "asm/current.h" | 
 | #include "asm/uaccess.h" | 
 | #include "asm/sigcontext.h" | 
 | #include "asm/ptrace.h" | 
 | #include "asm/arch/ucontext.h" | 
 | #include "choose-mode.h" | 
 | #include "sysdep/ptrace.h" | 
 | #include "frame_kern.h" | 
 |  | 
 | #ifdef CONFIG_MODE_SKAS | 
 |  | 
 | #include "skas.h" | 
 |  | 
 | static int copy_sc_from_user_skas(struct pt_regs *regs, | 
 |                                  struct sigcontext *from) | 
 | { | 
 |        int err = 0; | 
 |  | 
 | #define GETREG(regs, regno, sc, regname) \ | 
 |        __get_user((regs)->regs.skas.regs[(regno) / sizeof(unsigned long)], \ | 
 |                   &(sc)->regname) | 
 |  | 
 |        err |= GETREG(regs, R8, from, r8); | 
 |        err |= GETREG(regs, R9, from, r9); | 
 |        err |= GETREG(regs, R10, from, r10); | 
 |        err |= GETREG(regs, R11, from, r11); | 
 |        err |= GETREG(regs, R12, from, r12); | 
 |        err |= GETREG(regs, R13, from, r13); | 
 |        err |= GETREG(regs, R14, from, r14); | 
 |        err |= GETREG(regs, R15, from, r15); | 
 |        err |= GETREG(regs, RDI, from, rdi); | 
 |        err |= GETREG(regs, RSI, from, rsi); | 
 |        err |= GETREG(regs, RBP, from, rbp); | 
 |        err |= GETREG(regs, RBX, from, rbx); | 
 |        err |= GETREG(regs, RDX, from, rdx); | 
 |        err |= GETREG(regs, RAX, from, rax); | 
 |        err |= GETREG(regs, RCX, from, rcx); | 
 |        err |= GETREG(regs, RSP, from, rsp); | 
 |        err |= GETREG(regs, RIP, from, rip); | 
 |        err |= GETREG(regs, EFLAGS, from, eflags); | 
 |        err |= GETREG(regs, CS, from, cs); | 
 |  | 
 | #undef GETREG | 
 |  | 
 |        return(err); | 
 | } | 
 |  | 
 | int copy_sc_to_user_skas(struct sigcontext *to, struct _fpstate *to_fp, | 
 |                         struct pt_regs *regs, unsigned long mask) | 
 | { | 
 |         struct faultinfo * fi = ¤t->thread.arch.faultinfo; | 
 | 	int err = 0; | 
 |  | 
 | 	err |= __put_user(0, &to->gs); | 
 | 	err |= __put_user(0, &to->fs); | 
 |  | 
 | #define PUTREG(regs, regno, sc, regname) \ | 
 |        __put_user((regs)->regs.skas.regs[(regno) / sizeof(unsigned long)], \ | 
 |                   &(sc)->regname) | 
 |  | 
 | 	err |= PUTREG(regs, RDI, to, rdi); | 
 | 	err |= PUTREG(regs, RSI, to, rsi); | 
 | 	err |= PUTREG(regs, RBP, to, rbp); | 
 | 	err |= PUTREG(regs, RSP, to, rsp); | 
 | 	err |= PUTREG(regs, RBX, to, rbx); | 
 | 	err |= PUTREG(regs, RDX, to, rdx); | 
 | 	err |= PUTREG(regs, RCX, to, rcx); | 
 | 	err |= PUTREG(regs, RAX, to, rax); | 
 | 	err |= PUTREG(regs, R8, to, r8); | 
 | 	err |= PUTREG(regs, R9, to, r9); | 
 | 	err |= PUTREG(regs, R10, to, r10); | 
 | 	err |= PUTREG(regs, R11, to, r11); | 
 | 	err |= PUTREG(regs, R12, to, r12); | 
 | 	err |= PUTREG(regs, R13, to, r13); | 
 | 	err |= PUTREG(regs, R14, to, r14); | 
 | 	err |= PUTREG(regs, R15, to, r15); | 
 | 	err |= PUTREG(regs, CS, to, cs); /* XXX x86_64 doesn't do this */ | 
 |  | 
 |         err |= __put_user(fi->cr2, &to->cr2); | 
 |         err |= __put_user(fi->error_code, &to->err); | 
 |         err |= __put_user(fi->trap_no, &to->trapno); | 
 |  | 
 | 	err |= PUTREG(regs, RIP, to, rip); | 
 | 	err |= PUTREG(regs, EFLAGS, to, eflags); | 
 | #undef PUTREG | 
 |  | 
 | 	err |= __put_user(mask, &to->oldmask); | 
 |  | 
 | 	return(err); | 
 | } | 
 |  | 
 | #endif | 
 |  | 
 | #ifdef CONFIG_MODE_TT | 
 | int copy_sc_from_user_tt(struct sigcontext *to, struct sigcontext *from, | 
 |                         int fpsize) | 
 | { | 
 |        struct _fpstate *to_fp, *from_fp; | 
 |        unsigned long sigs; | 
 |        int err; | 
 |  | 
 |        to_fp = to->fpstate; | 
 |        from_fp = from->fpstate; | 
 |        sigs = to->oldmask; | 
 |        err = copy_from_user(to, from, sizeof(*to)); | 
 |        to->oldmask = sigs; | 
 |        return(err); | 
 | } | 
 |  | 
 | int copy_sc_to_user_tt(struct sigcontext *to, struct _fpstate *fp, | 
 |                       struct sigcontext *from, int fpsize) | 
 | { | 
 |        struct _fpstate *to_fp, *from_fp; | 
 |        int err; | 
 |  | 
 |        to_fp = (fp ? fp : (struct _fpstate *) (to + 1)); | 
 |        from_fp = from->fpstate; | 
 |        err = copy_to_user(to, from, sizeof(*to)); | 
 |        return(err); | 
 | } | 
 |  | 
 | #endif | 
 |  | 
 | static int copy_sc_from_user(struct pt_regs *to, void __user *from) | 
 | { | 
 |        int ret; | 
 |  | 
 |        ret = CHOOSE_MODE(copy_sc_from_user_tt(UPT_SC(&to->regs), from, | 
 |                                               sizeof(struct _fpstate)), | 
 |                          copy_sc_from_user_skas(to, from)); | 
 |        return(ret); | 
 | } | 
 |  | 
 | static int copy_sc_to_user(struct sigcontext *to, struct _fpstate *fp, | 
 |                           struct pt_regs *from, unsigned long mask) | 
 | { | 
 |        return(CHOOSE_MODE(copy_sc_to_user_tt(to, fp, UPT_SC(&from->regs), | 
 |                                              sizeof(*fp)), | 
 |                           copy_sc_to_user_skas(to, fp, from, mask))); | 
 | } | 
 |  | 
 | struct rt_sigframe | 
 | { | 
 |        char *pretcode; | 
 |        struct ucontext uc; | 
 |        struct siginfo info; | 
 | }; | 
 |  | 
 | #define round_down(m, n) (((m) / (n)) * (n)) | 
 |  | 
 | int setup_signal_stack_si(unsigned long stack_top, int sig, | 
 | 			  struct k_sigaction *ka, struct pt_regs * regs, | 
 | 			  siginfo_t *info, sigset_t *set) | 
 | { | 
 | 	struct rt_sigframe __user *frame; | 
 | 	struct _fpstate __user *fp = NULL; | 
 | 	int err = 0; | 
 | 	struct task_struct *me = current; | 
 |  | 
 | 	frame = (struct rt_sigframe __user *) | 
 | 		round_down(stack_top - sizeof(struct rt_sigframe), 16) - 8; | 
 |         frame = (struct rt_sigframe *) ((unsigned long) frame - 128); | 
 |  | 
 | 	if (!access_ok(VERIFY_WRITE, fp, sizeof(struct _fpstate))) | 
 | 		goto out; | 
 |  | 
 | #if 0 /* XXX */ | 
 | 	if (save_i387(fp) < 0) | 
 | 		err |= -1; | 
 | #endif | 
 | 	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame))) | 
 | 		goto out; | 
 |  | 
 | 	if (ka->sa.sa_flags & SA_SIGINFO) { | 
 | 		err |= copy_siginfo_to_user(&frame->info, info); | 
 | 		if (err) | 
 | 			goto out; | 
 | 	} | 
 |  | 
 | 	/* Create the ucontext.  */ | 
 | 	err |= __put_user(0, &frame->uc.uc_flags); | 
 | 	err |= __put_user(0, &frame->uc.uc_link); | 
 | 	err |= __put_user(me->sas_ss_sp, &frame->uc.uc_stack.ss_sp); | 
 | 	err |= __put_user(sas_ss_flags(PT_REGS_SP(regs)), | 
 | 			  &frame->uc.uc_stack.ss_flags); | 
 | 	err |= __put_user(me->sas_ss_size, &frame->uc.uc_stack.ss_size); | 
 | 	err |= copy_sc_to_user(&frame->uc.uc_mcontext, fp, regs, set->sig[0]); | 
 | 	err |= __put_user(fp, &frame->uc.uc_mcontext.fpstate); | 
 | 	if (sizeof(*set) == 16) { | 
 | 		__put_user(set->sig[0], &frame->uc.uc_sigmask.sig[0]); | 
 | 		__put_user(set->sig[1], &frame->uc.uc_sigmask.sig[1]); | 
 | 	} | 
 | 	else | 
 | 		err |= __copy_to_user(&frame->uc.uc_sigmask, set, | 
 | 				      sizeof(*set)); | 
 |  | 
 | 	/* Set up to return from userspace.  If provided, use a stub | 
 | 	   already in userspace.  */ | 
 | 	/* x86-64 should always use SA_RESTORER. */ | 
 | 	if (ka->sa.sa_flags & SA_RESTORER) | 
 | 		err |= __put_user(ka->sa.sa_restorer, &frame->pretcode); | 
 | 	else | 
 | 		/* could use a vstub here */ | 
 | 		goto out; | 
 |  | 
 | 	if (err) | 
 | 		goto out; | 
 |  | 
 | 	/* Set up registers for signal handler */ | 
 | 	{ | 
 | 		struct exec_domain *ed = current_thread_info()->exec_domain; | 
 | 		if (unlikely(ed && ed->signal_invmap && sig < 32)) | 
 | 			sig = ed->signal_invmap[sig]; | 
 | 	} | 
 |  | 
 | 	PT_REGS_RDI(regs) = sig; | 
 | 	/* In case the signal handler was declared without prototypes */ | 
 | 	PT_REGS_RAX(regs) = 0; | 
 |  | 
 | 	/* This also works for non SA_SIGINFO handlers because they expect the | 
 | 	   next argument after the signal number on the stack. */ | 
 | 	PT_REGS_RSI(regs) = (unsigned long) &frame->info; | 
 | 	PT_REGS_RDX(regs) = (unsigned long) &frame->uc; | 
 | 	PT_REGS_RIP(regs) = (unsigned long) ka->sa.sa_handler; | 
 |  | 
 | 	PT_REGS_RSP(regs) = (unsigned long) frame; | 
 |  out: | 
 | 	return(err); | 
 | } | 
 |  | 
 | long sys_rt_sigreturn(struct pt_regs *regs) | 
 | { | 
 | 	unsigned long sp = PT_REGS_SP(¤t->thread.regs); | 
 | 	struct rt_sigframe __user *frame = | 
 | 		(struct rt_sigframe __user *)(sp - 8); | 
 | 	struct ucontext __user *uc = &frame->uc; | 
 | 	sigset_t set; | 
 |  | 
 | 	if(copy_from_user(&set, &uc->uc_sigmask, sizeof(set))) | 
 | 		goto segfault; | 
 |  | 
 | 	sigdelsetmask(&set, ~_BLOCKABLE); | 
 |  | 
 | 	spin_lock_irq(¤t->sighand->siglock); | 
 | 	current->blocked = set; | 
 | 	recalc_sigpending(); | 
 | 	spin_unlock_irq(¤t->sighand->siglock); | 
 |  | 
 | 	if(copy_sc_from_user(¤t->thread.regs, &uc->uc_mcontext)) | 
 | 		goto segfault; | 
 |  | 
 | 	/* Avoid ERESTART handling */ | 
 | 	PT_REGS_SYSCALL_NR(¤t->thread.regs) = -1; | 
 | 	return(PT_REGS_SYSCALL_RET(¤t->thread.regs)); | 
 |  | 
 |  segfault: | 
 | 	force_sig(SIGSEGV, current); | 
 | 	return 0; | 
 | } | 
 | /* | 
 |  * Overrides for Emacs so that we follow Linus's tabbing style. | 
 |  * Emacs will notice this stuff at the end of the file and automatically | 
 |  * adjust the settings for this buffer only.  This must remain at the end | 
 |  * of the file. | 
 |  * --------------------------------------------------------------------------- | 
 |  * Local variables: | 
 |  * c-file-style: "linux" | 
 |  * End: | 
 |  */ |