arch/arm/kernel/signal.c

   1 /*
   2  *  linux/arch/arm/kernel/signal.c
   3  *
   4  *  Copyright (C) 1995-2002 Russell King
   5  *
   6  * This program is free software; you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License version 2 as
   8  * published by the Free Software Foundation.
   9  */
  10 #include <linux/errno.h>
  11 #include <linux/signal.h>
  12 #include <linux/ptrace.h>
  13 #include <linux/personality.h>
  14 #include <linux/freezer.h>
  15
  16 #include <asm/cacheflush.h>
  17 #include <asm/ucontext.h>
  18 #include <asm/uaccess.h>
  19 #include <asm/unistd.h>
  20
  21 #include "ptrace.h"
  22 #include "signal.h"
  23
  24 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
  25
  26 /*
  27  * For ARM syscalls, we encode the syscall number into the instruction.
  28  */
  29 #define SWI_SYS_SIGRETURN       (0xef000000|(__NR_sigreturn))
  30 #define SWI_SYS_RT_SIGRETURN    (0xef000000|(__NR_rt_sigreturn))
  31
  32 /*
  33  * With EABI, the syscall number has to be loaded into r7.
  34  */
  35 #define MOV_R7_NR_SIGRETURN     (0xe3a07000 | (__NR_sigreturn - __NR_SYSCALL_BASE))
  36 #define MOV_R7_NR_RT_SIGRETURN  (0xe3a07000 | (__NR_rt_sigreturn - __NR_SYSCALL_BASE))
  37
  38 /*
  39  * For Thumb syscalls, we pass the syscall number via r7.  We therefore
  40  * need two 16-bit instructions.
  41  */
  42 #define SWI_THUMB_SIGRETURN     (0xdf00 << 16 | 0x2700 | (__NR_sigreturn - __NR_SYSCALL_BASE))
  43 #define SWI_THUMB_RT_SIGRETURN  (0xdf00 << 16 | 0x2700 | (__NR_rt_sigreturn - __NR_SYSCALL_BASE))
  44
  45 const unsigned long sigreturn_codes[7] = {
  46         MOV_R7_NR_SIGRETURN,    SWI_SYS_SIGRETURN,    SWI_THUMB_SIGRETURN,
  47         MOV_R7_NR_RT_SIGRETURN, SWI_SYS_RT_SIGRETURN, SWI_THUMB_RT_SIGRETURN,
  48 };
  49
  50 static int do_signal(sigset_t *oldset, struct pt_regs * regs, int syscall);
  51
  52 /*
  53  * atomically swap in the new signal mask, and wait for a signal.
  54  */
  55 asmlinkage int sys_sigsuspend(int restart, unsigned long oldmask, old_sigset_t mask, struct pt_regs *regs)
  56 {
  57         sigset_t saveset;
  58
  59         mask &= _BLOCKABLE;
  60         spin_lock_irq(&current->sighand->siglock);
  61         saveset = current->blocked;
  62         siginitset(&current->blocked, mask);
  63         recalc_sigpending();
  64         spin_unlock_irq(&current->sighand->siglock);
  65         regs->ARM_r0 = -EINTR;
  66
  67         while (1) {
  68                 current->state = TASK_INTERRUPTIBLE;
  69                 schedule();
  70                 if (do_signal(&saveset, regs, 0))
  71                         return regs->ARM_r0;
  72         }
  73 }
  74
  75 asmlinkage int
  76 sys_rt_sigsuspend(sigset_t __user *unewset, size_t sigsetsize, struct pt_regs *regs)
  77 {
  78         sigset_t saveset, newset;
  79
  80         /* XXX: Don't preclude handling different sized sigset_t's. */
  81         if (sigsetsize != sizeof(sigset_t))
  82                 return -EINVAL;
  83
  84         if (copy_from_user(&newset, unewset, sizeof(newset)))
  85                 return -EFAULT;
  86         sigdelsetmask(&newset, ~_BLOCKABLE);
  87
  88         spin_lock_irq(&current->sighand->siglock);
  89         saveset = current->blocked;
  90         current->blocked = newset;
  91         recalc_sigpending();
  92         spin_unlock_irq(&current->sighand->siglock);
  93         regs->ARM_r0 = -EINTR;
  94
  95         while (1) {
  96                 current->state = TASK_INTERRUPTIBLE;
  97                 schedule();
  98                 if (do_signal(&saveset, regs, 0))
  99                         return regs->ARM_r0;
 100         }
 101 }
 102
 103 asmlinkage int
 104 sys_sigaction(int sig, const struct old_sigaction __user *act,
 105               struct old_sigaction __user *oact)
 106 {
 107         struct k_sigaction new_ka, old_ka;
 108         int ret;
 109
 110         if (act) {
 111                 old_sigset_t mask;
 112                 if (!access_ok(VERIFY_READ, act, sizeof(*act)) ||
 113                     __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
 114                     __get_user(new_ka.sa.sa_restorer, &act->sa_restorer))
 115                         return -EFAULT;
 116                 __get_user(new_ka.sa.sa_flags, &act->sa_flags);
 117                 __get_user(mask, &act->sa_mask);
 118                 siginitset(&new_ka.sa.sa_mask, mask);
 119         }
 120
 121         ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
 122
 123         if (!ret && oact) {
 124                 if (!access_ok(VERIFY_WRITE, oact, sizeof(*oact)) ||
 125                     __put_user(old_ka.sa.sa_handler, &oact->sa_handler) ||
 126                     __put_user(old_ka.sa.sa_restorer, &oact->sa_restorer))
 127                         return -EFAULT;
 128                 __put_user(old_ka.sa.sa_flags, &oact->sa_flags);
 129                 __put_user(old_ka.sa.sa_mask.sig[0], &oact->sa_mask);
 130         }
 131
 132         return ret;
 133 }
 134
 135 #ifdef CONFIG_CRUNCH
 136 static int preserve_crunch_context(struct crunch_sigframe *frame)
 137 {
 138         char kbuf[sizeof(*frame) + 8];
 139         struct crunch_sigframe *kframe;
 140
 141         /* the crunch context must be 64 bit aligned */
 142         kframe = (struct crunch_sigframe *)((unsigned long)(kbuf + 8) & ~7);
 143         kframe->magic = CRUNCH_MAGIC;
 144         kframe->size = CRUNCH_STORAGE_SIZE;
 145         crunch_task_copy(current_thread_info(), &kframe->storage);
 146         return __copy_to_user(frame, kframe, sizeof(*frame));
 147 }
 148
 149 static int restore_crunch_context(struct crunch_sigframe *frame)
 150 {
 151         char kbuf[sizeof(*frame) + 8];
 152         struct crunch_sigframe *kframe;
 153
 154         /* the crunch context must be 64 bit aligned */
 155         kframe = (struct crunch_sigframe *)((unsigned long)(kbuf + 8) & ~7);
 156         if (__copy_from_user(kframe, frame, sizeof(*frame)))
 157                 return -1;
 158         if (kframe->magic != CRUNCH_MAGIC ||
 159             kframe->size != CRUNCH_STORAGE_SIZE)
 160                 return -1;
 161         crunch_task_restore(current_thread_info(), &kframe->storage);
 162         return 0;
 163 }
 164 #endif
 165
 166 #ifdef CONFIG_IWMMXT
 167
 168 static int preserve_iwmmxt_context(struct iwmmxt_sigframe *frame)
 169 {
 170         char kbuf[sizeof(*frame) + 8];
 171         struct iwmmxt_sigframe *kframe;
 172
 173         /* the iWMMXt context must be 64 bit aligned */
 174         kframe = (struct iwmmxt_sigframe *)((unsigned long)(kbuf + 8) & ~7);
 175         kframe->magic = IWMMXT_MAGIC;
 176         kframe->size = IWMMXT_STORAGE_SIZE;
 177         iwmmxt_task_copy(current_thread_info(), &kframe->storage);
 178         return __copy_to_user(frame, kframe, sizeof(*frame));
 179 }
 180
 181 static int restore_iwmmxt_context(struct iwmmxt_sigframe *frame)
 182 {
 183         char kbuf[sizeof(*frame) + 8];
 184         struct iwmmxt_sigframe *kframe;
 185
 186         /* the iWMMXt context must be 64 bit aligned */
 187         kframe = (struct iwmmxt_sigframe *)((unsigned long)(kbuf + 8) & ~7);
 188         if (__copy_from_user(kframe, frame, sizeof(*frame)))
 189                 return -1;
 190         if (kframe->magic != IWMMXT_MAGIC ||
 191             kframe->size != IWMMXT_STORAGE_SIZE)
 192                 return -1;
 193         iwmmxt_task_restore(current_thread_info(), &kframe->storage);
 194         return 0;
 195 }
 196
 197 #endif
 198
 199 /*
 200  * Do a signal return; undo the signal stack.  These are aligned to 64-bit.
 201  */
 202 struct sigframe {
 203         struct ucontext uc;
 204         unsigned long retcode[2];
 205 };
 206
 207 struct rt_sigframe {
 208         struct siginfo info;
 209         struct sigframe sig;
 210 };
 211
 212 static int restore_sigframe(struct pt_regs *regs, struct sigframe __user *sf)
 213 {
 214         struct aux_sigframe __user *aux;
 215         sigset_t set;
 216         int err;
 217
 218         err = __copy_from_user(&set, &sf->uc.uc_sigmask, sizeof(set));
 219         if (err == 0) {
 220                 sigdelsetmask(&set, ~_BLOCKABLE);
 221                 spin_lock_irq(&current->sighand->siglock);
 222                 current->blocked = set;
 223                 recalc_sigpending();
 224                 spin_unlock_irq(&current->sighand->siglock);
 225         }
 226
 227         __get_user_error(regs->ARM_r0, &sf->uc.uc_mcontext.arm_r0, err);
 228         __get_user_error(regs->ARM_r1, &sf->uc.uc_mcontext.arm_r1, err);
 229         __get_user_error(regs->ARM_r2, &sf->uc.uc_mcontext.arm_r2, err);
 230         __get_user_error(regs->ARM_r3, &sf->uc.uc_mcontext.arm_r3, err);
 231         __get_user_error(regs->ARM_r4, &sf->uc.uc_mcontext.arm_r4, err);
 232         __get_user_error(regs->ARM_r5, &sf->uc.uc_mcontext.arm_r5, err);
 233         __get_user_error(regs->ARM_r6, &sf->uc.uc_mcontext.arm_r6, err);
 234         __get_user_error(regs->ARM_r7, &sf->uc.uc_mcontext.arm_r7, err);
 235         __get_user_error(regs->ARM_r8, &sf->uc.uc_mcontext.arm_r8, err);
 236         __get_user_error(regs->ARM_r9, &sf->uc.uc_mcontext.arm_r9, err);
 237         __get_user_error(regs->ARM_r10, &sf->uc.uc_mcontext.arm_r10, err);
 238         __get_user_error(regs->ARM_fp, &sf->uc.uc_mcontext.arm_fp, err);
 239         __get_user_error(regs->ARM_ip, &sf->uc.uc_mcontext.arm_ip, err);
 240         __get_user_error(regs->ARM_sp, &sf->uc.uc_mcontext.arm_sp, err);
 241         __get_user_error(regs->ARM_lr, &sf->uc.uc_mcontext.arm_lr, err);
 242         __get_user_error(regs->ARM_pc, &sf->uc.uc_mcontext.arm_pc, err);
 243         __get_user_error(regs->ARM_cpsr, &sf->uc.uc_mcontext.arm_cpsr, err);
 244
 245         err |= !valid_user_regs(regs);
 246
 247         aux = (struct aux_sigframe __user *) sf->uc.uc_regspace;
 248 #ifdef CONFIG_CRUNCH
 249         if (err == 0)
 250                 err |= restore_crunch_context(&aux->crunch);
 251 #endif
 252 #ifdef CONFIG_IWMMXT
 253         if (err == 0 && test_thread_flag(TIF_USING_IWMMXT))
 254                 err |= restore_iwmmxt_context(&aux->iwmmxt);
 255 #endif
 256 #ifdef CONFIG_VFP
 257 //      if (err == 0)
 258 //              err |= vfp_restore_state(&sf->aux.vfp);
 259 #endif
 260
 261         return err;
 262 }
 263
 264 asmlinkage int sys_sigreturn(struct pt_regs *regs)
 265 {
 266         struct sigframe __user *frame;
 267
 268         /* Always make any pending restarted system calls return -EINTR */
 269         current_thread_info()->restart_block.fn = do_no_restart_syscall;
 270
 271         /*
 272          * Since we stacked the signal on a 64-bit boundary,
 273          * then 'sp' should be word aligned here.  If it's
 274          * not, then the user is trying to mess with us.
 275          */
 276         if (regs->ARM_sp & 7)
 277                 goto badframe;
 278
 279         frame = (struct sigframe __user *)regs->ARM_sp;
 280
 281         if (!access_ok(VERIFY_READ, frame, sizeof (*frame)))
 282                 goto badframe;
 283
 284         if (restore_sigframe(regs, frame))
 285                 goto badframe;
 286
 287         /* Send SIGTRAP if we're single-stepping */
 288         if (current->ptrace & PT_SINGLESTEP) {
 289                 ptrace_cancel_bpt(current);
 290                 send_sig(SIGTRAP, current, 1);
 291         }
 292
 293         return regs->ARM_r0;
 294
 295 badframe:
 296         force_sig(SIGSEGV, current);
 297         return 0;
 298 }
 299
 300 asmlinkage int sys_rt_sigreturn(struct pt_regs *regs)
 301 {
 302         struct rt_sigframe __user *frame;
 303
 304         /* Always make any pending restarted system calls return -EINTR */
 305         current_thread_info()->restart_block.fn = do_no_restart_syscall;
 306
 307         /*
 308          * Since we stacked the signal on a 64-bit boundary,
 309          * then 'sp' should be word aligned here.  If it's
 310          * not, then the user is trying to mess with us.
 311          */
 312         if (regs->ARM_sp & 7)
 313                 goto badframe;
 314
 315         frame = (struct rt_sigframe __user *)regs->ARM_sp;
 316
 317         if (!access_ok(VERIFY_READ, frame, sizeof (*frame)))
 318                 goto badframe;
 319
 320         if (restore_sigframe(regs, &frame->sig))
 321                 goto badframe;
 322
 323         if (do_sigaltstack(&frame->sig.uc.uc_stack, NULL, regs->ARM_sp) == -EFAULT)
 324                 goto badframe;
 325
 326         /* Send SIGTRAP if we're single-stepping */
 327         if (current->ptrace & PT_SINGLESTEP) {
 328                 ptrace_cancel_bpt(current);
 329                 send_sig(SIGTRAP, current, 1);
 330         }
 331
 332         return regs->ARM_r0;
 333
 334 badframe:
 335         force_sig(SIGSEGV, current);
 336         return 0;
 337 }
 338
 339 static int
 340 setup_sigframe(struct sigframe __user *sf, struct pt_regs *regs, sigset_t *set)
 341 {
 342         struct aux_sigframe __user *aux;
 343         int err = 0;
 344
 345         __put_user_error(regs->ARM_r0, &sf->uc.uc_mcontext.arm_r0, err);
 346         __put_user_error(regs->ARM_r1, &sf->uc.uc_mcontext.arm_r1, err);
 347         __put_user_error(regs->ARM_r2, &sf->uc.uc_mcontext.arm_r2, err);
 348         __put_user_error(regs->ARM_r3, &sf->uc.uc_mcontext.arm_r3, err);
 349         __put_user_error(regs->ARM_r4, &sf->uc.uc_mcontext.arm_r4, err);
 350         __put_user_error(regs->ARM_r5, &sf->uc.uc_mcontext.arm_r5, err);
 351         __put_user_error(regs->ARM_r6, &sf->uc.uc_mcontext.arm_r6, err);
 352         __put_user_error(regs->ARM_r7, &sf->uc.uc_mcontext.arm_r7, err);
 353         __put_user_error(regs->ARM_r8, &sf->uc.uc_mcontext.arm_r8, err);
 354         __put_user_error(regs->ARM_r9, &sf->uc.uc_mcontext.arm_r9, err);
 355         __put_user_error(regs->ARM_r10, &sf->uc.uc_mcontext.arm_r10, err);
 356         __put_user_error(regs->ARM_fp, &sf->uc.uc_mcontext.arm_fp, err);
 357         __put_user_error(regs->ARM_ip, &sf->uc.uc_mcontext.arm_ip, err);
 358         __put_user_error(regs->ARM_sp, &sf->uc.uc_mcontext.arm_sp, err);
 359         __put_user_error(regs->ARM_lr, &sf->uc.uc_mcontext.arm_lr, err);
 360         __put_user_error(regs->ARM_pc, &sf->uc.uc_mcontext.arm_pc, err);
 361         __put_user_error(regs->ARM_cpsr, &sf->uc.uc_mcontext.arm_cpsr, err);
 362
 363         __put_user_error(current->thread.trap_no, &sf->uc.uc_mcontext.trap_no, err);
 364         __put_user_error(current->thread.error_code, &sf->uc.uc_mcontext.error_code, err);
 365         __put_user_error(current->thread.address, &sf->uc.uc_mcontext.fault_address, err);
 366         __put_user_error(set->sig[0], &sf->uc.uc_mcontext.oldmask, err);
 367
 368         err |= __copy_to_user(&sf->uc.uc_sigmask, set, sizeof(*set));
 369
 370         aux = (struct aux_sigframe __user *) sf->uc.uc_regspace;
 371 #ifdef CONFIG_CRUNCH
 372         if (err == 0)
 373                 err |= preserve_crunch_context(&aux->crunch);
 374 #endif
 375 #ifdef CONFIG_IWMMXT
 376         if (err == 0 && test_thread_flag(TIF_USING_IWMMXT))
 377                 err |= preserve_iwmmxt_context(&aux->iwmmxt);
 378 #endif
 379 #ifdef CONFIG_VFP
 380 //      if (err == 0)
 381 //              err |= vfp_save_state(&sf->aux.vfp);
 382 #endif
 383         __put_user_error(0, &aux->end_magic, err);
 384
 385         return err;
 386 }
 387
 388 static inline void __user *
 389 get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, int framesize)
 390 {
 391         unsigned long sp = regs->ARM_sp;
 392         void __user *frame;
 393
 394         /*
 395          * This is the X/Open sanctioned signal stack switching.
 396          */
 397         if ((ka->sa.sa_flags & SA_ONSTACK) && !sas_ss_flags(sp))
 398                 sp = current->sas_ss_sp + current->sas_ss_size;
 399
 400         /*
 401          * ATPCS B01 mandates 8-byte alignment
 402          */
 403         frame = (void __user *)((sp - framesize) & ~7);
 404
 405         /*
 406          * Check that we can actually write to the signal frame.
 407          */
 408         if (!access_ok(VERIFY_WRITE, frame, framesize))
 409                 frame = NULL;
 410
 411         return frame;
 412 }
 413
 414 static int
 415 setup_return(struct pt_regs *regs, struct k_sigaction *ka,
 416              unsigned long __user *rc, void __user *frame, int usig)
 417 {
 418         unsigned long handler = (unsigned long)ka->sa.sa_handler;
 419         unsigned long retcode;
 420         int thumb = 0;
 421         unsigned long cpsr = regs->ARM_cpsr & ~PSR_f;
 422
 423         /*
 424          * Maybe we need to deliver a 32-bit signal to a 26-bit task.
 425          */
 426         if (ka->sa.sa_flags & SA_THIRTYTWO)
 427                 cpsr = (cpsr & ~MODE_MASK) | USR_MODE;
 428
 429 #ifdef CONFIG_ARM_THUMB
 430         if (elf_hwcap & HWCAP_THUMB) {
 431                 /*
 432                  * The LSB of the handler determines if we're going to
 433                  * be using THUMB or ARM mode for this signal handler.
 434                  */
 435                 thumb = handler & 1;
 436
 437                 if (thumb)
 438                         cpsr |= PSR_T_BIT;
 439                 else
 440                         cpsr &= ~PSR_T_BIT;
 441         }
 442 #endif
 443
 444         if (ka->sa.sa_flags & SA_RESTORER) {
 445                 retcode = (unsigned long)ka->sa.sa_restorer;
 446         } else {
 447                 unsigned int idx = thumb << 1;
 448
 449                 if (ka->sa.sa_flags & SA_SIGINFO)
 450                         idx += 3;
 451
 452                 if (__put_user(sigreturn_codes[idx],   rc) ||
 453                     __put_user(sigreturn_codes[idx+1], rc+1))
 454                         return 1;
 455
 456                 if (cpsr & MODE32_BIT) {
 457                         /*
 458                          * 32-bit code can use the new high-page
 459                          * signal return code support.
 460                          */
 461                         retcode = KERN_SIGRETURN_CODE + (idx << 2) + thumb;
 462                 } else {
 463                         /*
 464                          * Ensure that the instruction cache sees
 465                          * the return code written onto the stack.
 466                          */
 467                         flush_icache_range((unsigned long)rc,
 468                                            (unsigned long)(rc + 2));
 469
 470                         retcode = ((unsigned long)rc) + thumb;
 471                 }
 472         }
 473
 474         regs->ARM_r0 = usig;
 475         regs->ARM_sp = (unsigned long)frame;
 476         regs->ARM_lr = retcode;
 477         regs->ARM_pc = handler;
 478         regs->ARM_cpsr = cpsr;
 479
 480         return 0;
 481 }
 482
 483 static int
 484 setup_frame(int usig, struct k_sigaction *ka, sigset_t *set, struct pt_regs *regs)
 485 {
 486         struct sigframe __user *frame = get_sigframe(ka, regs, sizeof(*frame));
 487         int err = 0;
 488
 489         if (!frame)
 490                 return 1;
 491
 492         /*
 493          * Set uc.uc_flags to a value which sc.trap_no would never have.
 494          */
 495         __put_user_error(0x5ac3c35a, &frame->uc.uc_flags, err);
 496
 497         err |= setup_sigframe(frame, regs, set);
 498         if (err == 0)
 499                 err = setup_return(regs, ka, frame->retcode, frame, usig);
 500
 501         return err;
 502 }
 503
 504 static int
 505 setup_rt_frame(int usig, struct k_sigaction *ka, siginfo_t *info,
 506                sigset_t *set, struct pt_regs *regs)
 507 {
 508         struct rt_sigframe __user *frame = get_sigframe(ka, regs, sizeof(*frame));
 509         stack_t stack;
 510         int err = 0;
 511
 512         if (!frame)
 513                 return 1;
 514
 515         err |= copy_siginfo_to_user(&frame->info, info);
 516
 517         __put_user_error(0, &frame->sig.uc.uc_flags, err);
 518         __put_user_error(NULL, &frame->sig.uc.uc_link, err);
 519
 520         memset(&stack, 0, sizeof(stack));
 521         stack.ss_sp = (void __user *)current->sas_ss_sp;
 522         stack.ss_flags = sas_ss_flags(regs->ARM_sp);
 523         stack.ss_size = current->sas_ss_size;
 524         err |= __copy_to_user(&frame->sig.uc.uc_stack, &stack, sizeof(stack));
 525
 526         err |= setup_sigframe(&frame->sig, regs, set);
 527         if (err == 0)
 528                 err = setup_return(regs, ka, frame->sig.retcode, frame, usig);
 529
 530         if (err == 0) {
 531                 /*
 532                  * For realtime signals we must also set the second and third
 533                  * arguments for the signal handler.
 534                  *   -- Peter Maydell <pmaydell@chiark.greenend.org.uk> 2000-12-06
 535                  */
 536                 regs->ARM_r1 = (unsigned long)&frame->info;
 537                 regs->ARM_r2 = (unsigned long)&frame->sig.uc;
 538         }
 539
 540         return err;
 541 }
 542
 543 static inline void restart_syscall(struct pt_regs *regs)
 544 {
 545         regs->ARM_r0 = regs->ARM_ORIG_r0;
 546         regs->ARM_pc -= thumb_mode(regs) ? 2 : 4;
 547 }
 548
 549 /*
 550  * OK, we're invoking a handler
 551  */
 552 static void
 553 handle_signal(unsigned long sig, struct k_sigaction *ka,
 554               siginfo_t *info, sigset_t *oldset,
 555               struct pt_regs * regs, int syscall)
 556 {
 557         struct thread_info *thread = current_thread_info();
 558         struct task_struct *tsk = current;
 559         int usig = sig;
 560         int ret;
 561
 562         /*
 563          * If we were from a system call, check for system call restarting...
 564          */
 565         if (syscall) {
 566                 switch (regs->ARM_r0) {
 567                 case -ERESTART_RESTARTBLOCK:
 568                 case -ERESTARTNOHAND:
 569                         regs->ARM_r0 = -EINTR;
 570                         break;
 571                 case -ERESTARTSYS:
 572                         if (!(ka->sa.sa_flags & SA_RESTART)) {
 573                                 regs->ARM_r0 = -EINTR;
 574                                 break;
 575                         }
 576                         /* fallthrough */
 577                 case -ERESTARTNOINTR:
 578                         restart_syscall(regs);
 579                 }
 580         }
 581
 582         /*
 583          * translate the signal
 584          */
 585         if (usig < 32 && thread->exec_domain && thread->exec_domain->signal_invmap)
 586                 usig = thread->exec_domain->signal_invmap[usig];
 587
 588         /*
 589          * Set up the stack frame
 590          */
 591         if (ka->sa.sa_flags & SA_SIGINFO)
 592                 ret = setup_rt_frame(usig, ka, info, oldset, regs);
 593         else
 594                 ret = setup_frame(usig, ka, oldset, regs);
 595
 596         /*
 597          * Check that the resulting registers are actually sane.
 598          */
 599         ret |= !valid_user_regs(regs);
 600
 601         if (ret != 0) {
 602                 force_sigsegv(sig, tsk);
 603                 return;
 604         }
 605
 606         /*
 607          * Block the signal if we were successful.
 608          */
 609         spin_lock_irq(&tsk->sighand->siglock);
 610         sigorsets(&tsk->blocked, &tsk->blocked,
 611                   &ka->sa.sa_mask);
 612         if (!(ka->sa.sa_flags & SA_NODEFER))
 613                 sigaddset(&tsk->blocked, sig);
 614         recalc_sigpending();
 615         spin_unlock_irq(&tsk->sighand->siglock);
 616
 617 }
 618
 619 /*
 620  * Note that 'init' is a special process: it doesn't get signals it doesn't
 621  * want to handle. Thus you cannot kill init even with a SIGKILL even by
 622  * mistake.
 623  *
 624  * Note that we go through the signals twice: once to check the signals that
 625  * the kernel can handle, and then we build all the user-level signal handling
 626  * stack-frames in one go after that.
 627  */
 628 static int do_signal(sigset_t *oldset, struct pt_regs *regs, int syscall)
 629 {
 630         struct k_sigaction ka;
 631         siginfo_t info;
 632         int signr;
 633
 634         /*
 635          * We want the common case to go fast, which
 636          * is why we may in certain cases get here from
 637          * kernel mode. Just return without doing anything
 638          * if so.
 639          */
 640         if (!user_mode(regs))
 641                 return 0;
 642
 643         if (try_to_freeze())
 644                 goto no_signal;
 645
 646         if (current->ptrace & PT_SINGLESTEP)
 647                 ptrace_cancel_bpt(current);
 648
 649         signr = get_signal_to_deliver(&info, &ka, regs, NULL);
 650         if (signr > 0) {
 651                 handle_signal(signr, &ka, &info, oldset, regs, syscall);
 652                 if (current->ptrace & PT_SINGLESTEP)
 653                         ptrace_set_bpt(current);
 654                 return 1;
 655         }
 656
 657  no_signal:
 658         /*
 659          * No signal to deliver to the process - restart the syscall.
 660          */
 661         if (syscall) {
 662                 if (regs->ARM_r0 == -ERESTART_RESTARTBLOCK) {
 663                         if (thumb_mode(regs)) {
 664                                 regs->ARM_r7 = __NR_restart_syscall - __NR_SYSCALL_BASE;
 665                                 regs->ARM_pc -= 2;
 666                         } else {
 667 #if defined(CONFIG_AEABI) && !defined(CONFIG_OABI_COMPAT)
 668                                 regs->ARM_r7 = __NR_restart_syscall;
 669                                 regs->ARM_pc -= 4;
 670 #else
 671                                 u32 __user *usp;
 672                                 u32 swival = __NR_restart_syscall;
 673
 674                                 regs->ARM_sp -= 12;
 675                                 usp = (u32 __user *)regs->ARM_sp;
 676
 677                                 /*
 678                                  * Either we supports OABI only, or we have
 679                                  * EABI with the OABI compat layer enabled.
 680                                  * In the later case we don't know if user
 681                                  * space is EABI or not, and if not we must
 682                                  * not clobber r7.  Always using the OABI
 683                                  * syscall solves that issue and works for
 684                                  * all those cases.
 685                                  */
 686                                 swival = swival - __NR_SYSCALL_BASE + __NR_OABI_SYSCALL_BASE;
 687
 688                                 put_user(regs->ARM_pc, &usp[0]);
 689                                 /* swi __NR_restart_syscall */
 690                                 put_user(0xef000000 | swival, &usp[1]);
 691                                 /* ldr  pc, [sp], #12 */
 692                                 put_user(0xe49df00c, &usp[2]);
 693
 694                                 flush_icache_range((unsigned long)usp,
 695                                                    (unsigned long)(usp + 3));
 696
 697                                 regs->ARM_pc = regs->ARM_sp + 4;
 698 #endif
 699                         }
 700                 }
 701                 if (regs->ARM_r0 == -ERESTARTNOHAND ||
 702                     regs->ARM_r0 == -ERESTARTSYS ||
 703                     regs->ARM_r0 == -ERESTARTNOINTR) {
 704                         restart_syscall(regs);
 705                 }
 706         }
 707         if (current->ptrace & PT_SINGLESTEP)
 708                 ptrace_set_bpt(current);
 709         return 0;
 710 }
 711
 712 asmlinkage void
 713 do_notify_resume(struct pt_regs *regs, unsigned int thread_flags, int syscall)
 714 {
 715         if (thread_flags & _TIF_SIGPENDING)
 716                 do_signal(&current->blocked, regs, syscall);
 717 }