arch/microblaze/kernel/signal.c

   1 /*
   2  * Signal handling
   3  *
   4  * Copyright (C) 2008-2009 Michal Simek <monstr@monstr.eu>
   5  * Copyright (C) 2008-2009 PetaLogix
   6  * Copyright (C) 2003,2004 John Williams <jwilliams@itee.uq.edu.au>
   7  * Copyright (C) 2001 NEC Corporation
   8  * Copyright (C) 2001 Miles Bader <miles@gnu.org>
   9  * Copyright (C) 1999,2000 Niibe Yutaka & Kaz Kojima
  10  * Copyright (C) 1991,1992 Linus Torvalds
  11  *
  12  * 1997-11-28 Modified for POSIX.1b signals by Richard Henderson
  13  *
  14  * This file was was derived from the sh version, arch/sh/kernel/signal.c
  15  *
  16  * This file is subject to the terms and conditions of the GNU General
  17  * Public License. See the file COPYING in the main directory of this
  18  * archive for more details.
  19  */
  20
  21 #include <linux/sched.h>
  22 #include <linux/mm.h>
  23 #include <linux/smp.h>
  24 #include <linux/smp_lock.h>
  25 #include <linux/kernel.h>
  26 #include <linux/signal.h>
  27 #include <linux/errno.h>
  28 #include <linux/wait.h>
  29 #include <linux/ptrace.h>
  30 #include <linux/unistd.h>
  31 #include <linux/stddef.h>
  32 #include <linux/personality.h>
  33 #include <linux/percpu.h>
  34 #include <linux/linkage.h>
  35 #include <asm/entry.h>
  36 #include <asm/ucontext.h>
  37 #include <linux/uaccess.h>
  38 #include <asm/pgtable.h>
  39 #include <asm/pgalloc.h>
  40 #include <linux/signal.h>
  41 #include <linux/syscalls.h>
  42 #include <asm/cacheflush.h>
  43 #include <asm/syscalls.h>
  44
  45 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
  46
  47 asmlinkage int do_signal(struct pt_regs *regs, sigset_t *oldset, int in_sycall);
  48
  49 /*
  50  * Atomically swap in the new signal mask, and wait for a signal.
  51  */
  52 asmlinkage int
  53 sys_sigsuspend(old_sigset_t mask, struct pt_regs *regs)
  54 {
  55         sigset_t saveset;
  56
  57         mask &= _BLOCKABLE;
  58         spin_lock_irq(&current->sighand->siglock);
  59         saveset = current->blocked;
  60         siginitset(&current->blocked, mask);
  61         recalc_sigpending();
  62         spin_unlock_irq(&current->sighand->siglock);
  63
  64         regs->r3 = -EINTR;
  65         while (1) {
  66                 current->state = TASK_INTERRUPTIBLE;
  67                 schedule();
  68                 if (do_signal(regs, &saveset, 1))
  69                         return -EINTR;
  70         }
  71 }
  72
  73 asmlinkage int
  74 sys_rt_sigsuspend(sigset_t __user *unewset, size_t sigsetsize,
  75                 struct pt_regs *regs)
  76 {
  77         sigset_t saveset, newset;
  78
  79         /* XXX: Don't preclude handling different sized sigset_t's. */
  80         if (sigsetsize != sizeof(sigset_t))
  81                 return -EINVAL;
  82
  83         if (copy_from_user(&newset, unewset, sizeof(newset)))
  84                 return -EFAULT;
  85         sigdelsetmask(&newset, ~_BLOCKABLE);
  86         spin_lock_irq(&current->sighand->siglock);
  87         saveset = current->blocked;
  88         current->blocked = newset;
  89         recalc_sigpending();
  90         spin_unlock_irq(&current->sighand->siglock);
  91
  92         regs->r3 = -EINTR;
  93         while (1) {
  94                 current->state = TASK_INTERRUPTIBLE;
  95                 schedule();
  96                 if (do_signal(regs, &saveset, 1))
  97                         return -EINTR;
  98         }
  99 }
 100
 101 asmlinkage int
 102 sys_sigaction(int sig, const struct old_sigaction *act,
 103                 struct old_sigaction *oact)
 104 {
 105         struct k_sigaction new_ka, old_ka;
 106         int ret;
 107
 108         if (act) {
 109                 old_sigset_t mask;
 110                 if (!access_ok(VERIFY_READ, act, sizeof(*act)) ||
 111                         __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
 112                         __get_user(new_ka.sa.sa_restorer, &act->sa_restorer))
 113                         return -EFAULT;
 114                 __get_user(new_ka.sa.sa_flags, &act->sa_flags);
 115                 __get_user(mask, &act->sa_mask);
 116                 siginitset(&new_ka.sa.sa_mask, mask);
 117         }
 118
 119         ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
 120
 121         if (!ret && oact) {
 122                 if (!access_ok(VERIFY_WRITE, oact, sizeof(*oact)) ||
 123                         __put_user(old_ka.sa.sa_handler, &oact->sa_handler) ||
 124                         __put_user(old_ka.sa.sa_restorer, &oact->sa_restorer))
 125                         return -EFAULT;
 126                 __put_user(old_ka.sa.sa_flags, &oact->sa_flags);
 127                 __put_user(old_ka.sa.sa_mask.sig[0], &oact->sa_mask);
 128         }
 129
 130         return ret;
 131 }
 132
 133 asmlinkage int
 134 sys_sigaltstack(const stack_t __user *uss, stack_t __user *uoss,
 135                 struct pt_regs *regs)
 136 {
 137         return do_sigaltstack(uss, uoss, regs->r1);
 138 }
 139
 140 /*
 141  * Do a signal return; undo the signal stack.
 142  */
 143
 144 struct sigframe {
 145         struct sigcontext sc;
 146         unsigned long extramask[_NSIG_WORDS-1];
 147         unsigned long tramp[2]; /* signal trampoline */
 148 };
 149
 150 struct rt_sigframe {
 151         struct siginfo info;
 152         struct ucontext uc;
 153         unsigned long tramp[2]; /* signal trampoline */
 154 };
 155
 156 static int
 157 restore_sigcontext(struct pt_regs *regs, struct sigcontext *sc, int *rval_p)
 158 {
 159         unsigned int err = 0;
 160
 161 #define COPY(x)         {err |= __get_user(regs->x, &sc->regs.x); }
 162         COPY(r0);
 163         COPY(r1);
 164         COPY(r2);       COPY(r3);       COPY(r4);       COPY(r5);
 165         COPY(r6);       COPY(r7);       COPY(r8);       COPY(r9);
 166         COPY(r10);      COPY(r11);      COPY(r12);      COPY(r13);
 167         COPY(r14);      COPY(r15);      COPY(r16);      COPY(r17);
 168         COPY(r18);      COPY(r19);      COPY(r20);      COPY(r21);
 169         COPY(r22);      COPY(r23);      COPY(r24);      COPY(r25);
 170         COPY(r26);      COPY(r27);      COPY(r28);      COPY(r29);
 171         COPY(r30);      COPY(r31);
 172         COPY(pc);       COPY(ear);      COPY(esr);      COPY(fsr);
 173 #undef COPY
 174
 175         *rval_p = regs->r3;
 176
 177         return err;
 178 }
 179
 180 asmlinkage int sys_sigreturn(struct pt_regs *regs)
 181 {
 182         struct sigframe *frame = (struct sigframe *)regs->r1;
 183         sigset_t set;
 184         int rval;
 185
 186         if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
 187                 goto badframe;
 188
 189         if (__get_user(set.sig[0], &frame->sc.oldmask)
 190                 || (_NSIG_WORDS > 1
 191                 && __copy_from_user(&set.sig[1], &frame->extramask,
 192                                         sizeof(frame->extramask))))
 193                 goto badframe;
 194
 195         sigdelsetmask(&set, ~_BLOCKABLE);
 196
 197         spin_lock_irq(&current->sighand->siglock);
 198         current->blocked = set;
 199         recalc_sigpending();
 200         spin_unlock_irq(&current->sighand->siglock);
 201
 202         if (restore_sigcontext(regs, &frame->sc, &rval))
 203                 goto badframe;
 204         return rval;
 205
 206 badframe:
 207         force_sig(SIGSEGV, current);
 208         return 0;
 209 }
 210
 211 asmlinkage int sys_rt_sigreturn(struct pt_regs *regs)
 212 {
 213         struct rt_sigframe *frame = (struct rt_sigframe *)regs->r1;
 214         sigset_t set;
 215         stack_t st;
 216         int rval;
 217
 218         if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
 219                 goto badframe;
 220
 221         if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
 222                 goto badframe;
 223
 224         sigdelsetmask(&set, ~_BLOCKABLE);
 225         spin_lock_irq(&current->sighand->siglock);
 226         current->blocked = set;
 227         recalc_sigpending();
 228         spin_unlock_irq(&current->sighand->siglock);
 229
 230         if (restore_sigcontext(regs, &frame->uc.uc_mcontext, &rval))
 231                 goto badframe;
 232
 233         if (__copy_from_user((void *)&st, &frame->uc.uc_stack, sizeof(st)))
 234                 goto badframe;
 235         /* It is more difficult to avoid calling this function than to
 236          call it and ignore errors. */
 237         do_sigaltstack(&st, NULL, regs->r1);
 238
 239         return rval;
 240
 241 badframe:
 242         force_sig(SIGSEGV, current);
 243         return 0;
 244 }
 245
 246 /*
 247  * Set up a signal frame.
 248  */
 249
 250 static int
 251 setup_sigcontext(struct sigcontext *sc, struct pt_regs *regs,
 252                 unsigned long mask)
 253 {
 254         int err = 0;
 255
 256 #define COPY(x)         {err |= __put_user(regs->x, &sc->regs.x); }
 257         COPY(r0);
 258         COPY(r1);
 259         COPY(r2);       COPY(r3);       COPY(r4);       COPY(r5);
 260         COPY(r6);       COPY(r7);       COPY(r8);       COPY(r9);
 261         COPY(r10);      COPY(r11);      COPY(r12);      COPY(r13);
 262         COPY(r14);      COPY(r15);      COPY(r16);      COPY(r17);
 263         COPY(r18);      COPY(r19);      COPY(r20);      COPY(r21);
 264         COPY(r22);      COPY(r23);      COPY(r24);      COPY(r25);
 265         COPY(r26);      COPY(r27);      COPY(r28);      COPY(r29);
 266         COPY(r30);      COPY(r31);
 267         COPY(pc);       COPY(ear);      COPY(esr);      COPY(fsr);
 268 #undef COPY
 269
 270         err |= __put_user(mask, &sc->oldmask);
 271
 272         return err;
 273 }
 274
 275 /*
 276  * Determine which stack to use..
 277  */
 278 static inline void *
 279 get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, size_t frame_size)
 280 {
 281         /* Default to using normal stack */
 282         unsigned long sp = regs->r1;
 283
 284         if ((ka->sa.sa_flags & SA_ONSTACK) != 0 && !on_sig_stack(sp))
 285                 sp = current->sas_ss_sp + current->sas_ss_size;
 286
 287         return (void *)((sp - frame_size) & -8UL);
 288 }
 289
 290 static void setup_frame(int sig, struct k_sigaction *ka,
 291                         sigset_t *set, struct pt_regs *regs)
 292 {
 293         struct sigframe *frame;
 294         int err = 0;
 295         int signal;
 296
 297         frame = get_sigframe(ka, regs, sizeof(*frame));
 298
 299         if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
 300                 goto give_sigsegv;
 301
 302         signal = current_thread_info()->exec_domain
 303                 && current_thread_info()->exec_domain->signal_invmap
 304                 && sig < 32
 305                 ? current_thread_info()->exec_domain->signal_invmap[sig]
 306                 : sig;
 307
 308         err |= setup_sigcontext(&frame->sc, regs, set->sig[0]);
 309
 310         if (_NSIG_WORDS > 1) {
 311                 err |= __copy_to_user(frame->extramask, &set->sig[1],
 312                                         sizeof(frame->extramask));
 313         }
 314
 315         /* Set up to return from userspace. If provided, use a stub
 316          already in userspace. */
 317         /* minus 8 is offset to cater for "rtsd r15,8" offset */
 318         if (ka->sa.sa_flags & SA_RESTORER) {
 319                 regs->r15 = ((unsigned long)ka->sa.sa_restorer)-8;
 320         } else {
 321                 /* Note, these encodings are _big endian_! */
 322
 323                 /* addi r12, r0, __NR_sigreturn */
 324                 err |= __put_user(0x31800000 | __NR_sigreturn ,
 325                                 frame->tramp + 0);
 326                 /* brki r14, 0x8 */
 327                 err |= __put_user(0xb9cc0008, frame->tramp + 1);
 328
 329                 /* Return from sighandler will jump to the tramp.
 330                  Negative 8 offset because return is rtsd r15, 8 */
 331                 regs->r15 = ((unsigned long)frame->tramp)-8;
 332
 333                 __invalidate_cache_sigtramp((unsigned long)frame->tramp);
 334         }
 335
 336         if (err)
 337                 goto give_sigsegv;
 338
 339         /* Set up registers for signal handler */
 340         regs->r1 = (unsigned long) frame;
 341         /* Signal handler args: */
 342         regs->r5 = signal; /* Arg 0: signum */
 343         regs->r6 = (unsigned long) &frame->sc; /* arg 1: sigcontext */
 344
 345         /* Offset of 4 to handle microblaze rtid r14, 0 */
 346         regs->pc = (unsigned long)ka->sa.sa_handler;
 347
 348         set_fs(USER_DS);
 349
 350 #ifdef DEBUG_SIG
 351         printk(KERN_INFO "SIG deliver (%s:%d): sp=%p pc=%08lx\n",
 352                 current->comm, current->pid, frame, regs->pc);
 353 #endif
 354
 355         return;
 356
 357 give_sigsegv:
 358         if (sig == SIGSEGV)
 359                 ka->sa.sa_handler = SIG_DFL;
 360         force_sig(SIGSEGV, current);
 361 }
 362
 363 static void setup_rt_frame(int sig, struct k_sigaction *ka, siginfo_t *info,
 364                         sigset_t *set, struct pt_regs *regs)
 365 {
 366         struct rt_sigframe *frame;
 367         int err = 0;
 368         int signal;
 369
 370         frame = get_sigframe(ka, regs, sizeof(*frame));
 371
 372         if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
 373                 goto give_sigsegv;
 374
 375         signal = current_thread_info()->exec_domain
 376                 && current_thread_info()->exec_domain->signal_invmap
 377                 && sig < 32
 378                 ? current_thread_info()->exec_domain->signal_invmap[sig]
 379                 : sig;
 380
 381         err |= copy_siginfo_to_user(&frame->info, info);
 382
 383         /* Create the ucontext. */
 384         err |= __put_user(0, &frame->uc.uc_flags);
 385         err |= __put_user(0, &frame->uc.uc_link);
 386         err |= __put_user((void *)current->sas_ss_sp,
 387                         &frame->uc.uc_stack.ss_sp);
 388         err |= __put_user(sas_ss_flags(regs->r1),
 389                         &frame->uc.uc_stack.ss_flags);
 390         err |= __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size);
 391         err |= setup_sigcontext(&frame->uc.uc_mcontext,
 392                         regs, set->sig[0]);
 393         err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
 394
 395         /* Set up to return from userspace. If provided, use a stub
 396          already in userspace. */
 397         /* minus 8 is offset to cater for "rtsd r15,8" */
 398         if (ka->sa.sa_flags & SA_RESTORER) {
 399                 regs->r15 = ((unsigned long)ka->sa.sa_restorer)-8;
 400         } else {
 401                 /* addi r12, r0, __NR_sigreturn */
 402                 err |= __put_user(0x31800000 | __NR_rt_sigreturn ,
 403                                 frame->tramp + 0);
 404                 /* brki r14, 0x8 */
 405                 err |= __put_user(0xb9cc0008, frame->tramp + 1);
 406
 407                 /* Return from sighandler will jump to the tramp.
 408                  Negative 8 offset because return is rtsd r15, 8 */
 409                 regs->r15 = ((unsigned long)frame->tramp)-8;
 410
 411                 __invalidate_cache_sigtramp((unsigned long)frame->tramp);
 412         }
 413
 414         if (err)
 415                 goto give_sigsegv;
 416
 417         /* Set up registers for signal handler */
 418         regs->r1 = (unsigned long) frame;
 419         /* Signal handler args: */
 420         regs->r5 = signal; /* arg 0: signum */
 421         regs->r6 = (unsigned long) &frame->info; /* arg 1: siginfo */
 422         regs->r7 = (unsigned long) &frame->uc; /* arg2: ucontext */
 423         /* Offset to handle microblaze rtid r14, 0 */
 424         regs->pc = (unsigned long)ka->sa.sa_handler;
 425
 426         set_fs(USER_DS);
 427
 428 #ifdef DEBUG_SIG
 429         printk(KERN_INFO "SIG deliver (%s:%d): sp=%p pc=%08lx\n",
 430                 current->comm, current->pid, frame, regs->pc);
 431 #endif
 432
 433         return;
 434
 435 give_sigsegv:
 436         if (sig == SIGSEGV)
 437                 ka->sa.sa_handler = SIG_DFL;
 438         force_sig(SIGSEGV, current);
 439 }
 440
 441 /* Handle restarting system calls */
 442 static inline void
 443 handle_restart(struct pt_regs *regs, struct k_sigaction *ka, int has_handler)
 444 {
 445         switch (regs->r3) {
 446         case -ERESTART_RESTARTBLOCK:
 447         case -ERESTARTNOHAND:
 448                 if (!has_handler)
 449                         goto do_restart;
 450                 regs->r3 = -EINTR;
 451                 break;
 452         case -ERESTARTSYS:
 453                 if (has_handler && !(ka->sa.sa_flags & SA_RESTART)) {
 454                         regs->r3 = -EINTR;
 455                         break;
 456         }
 457         /* fallthrough */
 458         case -ERESTARTNOINTR:
 459 do_restart:
 460                 /* offset of 4 bytes to re-execute trap (brki) instruction */
 461                 regs->pc -= 4;
 462                 break;
 463         }
 464 }
 465
 466 /*
 467  * OK, we're invoking a handler
 468  */
 469
 470 static void
 471 handle_signal(unsigned long sig, struct k_sigaction *ka,
 472                 siginfo_t *info, sigset_t *oldset, struct pt_regs *regs)
 473 {
 474         /* Set up the stack frame */
 475         if (ka->sa.sa_flags & SA_SIGINFO)
 476                 setup_rt_frame(sig, ka, info, oldset, regs);
 477         else
 478                 setup_frame(sig, ka, oldset, regs);
 479
 480         if (ka->sa.sa_flags & SA_ONESHOT)
 481                 ka->sa.sa_handler = SIG_DFL;
 482
 483         if (!(ka->sa.sa_flags & SA_NODEFER)) {
 484                 spin_lock_irq(&current->sighand->siglock);
 485                 sigorsets(&current->blocked,
 486                                 &current->blocked, &ka->sa.sa_mask);
 487                 sigaddset(&current->blocked, sig);
 488                 recalc_sigpending();
 489                 spin_unlock_irq(&current->sighand->siglock);
 490         }
 491 }
 492
 493 /*
 494  * Note that 'init' is a special process: it doesn't get signals it doesn't
 495  * want to handle. Thus you cannot kill init even with a SIGKILL even by
 496  * mistake.
 497  *
 498  * Note that we go through the signals twice: once to check the signals that
 499  * the kernel can handle, and then we build all the user-level signal handling
 500  * stack-frames in one go after that.
 501  */
 502 int do_signal(struct pt_regs *regs, sigset_t *oldset, int in_syscall)
 503 {
 504         siginfo_t info;
 505         int signr;
 506         struct k_sigaction ka;
 507 #ifdef DEBUG_SIG
 508         printk(KERN_INFO "do signal: %p %p %d\n", regs, oldset, in_syscall);
 509         printk(KERN_INFO "do signal2: %lx %lx %ld [%lx]\n", regs->pc, regs->r1,
 510                         regs->r12, current_thread_info()->flags);
 511 #endif
 512         /*
 513          * We want the common case to go fast, which
 514          * is why we may in certain cases get here from
 515          * kernel mode. Just return without doing anything
 516          * if so.
 517          */
 518         if (kernel_mode(regs))
 519                 return 1;
 520
 521         if (!oldset)
 522                 oldset = &current->blocked;
 523
 524         signr = get_signal_to_deliver(&info, &ka, regs, NULL);
 525         if (signr > 0) {
 526                 /* Whee! Actually deliver the signal. */
 527                 if (in_syscall)
 528                         handle_restart(regs, &ka, 1);
 529                 handle_signal(signr, &ka, &info, oldset, regs);
 530                 return 1;
 531         }
 532
 533         if (in_syscall)
 534                 handle_restart(regs, NULL, 0);
 535
 536         /* Did we come from a system call? */
 537         return 0;
 538 }