signal.c 19 KB

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