277 lines
7.8 KiB
C
277 lines
7.8 KiB
C
/*
|
|
* 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)
|
|
{
|
|
unsigned long eflags;
|
|
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(current->thread.err, &to->err);
|
|
err |= __put_user(current->thread.trap_no, &to->trapno);
|
|
err |= PUTREG(regs, RIP, to, rip);
|
|
err |= PUTREG(regs, EFLAGS, to, eflags);
|
|
#undef PUTREG
|
|
|
|
err |= __put_user(mask, &to->oldmask);
|
|
err |= __put_user(current->thread.cr2, &to->cr2);
|
|
|
|
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 -= 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:
|
|
*/
|