git.oblomov.eu Git - linux-2.6/blob - arch/parisc/kernel/signal.c

   1 /*
   2  *  linux/arch/parisc/kernel/signal.c: Architecture-specific signal
   3  *  handling support.
   4  *
   5  *  Copyright (C) 2000 David Huggins-Daines <dhd@debian.org>
   6  *  Copyright (C) 2000 Linuxcare, Inc.
   7  *
   8  *  Based on the ia64, i386, and alpha versions.
   9  *
  10  *  Like the IA-64, we are a recent enough port (we are *starting*
  11  *  with glibc2.2) that we do not need to support the old non-realtime
  12  *  Linux signals.  Therefore we don't.  HP/UX signals will go in
  13  *  arch/parisc/hpux/signal.c when we figure out how to do them.
  14  */
  15
  16 #include <linux/sched.h>
  17 #include <linux/mm.h>
  18 #include <linux/smp.h>
  19 #include <linux/kernel.h>
  20 #include <linux/signal.h>
  21 #include <linux/errno.h>
  22 #include <linux/wait.h>
  23 #include <linux/ptrace.h>
  24 #include <linux/unistd.h>
  25 #include <linux/stddef.h>
  26 #include <linux/compat.h>
  27 #include <linux/elf.h>
  28 #include <asm/ucontext.h>
  29 #include <asm/rt_sigframe.h>
  30 #include <asm/uaccess.h>
  31 #include <asm/pgalloc.h>
  32 #include <asm/cacheflush.h>
  33 #include <asm/asm-offsets.h>
  34
  35 #ifdef CONFIG_COMPAT
  36 #include <linux/compat.h>
  37 #include "signal32.h"
  38 #endif
  39
  40 #define DEBUG_SIG 0
  41 #define DEBUG_SIG_LEVEL 2
  42
  43 #if DEBUG_SIG
  44 #define DBG(LEVEL, ...) \
  45         ((DEBUG_SIG_LEVEL >= LEVEL) \
  46         ? printk(__VA_ARGS__) : (void) 0)
  47 #else
  48 #define DBG(LEVEL, ...)
  49 #endif
  50
  51
  52 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
  53
  54 /* gcc will complain if a pointer is cast to an integer of different
  55  * size.  If you really need to do this (and we do for an ELF32 user
  56  * application in an ELF64 kernel) then you have to do a cast to an
  57  * integer of the same size first.  The A() macro accomplishes
  58  * this. */
  59 #define A(__x)  ((unsigned long)(__x))
  60
  61 /*
  62  * Atomically swap in the new signal mask, and wait for a signal.
  63  */
  64 #ifdef CONFIG_64BIT
  65 #include "sys32.h"
  66 #endif
  67
  68 /*
  69  * Do a signal return - restore sigcontext.
  70  */
  71
  72 /* Trampoline for calling rt_sigreturn() */
  73 #define INSN_LDI_R25_0   0x34190000 /* ldi  0,%r25 (in_syscall=0) */
  74 #define INSN_LDI_R25_1   0x34190002 /* ldi  1,%r25 (in_syscall=1) */
  75 #define INSN_LDI_R20     0x3414015a /* ldi  __NR_rt_sigreturn,%r20 */
  76 #define INSN_BLE_SR2_R0  0xe4008200 /* be,l 0x100(%sr2,%r0),%sr0,%r31 */
  77 #define INSN_NOP         0x08000240 /* nop */
  78 /* For debugging */
  79 #define INSN_DIE_HORRIBLY 0x68000ccc /* stw %r0,0x666(%sr0,%r0) */
  80
  81 static long
  82 restore_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs)
  83 {
  84         long err = 0;
  85
  86         err |= __copy_from_user(regs->gr, sc->sc_gr, sizeof(regs->gr));
  87         err |= __copy_from_user(regs->fr, sc->sc_fr, sizeof(regs->fr));
  88         err |= __copy_from_user(regs->iaoq, sc->sc_iaoq, sizeof(regs->iaoq));
  89         err |= __copy_from_user(regs->iasq, sc->sc_iasq, sizeof(regs->iasq));
  90         err |= __get_user(regs->sar, &sc->sc_sar);
  91         DBG(2,"restore_sigcontext: iaoq is 0x%#lx / 0x%#lx\n",
  92                         regs->iaoq[0],regs->iaoq[1]);
  93         DBG(2,"restore_sigcontext: r28 is %ld\n", regs->gr[28]);
  94         return err;
  95 }
  96
  97 void
  98 sys_rt_sigreturn(struct pt_regs *regs, int in_syscall)
  99 {
 100         struct rt_sigframe __user *frame;
 101         struct siginfo si;
 102         sigset_t set;
 103         unsigned long usp = (regs->gr[30] & ~(0x01UL));
 104         unsigned long sigframe_size = PARISC_RT_SIGFRAME_SIZE;
 105 #ifdef CONFIG_64BIT
 106         compat_sigset_t compat_set;
 107         struct compat_rt_sigframe __user * compat_frame;
 108
 109         if (is_compat_task())
 110                 sigframe_size = PARISC_RT_SIGFRAME_SIZE32;
 111 #endif
 112
 113
 114         /* Unwind the user stack to get the rt_sigframe structure. */
 115         frame = (struct rt_sigframe __user *)
 116                 (usp - sigframe_size);
 117         DBG(2,"sys_rt_sigreturn: frame is %p\n", frame);
 118
 119 #ifdef CONFIG_64BIT
 120         compat_frame = (struct compat_rt_sigframe __user *)frame;
 121
 122         if (is_compat_task()) {
 123                 DBG(2,"sys_rt_sigreturn: ELF32 process.\n");
 124                 if (__copy_from_user(&compat_set, &compat_frame->uc.uc_sigmask, sizeof(compat_set)))
 125                         goto give_sigsegv;
 126                 sigset_32to64(&set,&compat_set);
 127         } else
 128 #endif
 129         {
 130                 if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
 131                         goto give_sigsegv;
 132         }
 133
 134         sigdelsetmask(&set, ~_BLOCKABLE);
 135         spin_lock_irq(&current->sighand->siglock);
 136         current->blocked = set;
 137         recalc_sigpending();
 138         spin_unlock_irq(&current->sighand->siglock);
 139
 140         /* Good thing we saved the old gr[30], eh? */
 141 #ifdef CONFIG_64BIT
 142         if (is_compat_task()) {
 143                 DBG(1,"sys_rt_sigreturn: compat_frame->uc.uc_mcontext 0x%p\n",
 144                                 &compat_frame->uc.uc_mcontext);
 145 // FIXME: Load upper half from register file
 146                 if (restore_sigcontext32(&compat_frame->uc.uc_mcontext,
 147                                         &compat_frame->regs, regs))
 148                         goto give_sigsegv;
 149                 DBG(1,"sys_rt_sigreturn: usp %#08lx stack 0x%p\n",
 150                                 usp, &compat_frame->uc.uc_stack);
 151                 if (do_sigaltstack32(&compat_frame->uc.uc_stack, NULL, usp) == -EFAULT)
 152                         goto give_sigsegv;
 153         } else
 154 #endif
 155         {
 156                 DBG(1,"sys_rt_sigreturn: frame->uc.uc_mcontext 0x%p\n",
 157                                 &frame->uc.uc_mcontext);
 158                 if (restore_sigcontext(&frame->uc.uc_mcontext, regs))
 159                         goto give_sigsegv;
 160                 DBG(1,"sys_rt_sigreturn: usp %#08lx stack 0x%p\n",
 161                                 usp, &frame->uc.uc_stack);
 162                 if (do_sigaltstack(&frame->uc.uc_stack, NULL, usp) == -EFAULT)
 163                         goto give_sigsegv;
 164         }
 165
 166
 167
 168         /* If we are on the syscall path IAOQ will not be restored, and
 169          * if we are on the interrupt path we must not corrupt gr31.
 170          */
 171         if (in_syscall)
 172                 regs->gr[31] = regs->iaoq[0];
 173 #if DEBUG_SIG
 174         DBG(1,"sys_rt_sigreturn: returning to %#lx, DUMPING REGS:\n", regs->iaoq[0]);
 175         show_regs(regs);
 176 #endif
 177         return;
 178
 179 give_sigsegv:
 180         DBG(1,"sys_rt_sigreturn: Sending SIGSEGV\n");
 181         si.si_signo = SIGSEGV;
 182         si.si_errno = 0;
 183         si.si_code = SI_KERNEL;
 184         si.si_pid = task_pid_vnr(current);
 185         si.si_uid = current->uid;
 186         si.si_addr = &frame->uc;
 187         force_sig_info(SIGSEGV, &si, current);
 188         return;
 189 }
 190
 191 /*
 192  * Set up a signal frame.
 193  */
 194
 195 static inline void __user *
 196 get_sigframe(struct k_sigaction *ka, unsigned long sp, size_t frame_size)
 197 {
 198         /*FIXME: ELF32 vs. ELF64 has different frame_size, but since we
 199           don't use the parameter it doesn't matter */
 200
 201         DBG(1,"get_sigframe: ka = %#lx, sp = %#lx, frame_size = %#lx\n",
 202                         (unsigned long)ka, sp, frame_size);
 203
 204         if ((ka->sa.sa_flags & SA_ONSTACK) != 0 && ! sas_ss_flags(sp))
 205                 sp = current->sas_ss_sp; /* Stacks grow up! */
 206
 207         DBG(1,"get_sigframe: Returning sp = %#lx\n", (unsigned long)sp);
 208         return (void __user *) sp; /* Stacks grow up.  Fun. */
 209 }
 210
 211 static long
 212 setup_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs, int in_syscall)
 213
 214 {
 215         unsigned long flags = 0;
 216         long err = 0;
 217
 218         if (on_sig_stack((unsigned long) sc))
 219                 flags |= PARISC_SC_FLAG_ONSTACK;
 220         if (in_syscall) {
 221                 flags |= PARISC_SC_FLAG_IN_SYSCALL;
 222                 /* regs->iaoq is undefined in the syscall return path */
 223                 err |= __put_user(regs->gr[31], &sc->sc_iaoq[0]);
 224                 err |= __put_user(regs->gr[31]+4, &sc->sc_iaoq[1]);
 225                 err |= __put_user(regs->sr[3], &sc->sc_iasq[0]);
 226                 err |= __put_user(regs->sr[3], &sc->sc_iasq[1]);
 227                 DBG(1,"setup_sigcontext: iaoq %#lx / %#lx (in syscall)\n",
 228                         regs->gr[31], regs->gr[31]+4);
 229         } else {
 230                 err |= __copy_to_user(sc->sc_iaoq, regs->iaoq, sizeof(regs->iaoq));
 231                 err |= __copy_to_user(sc->sc_iasq, regs->iasq, sizeof(regs->iasq));
 232                 DBG(1,"setup_sigcontext: iaoq %#lx / %#lx (not in syscall)\n",
 233                         regs->iaoq[0], regs->iaoq[1]);
 234         }
 235
 236         err |= __put_user(flags, &sc->sc_flags);
 237         err |= __copy_to_user(sc->sc_gr, regs->gr, sizeof(regs->gr));
 238         err |= __copy_to_user(sc->sc_fr, regs->fr, sizeof(regs->fr));
 239         err |= __put_user(regs->sar, &sc->sc_sar);
 240         DBG(1,"setup_sigcontext: r28 is %ld\n", regs->gr[28]);
 241
 242         return err;
 243 }
 244
 245 static long
 246 setup_rt_frame(int sig, struct k_sigaction *ka, siginfo_t *info,
 247                sigset_t *set, struct pt_regs *regs, int in_syscall)
 248 {
 249         struct rt_sigframe __user *frame;
 250         unsigned long rp, usp;
 251         unsigned long haddr, sigframe_size;
 252         int err = 0;
 253 #ifdef CONFIG_64BIT
 254         compat_int_t compat_val;
 255         struct compat_rt_sigframe __user * compat_frame;
 256         compat_sigset_t compat_set;
 257 #endif
 258
 259         usp = (regs->gr[30] & ~(0x01UL));
 260         /*FIXME: frame_size parameter is unused, remove it. */
 261         frame = get_sigframe(ka, usp, sizeof(*frame));
 262
 263         DBG(1,"SETUP_RT_FRAME: START\n");
 264         DBG(1,"setup_rt_frame: frame %p info %p\n", frame, info);
 265
 266
 267 #ifdef CONFIG_64BIT
 268
 269         compat_frame = (struct compat_rt_sigframe __user *)frame;
 270
 271         if (is_compat_task()) {
 272                 DBG(1,"setup_rt_frame: frame->info = 0x%p\n", &compat_frame->info);
 273                 err |= copy_siginfo_to_user32(&compat_frame->info, info);
 274                 DBG(1,"SETUP_RT_FRAME: 1\n");
 275                 compat_val = (compat_int_t)current->sas_ss_sp;
 276                 err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_sp);
 277                 DBG(1,"SETUP_RT_FRAME: 2\n");
 278                 compat_val = (compat_int_t)current->sas_ss_size;
 279                 err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_size);
 280                 DBG(1,"SETUP_RT_FRAME: 3\n");
 281                 compat_val = sas_ss_flags(regs->gr[30]);
 282                 err |= __put_user(compat_val, &compat_frame->uc.uc_stack.ss_flags);
 283                 DBG(1,"setup_rt_frame: frame->uc = 0x%p\n", &compat_frame->uc);
 284                 DBG(1,"setup_rt_frame: frame->uc.uc_mcontext = 0x%p\n", &compat_frame->uc.uc_mcontext);
 285                 err |= setup_sigcontext32(&compat_frame->uc.uc_mcontext,
 286                                         &compat_frame->regs, regs, in_syscall);
 287                 sigset_64to32(&compat_set,set);
 288                 err |= __copy_to_user(&compat_frame->uc.uc_sigmask, &compat_set, sizeof(compat_set));
 289         } else
 290 #endif
 291         {
 292                 DBG(1,"setup_rt_frame: frame->info = 0x%p\n", &frame->info);
 293                 err |= copy_siginfo_to_user(&frame->info, info);
 294                 err |= __put_user(current->sas_ss_sp, &frame->uc.uc_stack.ss_sp);
 295                 err |= __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size);
 296                 err |= __put_user(sas_ss_flags(regs->gr[30]),
 297                                   &frame->uc.uc_stack.ss_flags);
 298                 DBG(1,"setup_rt_frame: frame->uc = 0x%p\n", &frame->uc);
 299                 DBG(1,"setup_rt_frame: frame->uc.uc_mcontext = 0x%p\n", &frame->uc.uc_mcontext);
 300                 err |= setup_sigcontext(&frame->uc.uc_mcontext, regs, in_syscall);
 301                 /* FIXME: Should probably be converted aswell for the compat case */
 302                 err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
 303         }
 304
 305         if (err)
 306                 goto give_sigsegv;
 307
 308         /* Set up to return from userspace.  If provided, use a stub
 309            already in userspace. The first words of tramp are used to
 310            save the previous sigrestartblock trampoline that might be
 311            on the stack. We start the sigreturn trampoline at
 312            SIGRESTARTBLOCK_TRAMP+X. */
 313         err |= __put_user(in_syscall ? INSN_LDI_R25_1 : INSN_LDI_R25_0,
 314                         &frame->tramp[SIGRESTARTBLOCK_TRAMP+0]);
 315         err |= __put_user(INSN_LDI_R20,
 316                         &frame->tramp[SIGRESTARTBLOCK_TRAMP+1]);
 317         err |= __put_user(INSN_BLE_SR2_R0,
 318                         &frame->tramp[SIGRESTARTBLOCK_TRAMP+2]);
 319         err |= __put_user(INSN_NOP, &frame->tramp[SIGRESTARTBLOCK_TRAMP+3]);
 320
 321 #if DEBUG_SIG
 322         /* Assert that we're flushing in the correct space... */
 323         {
 324                 int sid;
 325                 asm ("mfsp %%sr3,%0" : "=r" (sid));
 326                 DBG(1,"setup_rt_frame: Flushing 64 bytes at space %#x offset %p\n",
 327                        sid, frame->tramp);
 328         }
 329 #endif
 330
 331         flush_user_dcache_range((unsigned long) &frame->tramp[0],
 332                            (unsigned long) &frame->tramp[TRAMP_SIZE]);
 333         flush_user_icache_range((unsigned long) &frame->tramp[0],
 334                            (unsigned long) &frame->tramp[TRAMP_SIZE]);
 335
 336         /* TRAMP Words 0-4, Length 5 = SIGRESTARTBLOCK_TRAMP
 337          * TRAMP Words 5-9, Length 4 = SIGRETURN_TRAMP
 338          * So the SIGRETURN_TRAMP is at the end of SIGRESTARTBLOCK_TRAMP
 339          */
 340         rp = (unsigned long) &frame->tramp[SIGRESTARTBLOCK_TRAMP];
 341
 342         if (err)
 343                 goto give_sigsegv;
 344
 345         haddr = A(ka->sa.sa_handler);
 346         /* The sa_handler may be a pointer to a function descriptor */
 347 #ifdef CONFIG_64BIT
 348         if (is_compat_task()) {
 349 #endif
 350                 if (haddr & PA_PLABEL_FDESC) {
 351                         Elf32_Fdesc fdesc;
 352                         Elf32_Fdesc __user *ufdesc = (Elf32_Fdesc __user *)A(haddr & ~3);
 353
 354                         err = __copy_from_user(&fdesc, ufdesc, sizeof(fdesc));
 355
 356                         if (err)
 357                                 goto give_sigsegv;
 358
 359                         haddr = fdesc.addr;
 360                         regs->gr[19] = fdesc.gp;
 361                 }
 362 #ifdef CONFIG_64BIT
 363         } else {
 364                 Elf64_Fdesc fdesc;
 365                 Elf64_Fdesc __user *ufdesc = (Elf64_Fdesc __user *)A(haddr & ~3);
 366
 367                 err = __copy_from_user(&fdesc, ufdesc, sizeof(fdesc));
 368
 369                 if (err)
 370                         goto give_sigsegv;
 371
 372                 haddr = fdesc.addr;
 373                 regs->gr[19] = fdesc.gp;
 374                 DBG(1,"setup_rt_frame: 64 bit signal, exe=%#lx, r19=%#lx, in_syscall=%d\n",
 375                      haddr, regs->gr[19], in_syscall);
 376         }
 377 #endif
 378
 379         /* The syscall return path will create IAOQ values from r31.
 380          */
 381         sigframe_size = PARISC_RT_SIGFRAME_SIZE;
 382 #ifdef CONFIG_64BIT
 383         if (is_compat_task())
 384                 sigframe_size = PARISC_RT_SIGFRAME_SIZE32;
 385 #endif
 386         if (in_syscall) {
 387                 regs->gr[31] = haddr;
 388 #ifdef CONFIG_64BIT
 389                 if (!test_thread_flag(TIF_32BIT))
 390                         sigframe_size |= 1;
 391 #endif
 392         } else {
 393                 unsigned long psw = USER_PSW;
 394 #ifdef CONFIG_64BIT
 395                 if (!test_thread_flag(TIF_32BIT))
 396                         psw |= PSW_W;
 397 #endif
 398
 399                 /* If we are singlestepping, arrange a trap to be delivered
 400                    when we return to userspace. Note the semantics -- we
 401                    should trap before the first insn in the handler is
 402                    executed. Ref:
 403                         http://sources.redhat.com/ml/gdb/2004-11/msg00245.html
 404                  */
 405                 if (pa_psw(current)->r) {
 406                         pa_psw(current)->r = 0;
 407                         psw |= PSW_R;
 408                         mtctl(-1, 0);
 409                 }
 410
 411                 regs->gr[0] = psw;
 412                 regs->iaoq[0] = haddr | 3;
 413                 regs->iaoq[1] = regs->iaoq[0] + 4;
 414         }
 415
 416         regs->gr[2]  = rp;                /* userland return pointer */
 417         regs->gr[26] = sig;               /* signal number */
 418
 419 #ifdef CONFIG_64BIT
 420         if (is_compat_task()) {
 421                 regs->gr[25] = A(&compat_frame->info); /* siginfo pointer */
 422                 regs->gr[24] = A(&compat_frame->uc);   /* ucontext pointer */
 423         } else
 424 #endif
 425         {
 426                 regs->gr[25] = A(&frame->info); /* siginfo pointer */
 427                 regs->gr[24] = A(&frame->uc);   /* ucontext pointer */
 428         }
 429
 430         DBG(1,"setup_rt_frame: making sigreturn frame: %#lx + %#lx = %#lx\n",
 431                regs->gr[30], sigframe_size,
 432                regs->gr[30] + sigframe_size);
 433         /* Raise the user stack pointer to make a proper call frame. */
 434         regs->gr[30] = (A(frame) + sigframe_size);
 435
 436
 437         DBG(1,"setup_rt_frame: sig deliver (%s,%d) frame=0x%p sp=%#lx iaoq=%#lx/%#lx rp=%#lx\n",
 438                current->comm, current->pid, frame, regs->gr[30],
 439                regs->iaoq[0], regs->iaoq[1], rp);
 440
 441         return 1;
 442
 443 give_sigsegv:
 444         DBG(1,"setup_rt_frame: sending SIGSEGV\n");
 445         force_sigsegv(sig, current);
 446         return 0;
 447 }
 448
 449 /*
 450  * OK, we're invoking a handler.
 451  */
 452
 453 static long
 454 handle_signal(unsigned long sig, siginfo_t *info, struct k_sigaction *ka,
 455                 sigset_t *oldset, struct pt_regs *regs, int in_syscall)
 456 {
 457         DBG(1,"handle_signal: sig=%ld, ka=%p, info=%p, oldset=%p, regs=%p\n",
 458                sig, ka, info, oldset, regs);
 459
 460         /* Set up the stack frame */
 461         if (!setup_rt_frame(sig, ka, info, oldset, regs, in_syscall))
 462                 return 0;
 463
 464         spin_lock_irq(&current->sighand->siglock);
 465         sigorsets(&current->blocked,&current->blocked,&ka->sa.sa_mask);
 466         if (!(ka->sa.sa_flags & SA_NODEFER))
 467                 sigaddset(&current->blocked,sig);
 468         recalc_sigpending();
 469         spin_unlock_irq(&current->sighand->siglock);
 470         return 1;
 471 }
 472
 473 static inline void
 474 syscall_restart(struct pt_regs *regs, struct k_sigaction *ka)
 475 {
 476         /* Check the return code */
 477         switch (regs->gr[28]) {
 478         case -ERESTART_RESTARTBLOCK:
 479                 current_thread_info()->restart_block.fn =
 480                         do_no_restart_syscall;
 481         case -ERESTARTNOHAND:
 482                 DBG(1,"ERESTARTNOHAND: returning -EINTR\n");
 483                 regs->gr[28] = -EINTR;
 484                 break;
 485
 486         case -ERESTARTSYS:
 487                 if (!(ka->sa.sa_flags & SA_RESTART)) {
 488                         DBG(1,"ERESTARTSYS: putting -EINTR\n");
 489                         regs->gr[28] = -EINTR;
 490                         break;
 491                 }
 492                 /* fallthrough */
 493         case -ERESTARTNOINTR:
 494                 /* A syscall is just a branch, so all
 495                  * we have to do is fiddle the return pointer.
 496                  */
 497                 regs->gr[31] -= 8; /* delayed branching */
 498                 /* Preserve original r28. */
 499                 regs->gr[28] = regs->orig_r28;
 500                 break;
 501         }
 502 }
 503
 504 static inline void
 505 insert_restart_trampoline(struct pt_regs *regs)
 506 {
 507         switch(regs->gr[28]) {
 508         case -ERESTART_RESTARTBLOCK: {
 509                 /* Restart the system call - no handlers present */
 510                 unsigned int *usp = (unsigned int *)regs->gr[30];
 511
 512                 /* Setup a trampoline to restart the syscall
 513                  * with __NR_restart_syscall
 514                  *
 515                  *  0: <return address (orig r31)>
 516                  *  4: <2nd half for 64-bit>
 517                  *  8: ldw 0(%sp), %r31
 518                  * 12: be 0x100(%sr2, %r0)
 519                  * 16: ldi __NR_restart_syscall, %r20
 520                  */
 521 #ifdef CONFIG_64BIT
 522                 put_user(regs->gr[31] >> 32, &usp[0]);
 523                 put_user(regs->gr[31] & 0xffffffff, &usp[1]);
 524                 put_user(0x0fc010df, &usp[2]);
 525 #else
 526                 put_user(regs->gr[31], &usp[0]);
 527                 put_user(0x0fc0109f, &usp[2]);
 528 #endif
 529                 put_user(0xe0008200, &usp[3]);
 530                 put_user(0x34140000, &usp[4]);
 531
 532                 /* Stack is 64-byte aligned, and we only need
 533                  * to flush 1 cache line.
 534                  * Flushing one cacheline is cheap.
 535                  * "sync" on bigger (> 4 way) boxes is not.
 536                  */
 537                 flush_user_dcache_range(regs->gr[30], regs->gr[30] + 4);
 538                 flush_user_icache_range(regs->gr[30], regs->gr[30] + 4);
 539
 540                 regs->gr[31] = regs->gr[30] + 8;
 541                 /* Preserve original r28. */
 542                 regs->gr[28] = regs->orig_r28;
 543
 544                 return;
 545         }
 546         case -ERESTARTNOHAND:
 547         case -ERESTARTSYS:
 548         case -ERESTARTNOINTR: {
 549                 /* Hooray for delayed branching.  We don't
 550                  * have to restore %r20 (the system call
 551                  * number) because it gets loaded in the delay
 552                  * slot of the branch external instruction.
 553                  */
 554                 regs->gr[31] -= 8;
 555                 /* Preserve original r28. */
 556                 regs->gr[28] = regs->orig_r28;
 557
 558                 return;
 559         }
 560         default:
 561                 break;
 562         }
 563 }
 564
 565 /*
 566  * Note that 'init' is a special process: it doesn't get signals it doesn't
 567  * want to handle. Thus you cannot kill init even with a SIGKILL even by
 568  * mistake.
 569  *
 570  * We need to be able to restore the syscall arguments (r21-r26) to
 571  * restart syscalls.  Thus, the syscall path should save them in the
 572  * pt_regs structure (it's okay to do so since they are caller-save
 573  * registers).  As noted below, the syscall number gets restored for
 574  * us due to the magic of delayed branching.
 575  */
 576 asmlinkage void
 577 do_signal(struct pt_regs *regs, long in_syscall)
 578 {
 579         siginfo_t info;
 580         struct k_sigaction ka;
 581         int signr;
 582         sigset_t *oldset;
 583
 584         DBG(1,"\ndo_signal: oldset=0x%p, regs=0x%p, sr7 %#lx, in_syscall=%d\n",
 585                oldset, regs, regs->sr[7], in_syscall);
 586
 587         /* Everyone else checks to see if they are in kernel mode at
 588            this point and exits if that's the case.  I'm not sure why
 589            we would be called in that case, but for some reason we
 590            are. */
 591
 592         if (test_thread_flag(TIF_RESTORE_SIGMASK))
 593                 oldset = &current->saved_sigmask;
 594         else
 595                 oldset = &current->blocked;
 596
 597         DBG(1,"do_signal: oldset %08lx / %08lx\n",
 598                 oldset->sig[0], oldset->sig[1]);
 599
 600
 601         /* May need to force signal if handle_signal failed to deliver */
 602         while (1) {
 603
 604                 signr = get_signal_to_deliver(&info, &ka, regs, NULL);
 605                 DBG(3,"do_signal: signr = %d, regs->gr[28] = %ld\n", signr, regs->gr[28]);
 606
 607                 if (signr <= 0)
 608                   break;
 609
 610                 /* Restart a system call if necessary. */
 611                 if (in_syscall)
 612                         syscall_restart(regs, &ka);
 613
 614                 /* Whee!  Actually deliver the signal.  If the
 615                    delivery failed, we need to continue to iterate in
 616                    this loop so we can deliver the SIGSEGV... */
 617                 if (handle_signal(signr, &info, &ka, oldset,
 618                                   regs, in_syscall)) {
 619                         DBG(1,KERN_DEBUG "do_signal: Exit (success), regs->gr[28] = %ld\n",
 620                                 regs->gr[28]);
 621                         if (test_thread_flag(TIF_RESTORE_SIGMASK))
 622                                 clear_thread_flag(TIF_RESTORE_SIGMASK);
 623                         return;
 624                 }
 625         }
 626         /* end of while(1) looping forever if we can't force a signal */
 627
 628         /* Did we come from a system call? */
 629         if (in_syscall)
 630                 insert_restart_trampoline(regs);
 631
 632         DBG(1,"do_signal: Exit (not delivered), regs->gr[28] = %ld\n",
 633                 regs->gr[28]);
 634
 635         if (test_thread_flag(TIF_RESTORE_SIGMASK)) {
 636                 clear_thread_flag(TIF_RESTORE_SIGMASK);
 637                 sigprocmask(SIG_SETMASK, &current->saved_sigmask, NULL);
 638         }
 639
 640         return;
 641 }
 642
 643 void do_notify_resume(struct pt_regs *regs, long in_syscall)
 644 {
 645         if (test_thread_flag(TIF_SIGPENDING) ||
 646             test_thread_flag(TIF_RESTORE_SIGMASK))
 647                 do_signal(regs, in_syscall);
 648 }