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