123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400 |
- #include <linux/signal.h>
- #include <linux/ptrace.h>
- #include <linux/personality.h>
- #include <linux/uaccess.h>
- #include <linux/syscalls.h>
- #include <linux/tracehook.h>
- #include <asm/ucontext.h>
- struct rt_sigframe {
- struct siginfo info;
- struct ucontext uc;
- #define MAGIC_SIGALTSTK 0x07302004
- unsigned int sigret_magic;
- };
- static int
- stash_usr_regs(struct rt_sigframe __user *sf, struct pt_regs *regs,
- sigset_t *set)
- {
- int err;
- struct user_regs_struct uregs;
- uregs.scratch.bta = regs->bta;
- uregs.scratch.lp_start = regs->lp_start;
- uregs.scratch.lp_end = regs->lp_end;
- uregs.scratch.lp_count = regs->lp_count;
- uregs.scratch.status32 = regs->status32;
- uregs.scratch.ret = regs->ret;
- uregs.scratch.blink = regs->blink;
- uregs.scratch.fp = regs->fp;
- uregs.scratch.gp = regs->r26;
- uregs.scratch.r12 = regs->r12;
- uregs.scratch.r11 = regs->r11;
- uregs.scratch.r10 = regs->r10;
- uregs.scratch.r9 = regs->r9;
- uregs.scratch.r8 = regs->r8;
- uregs.scratch.r7 = regs->r7;
- uregs.scratch.r6 = regs->r6;
- uregs.scratch.r5 = regs->r5;
- uregs.scratch.r4 = regs->r4;
- uregs.scratch.r3 = regs->r3;
- uregs.scratch.r2 = regs->r2;
- uregs.scratch.r1 = regs->r1;
- uregs.scratch.r0 = regs->r0;
- uregs.scratch.sp = regs->sp;
- err = __copy_to_user(&(sf->uc.uc_mcontext.regs.scratch), &uregs.scratch,
- sizeof(sf->uc.uc_mcontext.regs.scratch));
- err |= __copy_to_user(&sf->uc.uc_sigmask, set, sizeof(sigset_t));
- return err;
- }
- static int restore_usr_regs(struct pt_regs *regs, struct rt_sigframe __user *sf)
- {
- sigset_t set;
- int err;
- struct user_regs_struct uregs;
- err = __copy_from_user(&set, &sf->uc.uc_sigmask, sizeof(set));
- err |= __copy_from_user(&uregs.scratch,
- &(sf->uc.uc_mcontext.regs.scratch),
- sizeof(sf->uc.uc_mcontext.regs.scratch));
- if (err)
- return err;
- set_current_blocked(&set);
- regs->bta = uregs.scratch.bta;
- regs->lp_start = uregs.scratch.lp_start;
- regs->lp_end = uregs.scratch.lp_end;
- regs->lp_count = uregs.scratch.lp_count;
- regs->status32 = uregs.scratch.status32;
- regs->ret = uregs.scratch.ret;
- regs->blink = uregs.scratch.blink;
- regs->fp = uregs.scratch.fp;
- regs->r26 = uregs.scratch.gp;
- regs->r12 = uregs.scratch.r12;
- regs->r11 = uregs.scratch.r11;
- regs->r10 = uregs.scratch.r10;
- regs->r9 = uregs.scratch.r9;
- regs->r8 = uregs.scratch.r8;
- regs->r7 = uregs.scratch.r7;
- regs->r6 = uregs.scratch.r6;
- regs->r5 = uregs.scratch.r5;
- regs->r4 = uregs.scratch.r4;
- regs->r3 = uregs.scratch.r3;
- regs->r2 = uregs.scratch.r2;
- regs->r1 = uregs.scratch.r1;
- regs->r0 = uregs.scratch.r0;
- regs->sp = uregs.scratch.sp;
- return 0;
- }
- static inline int is_do_ss_needed(unsigned int magic)
- {
- if (MAGIC_SIGALTSTK == magic)
- return 1;
- else
- return 0;
- }
- SYSCALL_DEFINE0(rt_sigreturn)
- {
- struct rt_sigframe __user *sf;
- unsigned int magic;
- struct pt_regs *regs = current_pt_regs();
-
- current->restart_block.fn = do_no_restart_syscall;
-
- if (regs->sp & 3)
- goto badframe;
- sf = (struct rt_sigframe __force __user *)(regs->sp);
- if (!access_ok(VERIFY_READ, sf, sizeof(*sf)))
- goto badframe;
- if (__get_user(magic, &sf->sigret_magic))
- goto badframe;
- if (unlikely(is_do_ss_needed(magic)))
- if (restore_altstack(&sf->uc.uc_stack))
- goto badframe;
- if (restore_usr_regs(regs, sf))
- goto badframe;
-
- syscall_wont_restart(regs);
-
- regs->status32 |= STATUS_U_MASK;
- return regs->r0;
- badframe:
- force_sig(SIGSEGV, current);
- return 0;
- }
- static inline void __user *get_sigframe(struct ksignal *ksig,
- struct pt_regs *regs,
- unsigned long framesize)
- {
- unsigned long sp = sigsp(regs->sp, ksig);
- void __user *frame;
-
-
- frame = (void __user *)((sp - framesize) & ~7);
-
- if (!access_ok(VERIFY_WRITE, frame, framesize))
- frame = NULL;
- return frame;
- }
- static int
- setup_rt_frame(struct ksignal *ksig, sigset_t *set, struct pt_regs *regs)
- {
- struct rt_sigframe __user *sf;
- unsigned int magic = 0;
- int err = 0;
- sf = get_sigframe(ksig, regs, sizeof(struct rt_sigframe));
- if (!sf)
- return 1;
-
- err |= stash_usr_regs(sf, regs, set);
-
- if (unlikely(ksig->ka.sa.sa_flags & SA_SIGINFO)) {
- err |= copy_siginfo_to_user(&sf->info, &ksig->info);
- err |= __put_user(0, &sf->uc.uc_flags);
- err |= __put_user(NULL, &sf->uc.uc_link);
- err |= __save_altstack(&sf->uc.uc_stack, regs->sp);
-
- regs->r1 = (unsigned long)&sf->info;
- regs->r2 = (unsigned long)&sf->uc;
-
- magic = MAGIC_SIGALTSTK;
- }
- err |= __put_user(magic, &sf->sigret_magic);
- if (err)
- return err;
-
- regs->r0 = ksig->sig;
-
- regs->ret = (unsigned long)ksig->ka.sa.sa_handler;
-
- if(!(ksig->ka.sa.sa_flags & SA_RESTORER))
- return 1;
- regs->blink = (unsigned long)ksig->ka.sa.sa_restorer;
-
- regs->sp = (unsigned long)sf;
-
- regs->status32 &= ~STATUS_DE_MASK;
- regs->status32 |= STATUS_L_MASK;
- return err;
- }
- static void arc_restart_syscall(struct k_sigaction *ka, struct pt_regs *regs)
- {
- switch (regs->r0) {
- case -ERESTART_RESTARTBLOCK:
- case -ERESTARTNOHAND:
-
- regs->r0 = -EINTR;
- break;
- case -ERESTARTSYS:
-
- if (!(ka->sa.sa_flags & SA_RESTART)) {
- regs->r0 = -EINTR;
- break;
- }
-
- case -ERESTARTNOINTR:
-
- regs->r0 = regs->orig_r0;
- regs->ret -= is_isa_arcv2() ? 2 : 4;
- break;
- }
- }
- static void
- handle_signal(struct ksignal *ksig, struct pt_regs *regs)
- {
- sigset_t *oldset = sigmask_to_save();
- int failed;
-
- failed = setup_rt_frame(ksig, oldset, regs);
- signal_setup_done(failed, ksig, 0);
- }
- void do_signal(struct pt_regs *regs)
- {
- struct ksignal ksig;
- int restart_scall;
- restart_scall = in_syscall(regs) && syscall_restartable(regs);
- if (get_signal(&ksig)) {
- if (restart_scall) {
- arc_restart_syscall(&ksig.ka, regs);
- syscall_wont_restart(regs);
- }
- handle_signal(&ksig, regs);
- return;
- }
- if (restart_scall) {
-
- if (regs->r0 == -ERESTARTNOHAND ||
- regs->r0 == -ERESTARTSYS || regs->r0 == -ERESTARTNOINTR) {
- regs->r0 = regs->orig_r0;
- regs->ret -= is_isa_arcv2() ? 2 : 4;
- } else if (regs->r0 == -ERESTART_RESTARTBLOCK) {
- regs->r8 = __NR_restart_syscall;
- regs->ret -= is_isa_arcv2() ? 2 : 4;
- }
- syscall_wont_restart(regs);
- }
-
- restore_saved_sigmask();
- }
- void do_notify_resume(struct pt_regs *regs)
- {
-
- if (test_and_clear_thread_flag(TIF_NOTIFY_RESUME))
- tracehook_notify_resume(regs);
- }
|