return (void *)((usp - frame_size) & -8UL);
 }
 
-static void setup_frame (int sig, struct k_sigaction *ka,
+static int setup_frame (int sig, struct k_sigaction *ka,
                         sigset_t *set, struct pt_regs *regs)
 {
        struct sigframe *frame;
                tregs->pc = regs->pc;
                tregs->sr = regs->sr;
        }
-       return;
+       return err;
 
 give_sigsegv:
        force_sigsegv(sig, current);
        goto adjust_stack;
 }
 
-static void setup_rt_frame (int sig, struct k_sigaction *ka, siginfo_t *info,
+static int setup_rt_frame (int sig, struct k_sigaction *ka, siginfo_t *info,
                            sigset_t *set, struct pt_regs *regs)
 {
        struct rt_sigframe *frame;
                tregs->pc = regs->pc;
                tregs->sr = regs->sr;
        }
-       return;
+       return err;
 
 give_sigsegv:
        force_sigsegv(sig, current);
 handle_signal(int sig, struct k_sigaction *ka, siginfo_t *info,
              sigset_t *oldset, struct pt_regs *regs)
 {
+       int err;
        /* are we from a system call? */
        if (regs->orig_d0 >= 0)
                /* If so, check system call restarting.. */
 
        /* set up the stack frame */
        if (ka->sa.sa_flags & SA_SIGINFO)
-               setup_rt_frame(sig, ka, info, oldset, regs);
+               err = setup_rt_frame(sig, ka, info, oldset, regs);
        else
-               setup_frame(sig, ka, oldset, regs);
+               err = setup_frame(sig, ka, oldset, regs);
+
+       if (err)
+               return;
 
        spin_lock_irq(¤t->sighand->siglock);
        sigorsets(¤t->blocked,¤t->blocked,&ka->sa.sa_mask);
                sigaddset(¤t->blocked,sig);
        recalc_sigpending();
        spin_unlock_irq(¤t->sighand->siglock);
+
+       clear_thread_flag(TIF_RESTORE_SIGMASK);
 }
 
 /*
        if (signr > 0) {
                /* Whee!  Actually deliver the signal.  */
                handle_signal(signr, &ka, &info, oldset, regs);
-               clear_thread_flag(TIF_RESTORE_SIGMASK);
                return;
        }