signal_no.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766
  1. /*
  2. * linux/arch/m68knommu/kernel/signal.c
  3. *
  4. * Copyright (C) 1991, 1992 Linus Torvalds
  5. *
  6. * This file is subject to the terms and conditions of the GNU General Public
  7. * License. See the file COPYING in the main directory of this archive
  8. * for more details.
  9. */
  10. /*
  11. * Linux/m68k support by Hamish Macdonald
  12. *
  13. * 68060 fixes by Jesper Skov
  14. *
  15. * 1997-12-01 Modified for POSIX.1b signals by Andreas Schwab
  16. *
  17. * mathemu support by Roman Zippel
  18. * (Note: fpstate in the signal context is completely ignored for the emulator
  19. * and the internal floating point format is put on stack)
  20. */
  21. /*
  22. * ++roman (07/09/96): implemented signal stacks (specially for tosemu on
  23. * Atari :-) Current limitation: Only one sigstack can be active at one time.
  24. * If a second signal with SA_ONSTACK set arrives while working on a sigstack,
  25. * SA_ONSTACK is ignored. This behaviour avoids lots of trouble with nested
  26. * signal handlers!
  27. */
  28. #include <linux/sched.h>
  29. #include <linux/mm.h>
  30. #include <linux/kernel.h>
  31. #include <linux/signal.h>
  32. #include <linux/syscalls.h>
  33. #include <linux/errno.h>
  34. #include <linux/wait.h>
  35. #include <linux/ptrace.h>
  36. #include <linux/unistd.h>
  37. #include <linux/stddef.h>
  38. #include <linux/highuid.h>
  39. #include <linux/tty.h>
  40. #include <linux/personality.h>
  41. #include <linux/binfmts.h>
  42. #include <asm/setup.h>
  43. #include <asm/uaccess.h>
  44. #include <asm/pgtable.h>
  45. #include <asm/traps.h>
  46. #include <asm/ucontext.h>
  47. #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
  48. void ret_from_user_signal(void);
  49. void ret_from_user_rt_signal(void);
  50. /*
  51. * Atomically swap in the new signal mask, and wait for a signal.
  52. */
  53. asmlinkage int
  54. sys_sigsuspend(int unused0, int unused1, old_sigset_t mask)
  55. {
  56. mask &= _BLOCKABLE;
  57. spin_lock_irq(&current->sighand->siglock);
  58. current->saved_sigmask = current->blocked;
  59. siginitset(&current->blocked, mask);
  60. recalc_sigpending();
  61. spin_unlock_irq(&current->sighand->siglock);
  62. current->state = TASK_INTERRUPTIBLE;
  63. schedule();
  64. set_restore_sigmask();
  65. return -ERESTARTNOHAND;
  66. }
  67. asmlinkage int
  68. sys_sigaction(int sig, const struct old_sigaction __user *act,
  69. struct old_sigaction __user *oact)
  70. {
  71. struct k_sigaction new_ka, old_ka;
  72. int ret;
  73. if (act) {
  74. old_sigset_t mask;
  75. if (!access_ok(VERIFY_READ, act, sizeof(*act)) ||
  76. __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
  77. __get_user(new_ka.sa.sa_restorer, &act->sa_restorer) ||
  78. __get_user(new_ka.sa.sa_flags, &act->sa_flags) ||
  79. __get_user(mask, &act->sa_mask))
  80. return -EFAULT;
  81. siginitset(&new_ka.sa.sa_mask, mask);
  82. }
  83. ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
  84. if (!ret && oact) {
  85. if (!access_ok(VERIFY_WRITE, oact, sizeof(*oact)) ||
  86. __put_user(old_ka.sa.sa_handler, &oact->sa_handler) ||
  87. __put_user(old_ka.sa.sa_restorer, &oact->sa_restorer) ||
  88. __put_user(old_ka.sa.sa_flags, &oact->sa_flags) ||
  89. __put_user(old_ka.sa.sa_mask.sig[0], &oact->sa_mask))
  90. return -EFAULT;
  91. }
  92. return ret;
  93. }
  94. asmlinkage int
  95. sys_sigaltstack(const stack_t __user *uss, stack_t __user *uoss)
  96. {
  97. return do_sigaltstack(uss, uoss, rdusp());
  98. }
  99. /*
  100. * Do a signal return; undo the signal stack.
  101. *
  102. * Keep the return code on the stack quadword aligned!
  103. * That makes the cache flush below easier.
  104. */
  105. struct sigframe
  106. {
  107. char __user *pretcode;
  108. int sig;
  109. int code;
  110. struct sigcontext __user *psc;
  111. char retcode[8];
  112. unsigned long extramask[_NSIG_WORDS-1];
  113. struct sigcontext sc;
  114. };
  115. struct rt_sigframe
  116. {
  117. char __user *pretcode;
  118. int sig;
  119. struct siginfo __user *pinfo;
  120. void __user *puc;
  121. char retcode[8];
  122. struct siginfo info;
  123. struct ucontext uc;
  124. };
  125. #ifdef CONFIG_FPU
  126. static unsigned char fpu_version = 0; /* version number of fpu, set by setup_frame */
  127. static inline int restore_fpu_state(struct sigcontext *sc)
  128. {
  129. int err = 1;
  130. if (FPU_IS_EMU) {
  131. /* restore registers */
  132. memcpy(current->thread.fpcntl, sc->sc_fpcntl, 12);
  133. memcpy(current->thread.fp, sc->sc_fpregs, 24);
  134. return 0;
  135. }
  136. if (sc->sc_fpstate[0]) {
  137. /* Verify the frame format. */
  138. if (sc->sc_fpstate[0] != fpu_version)
  139. goto out;
  140. __asm__ volatile (".chip 68k/68881\n\t"
  141. "fmovemx %0,%%fp0-%%fp1\n\t"
  142. "fmoveml %1,%%fpcr/%%fpsr/%%fpiar\n\t"
  143. ".chip 68k"
  144. : /* no outputs */
  145. : "m" (*sc->sc_fpregs), "m" (*sc->sc_fpcntl));
  146. }
  147. __asm__ volatile (".chip 68k/68881\n\t"
  148. "frestore %0\n\t"
  149. ".chip 68k" : : "m" (*sc->sc_fpstate));
  150. err = 0;
  151. out:
  152. return err;
  153. }
  154. #define FPCONTEXT_SIZE 216
  155. #define uc_fpstate uc_filler[0]
  156. #define uc_formatvec uc_filler[FPCONTEXT_SIZE/4]
  157. #define uc_extra uc_filler[FPCONTEXT_SIZE/4+1]
  158. static inline int rt_restore_fpu_state(struct ucontext __user *uc)
  159. {
  160. unsigned char fpstate[FPCONTEXT_SIZE];
  161. int context_size = 0;
  162. fpregset_t fpregs;
  163. int err = 1;
  164. if (FPU_IS_EMU) {
  165. /* restore fpu control register */
  166. if (__copy_from_user(current->thread.fpcntl,
  167. uc->uc_mcontext.fpregs.f_fpcntl, 12))
  168. goto out;
  169. /* restore all other fpu register */
  170. if (__copy_from_user(current->thread.fp,
  171. uc->uc_mcontext.fpregs.f_fpregs, 96))
  172. goto out;
  173. return 0;
  174. }
  175. if (__get_user(*(long *)fpstate, (long __user *)&uc->uc_fpstate))
  176. goto out;
  177. if (fpstate[0]) {
  178. context_size = fpstate[1];
  179. /* Verify the frame format. */
  180. if (fpstate[0] != fpu_version)
  181. goto out;
  182. if (__copy_from_user(&fpregs, &uc->uc_mcontext.fpregs,
  183. sizeof(fpregs)))
  184. goto out;
  185. __asm__ volatile (".chip 68k/68881\n\t"
  186. "fmovemx %0,%%fp0-%%fp7\n\t"
  187. "fmoveml %1,%%fpcr/%%fpsr/%%fpiar\n\t"
  188. ".chip 68k"
  189. : /* no outputs */
  190. : "m" (*fpregs.f_fpregs),
  191. "m" (*fpregs.f_fpcntl));
  192. }
  193. if (context_size &&
  194. __copy_from_user(fpstate + 4, (long __user *)&uc->uc_fpstate + 1,
  195. context_size))
  196. goto out;
  197. __asm__ volatile (".chip 68k/68881\n\t"
  198. "frestore %0\n\t"
  199. ".chip 68k" : : "m" (*fpstate));
  200. err = 0;
  201. out:
  202. return err;
  203. }
  204. #endif
  205. static inline int
  206. restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *usc, void __user *fp,
  207. int *pd0)
  208. {
  209. int formatvec;
  210. struct sigcontext context;
  211. int err = 0;
  212. /* Always make any pending restarted system calls return -EINTR */
  213. current_thread_info()->restart_block.fn = do_no_restart_syscall;
  214. /* get previous context */
  215. if (copy_from_user(&context, usc, sizeof(context)))
  216. goto badframe;
  217. /* restore passed registers */
  218. regs->d1 = context.sc_d1;
  219. regs->a0 = context.sc_a0;
  220. regs->a1 = context.sc_a1;
  221. ((struct switch_stack *)regs - 1)->a5 = context.sc_a5;
  222. regs->sr = (regs->sr & 0xff00) | (context.sc_sr & 0xff);
  223. regs->pc = context.sc_pc;
  224. regs->orig_d0 = -1; /* disable syscall checks */
  225. wrusp(context.sc_usp);
  226. formatvec = context.sc_formatvec;
  227. regs->format = formatvec >> 12;
  228. regs->vector = formatvec & 0xfff;
  229. #ifdef CONFIG_FPU
  230. err = restore_fpu_state(&context);
  231. #endif
  232. *pd0 = context.sc_d0;
  233. return err;
  234. badframe:
  235. return 1;
  236. }
  237. static inline int
  238. rt_restore_ucontext(struct pt_regs *regs, struct switch_stack *sw,
  239. struct ucontext __user *uc, int *pd0)
  240. {
  241. int temp;
  242. greg_t __user *gregs = uc->uc_mcontext.gregs;
  243. unsigned long usp;
  244. int err;
  245. /* Always make any pending restarted system calls return -EINTR */
  246. current_thread_info()->restart_block.fn = do_no_restart_syscall;
  247. err = __get_user(temp, &uc->uc_mcontext.version);
  248. if (temp != MCONTEXT_VERSION)
  249. goto badframe;
  250. /* restore passed registers */
  251. err |= __get_user(regs->d0, &gregs[0]);
  252. err |= __get_user(regs->d1, &gregs[1]);
  253. err |= __get_user(regs->d2, &gregs[2]);
  254. err |= __get_user(regs->d3, &gregs[3]);
  255. err |= __get_user(regs->d4, &gregs[4]);
  256. err |= __get_user(regs->d5, &gregs[5]);
  257. err |= __get_user(sw->d6, &gregs[6]);
  258. err |= __get_user(sw->d7, &gregs[7]);
  259. err |= __get_user(regs->a0, &gregs[8]);
  260. err |= __get_user(regs->a1, &gregs[9]);
  261. err |= __get_user(regs->a2, &gregs[10]);
  262. err |= __get_user(sw->a3, &gregs[11]);
  263. err |= __get_user(sw->a4, &gregs[12]);
  264. err |= __get_user(sw->a5, &gregs[13]);
  265. err |= __get_user(sw->a6, &gregs[14]);
  266. err |= __get_user(usp, &gregs[15]);
  267. wrusp(usp);
  268. err |= __get_user(regs->pc, &gregs[16]);
  269. err |= __get_user(temp, &gregs[17]);
  270. regs->sr = (regs->sr & 0xff00) | (temp & 0xff);
  271. regs->orig_d0 = -1; /* disable syscall checks */
  272. regs->format = temp >> 12;
  273. regs->vector = temp & 0xfff;
  274. if (do_sigaltstack(&uc->uc_stack, NULL, usp) == -EFAULT)
  275. goto badframe;
  276. *pd0 = regs->d0;
  277. return err;
  278. badframe:
  279. return 1;
  280. }
  281. asmlinkage int do_sigreturn(unsigned long __unused)
  282. {
  283. struct switch_stack *sw = (struct switch_stack *) &__unused;
  284. struct pt_regs *regs = (struct pt_regs *) (sw + 1);
  285. unsigned long usp = rdusp();
  286. struct sigframe __user *frame = (struct sigframe __user *)(usp - 4);
  287. sigset_t set;
  288. int d0;
  289. if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
  290. goto badframe;
  291. if (__get_user(set.sig[0], &frame->sc.sc_mask) ||
  292. (_NSIG_WORDS > 1 &&
  293. __copy_from_user(&set.sig[1], &frame->extramask,
  294. sizeof(frame->extramask))))
  295. goto badframe;
  296. sigdelsetmask(&set, ~_BLOCKABLE);
  297. spin_lock_irq(&current->sighand->siglock);
  298. current->blocked = set;
  299. recalc_sigpending();
  300. spin_unlock_irq(&current->sighand->siglock);
  301. if (restore_sigcontext(regs, &frame->sc, frame + 1, &d0))
  302. goto badframe;
  303. return d0;
  304. badframe:
  305. force_sig(SIGSEGV, current);
  306. return 0;
  307. }
  308. asmlinkage int do_rt_sigreturn(unsigned long __unused)
  309. {
  310. struct switch_stack *sw = (struct switch_stack *) &__unused;
  311. struct pt_regs *regs = (struct pt_regs *) (sw + 1);
  312. unsigned long usp = rdusp();
  313. struct rt_sigframe __user *frame = (struct rt_sigframe __user *)(usp - 4);
  314. sigset_t set;
  315. int d0;
  316. if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
  317. goto badframe;
  318. if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
  319. goto badframe;
  320. sigdelsetmask(&set, ~_BLOCKABLE);
  321. spin_lock_irq(&current->sighand->siglock);
  322. current->blocked = set;
  323. recalc_sigpending();
  324. spin_unlock_irq(&current->sighand->siglock);
  325. if (rt_restore_ucontext(regs, sw, &frame->uc, &d0))
  326. goto badframe;
  327. return d0;
  328. badframe:
  329. force_sig(SIGSEGV, current);
  330. return 0;
  331. }
  332. #ifdef CONFIG_FPU
  333. /*
  334. * Set up a signal frame.
  335. */
  336. static inline void save_fpu_state(struct sigcontext *sc, struct pt_regs *regs)
  337. {
  338. if (FPU_IS_EMU) {
  339. /* save registers */
  340. memcpy(sc->sc_fpcntl, current->thread.fpcntl, 12);
  341. memcpy(sc->sc_fpregs, current->thread.fp, 24);
  342. return;
  343. }
  344. __asm__ volatile (".chip 68k/68881\n\t"
  345. "fsave %0\n\t"
  346. ".chip 68k"
  347. : : "m" (*sc->sc_fpstate) : "memory");
  348. if (sc->sc_fpstate[0]) {
  349. fpu_version = sc->sc_fpstate[0];
  350. __asm__ volatile (".chip 68k/68881\n\t"
  351. "fmovemx %%fp0-%%fp1,%0\n\t"
  352. "fmoveml %%fpcr/%%fpsr/%%fpiar,%1\n\t"
  353. ".chip 68k"
  354. : "=m" (*sc->sc_fpregs),
  355. "=m" (*sc->sc_fpcntl)
  356. : /* no inputs */
  357. : "memory");
  358. }
  359. }
  360. static inline int rt_save_fpu_state(struct ucontext __user *uc, struct pt_regs *regs)
  361. {
  362. unsigned char fpstate[FPCONTEXT_SIZE];
  363. int context_size = 0;
  364. int err = 0;
  365. if (FPU_IS_EMU) {
  366. /* save fpu control register */
  367. err |= copy_to_user(uc->uc_mcontext.fpregs.f_pcntl,
  368. current->thread.fpcntl, 12);
  369. /* save all other fpu register */
  370. err |= copy_to_user(uc->uc_mcontext.fpregs.f_fpregs,
  371. current->thread.fp, 96);
  372. return err;
  373. }
  374. __asm__ volatile (".chip 68k/68881\n\t"
  375. "fsave %0\n\t"
  376. ".chip 68k"
  377. : : "m" (*fpstate) : "memory");
  378. err |= __put_user(*(long *)fpstate, (long __user *)&uc->uc_fpstate);
  379. if (fpstate[0]) {
  380. fpregset_t fpregs;
  381. context_size = fpstate[1];
  382. fpu_version = fpstate[0];
  383. __asm__ volatile (".chip 68k/68881\n\t"
  384. "fmovemx %%fp0-%%fp7,%0\n\t"
  385. "fmoveml %%fpcr/%%fpsr/%%fpiar,%1\n\t"
  386. ".chip 68k"
  387. : "=m" (*fpregs.f_fpregs),
  388. "=m" (*fpregs.f_fpcntl)
  389. : /* no inputs */
  390. : "memory");
  391. err |= copy_to_user(&uc->uc_mcontext.fpregs, &fpregs,
  392. sizeof(fpregs));
  393. }
  394. if (context_size)
  395. err |= copy_to_user((long __user *)&uc->uc_fpstate + 1, fpstate + 4,
  396. context_size);
  397. return err;
  398. }
  399. #endif
  400. static void setup_sigcontext(struct sigcontext *sc, struct pt_regs *regs,
  401. unsigned long mask)
  402. {
  403. sc->sc_mask = mask;
  404. sc->sc_usp = rdusp();
  405. sc->sc_d0 = regs->d0;
  406. sc->sc_d1 = regs->d1;
  407. sc->sc_a0 = regs->a0;
  408. sc->sc_a1 = regs->a1;
  409. sc->sc_a5 = ((struct switch_stack *)regs - 1)->a5;
  410. sc->sc_sr = regs->sr;
  411. sc->sc_pc = regs->pc;
  412. sc->sc_formatvec = regs->format << 12 | regs->vector;
  413. #ifdef CONFIG_FPU
  414. save_fpu_state(sc, regs);
  415. #endif
  416. }
  417. static inline int rt_setup_ucontext(struct ucontext __user *uc, struct pt_regs *regs)
  418. {
  419. struct switch_stack *sw = (struct switch_stack *)regs - 1;
  420. greg_t __user *gregs = uc->uc_mcontext.gregs;
  421. int err = 0;
  422. err |= __put_user(MCONTEXT_VERSION, &uc->uc_mcontext.version);
  423. err |= __put_user(regs->d0, &gregs[0]);
  424. err |= __put_user(regs->d1, &gregs[1]);
  425. err |= __put_user(regs->d2, &gregs[2]);
  426. err |= __put_user(regs->d3, &gregs[3]);
  427. err |= __put_user(regs->d4, &gregs[4]);
  428. err |= __put_user(regs->d5, &gregs[5]);
  429. err |= __put_user(sw->d6, &gregs[6]);
  430. err |= __put_user(sw->d7, &gregs[7]);
  431. err |= __put_user(regs->a0, &gregs[8]);
  432. err |= __put_user(regs->a1, &gregs[9]);
  433. err |= __put_user(regs->a2, &gregs[10]);
  434. err |= __put_user(sw->a3, &gregs[11]);
  435. err |= __put_user(sw->a4, &gregs[12]);
  436. err |= __put_user(sw->a5, &gregs[13]);
  437. err |= __put_user(sw->a6, &gregs[14]);
  438. err |= __put_user(rdusp(), &gregs[15]);
  439. err |= __put_user(regs->pc, &gregs[16]);
  440. err |= __put_user(regs->sr, &gregs[17]);
  441. #ifdef CONFIG_FPU
  442. err |= rt_save_fpu_state(uc, regs);
  443. #endif
  444. return err;
  445. }
  446. static inline void __user *
  447. get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, size_t frame_size)
  448. {
  449. unsigned long usp;
  450. /* Default to using normal stack. */
  451. usp = rdusp();
  452. /* This is the X/Open sanctioned signal stack switching. */
  453. if (ka->sa.sa_flags & SA_ONSTACK) {
  454. if (!sas_ss_flags(usp))
  455. usp = current->sas_ss_sp + current->sas_ss_size;
  456. }
  457. return (void __user *)((usp - frame_size) & -8UL);
  458. }
  459. static int setup_frame (int sig, struct k_sigaction *ka,
  460. sigset_t *set, struct pt_regs *regs)
  461. {
  462. struct sigframe __user *frame;
  463. struct sigcontext context;
  464. int err = 0;
  465. frame = get_sigframe(ka, regs, sizeof(*frame));
  466. err |= __put_user((current_thread_info()->exec_domain
  467. && current_thread_info()->exec_domain->signal_invmap
  468. && sig < 32
  469. ? current_thread_info()->exec_domain->signal_invmap[sig]
  470. : sig),
  471. &frame->sig);
  472. err |= __put_user(regs->vector, &frame->code);
  473. err |= __put_user(&frame->sc, &frame->psc);
  474. if (_NSIG_WORDS > 1)
  475. err |= copy_to_user(frame->extramask, &set->sig[1],
  476. sizeof(frame->extramask));
  477. setup_sigcontext(&context, regs, set->sig[0]);
  478. err |= copy_to_user (&frame->sc, &context, sizeof(context));
  479. /* Set up to return from userspace. */
  480. err |= __put_user((void *) ret_from_user_signal, &frame->pretcode);
  481. if (err)
  482. goto give_sigsegv;
  483. /* Set up registers for signal handler */
  484. wrusp ((unsigned long) frame);
  485. regs->pc = (unsigned long) ka->sa.sa_handler;
  486. ((struct switch_stack *)regs - 1)->a5 = current->mm->start_data;
  487. regs->format = 0x4; /*set format byte to make stack appear modulo 4
  488. which it will be when doing the rte */
  489. adjust_stack:
  490. /* Prepare to skip over the extra stuff in the exception frame. */
  491. if (regs->stkadj) {
  492. struct pt_regs *tregs =
  493. (struct pt_regs *)((ulong)regs + regs->stkadj);
  494. #if defined(DEBUG)
  495. printk(KERN_DEBUG "Performing stackadjust=%04x\n", regs->stkadj);
  496. #endif
  497. /* This must be copied with decreasing addresses to
  498. handle overlaps. */
  499. tregs->vector = 0;
  500. tregs->format = 0;
  501. tregs->pc = regs->pc;
  502. tregs->sr = regs->sr;
  503. }
  504. return err;
  505. give_sigsegv:
  506. force_sigsegv(sig, current);
  507. goto adjust_stack;
  508. }
  509. static int setup_rt_frame (int sig, struct k_sigaction *ka, siginfo_t *info,
  510. sigset_t *set, struct pt_regs *regs)
  511. {
  512. struct rt_sigframe __user *frame;
  513. int err = 0;
  514. frame = get_sigframe(ka, regs, sizeof(*frame));
  515. err |= __put_user((current_thread_info()->exec_domain
  516. && current_thread_info()->exec_domain->signal_invmap
  517. && sig < 32
  518. ? current_thread_info()->exec_domain->signal_invmap[sig]
  519. : sig),
  520. &frame->sig);
  521. err |= __put_user(&frame->info, &frame->pinfo);
  522. err |= __put_user(&frame->uc, &frame->puc);
  523. err |= copy_siginfo_to_user(&frame->info, info);
  524. /* Create the ucontext. */
  525. err |= __put_user(0, &frame->uc.uc_flags);
  526. err |= __put_user(NULL, &frame->uc.uc_link);
  527. err |= __put_user((void __user *)current->sas_ss_sp,
  528. &frame->uc.uc_stack.ss_sp);
  529. err |= __put_user(sas_ss_flags(rdusp()),
  530. &frame->uc.uc_stack.ss_flags);
  531. err |= __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size);
  532. err |= rt_setup_ucontext(&frame->uc, regs);
  533. err |= copy_to_user (&frame->uc.uc_sigmask, set, sizeof(*set));
  534. /* Set up to return from userspace. */
  535. err |= __put_user((void *) ret_from_user_rt_signal, &frame->pretcode);
  536. if (err)
  537. goto give_sigsegv;
  538. /* Set up registers for signal handler */
  539. wrusp ((unsigned long) frame);
  540. regs->pc = (unsigned long) ka->sa.sa_handler;
  541. ((struct switch_stack *)regs - 1)->a5 = current->mm->start_data;
  542. regs->format = 0x4; /*set format byte to make stack appear modulo 4
  543. which it will be when doing the rte */
  544. adjust_stack:
  545. /* Prepare to skip over the extra stuff in the exception frame. */
  546. if (regs->stkadj) {
  547. struct pt_regs *tregs =
  548. (struct pt_regs *)((ulong)regs + regs->stkadj);
  549. #if defined(DEBUG)
  550. printk(KERN_DEBUG "Performing stackadjust=%04x\n", regs->stkadj);
  551. #endif
  552. /* This must be copied with decreasing addresses to
  553. handle overlaps. */
  554. tregs->vector = 0;
  555. tregs->format = 0;
  556. tregs->pc = regs->pc;
  557. tregs->sr = regs->sr;
  558. }
  559. return err;
  560. give_sigsegv:
  561. force_sigsegv(sig, current);
  562. goto adjust_stack;
  563. }
  564. static inline void
  565. handle_restart(struct pt_regs *regs, struct k_sigaction *ka, int has_handler)
  566. {
  567. switch (regs->d0) {
  568. case -ERESTARTNOHAND:
  569. if (!has_handler)
  570. goto do_restart;
  571. regs->d0 = -EINTR;
  572. break;
  573. case -ERESTART_RESTARTBLOCK:
  574. if (!has_handler) {
  575. regs->d0 = __NR_restart_syscall;
  576. regs->pc -= 2;
  577. break;
  578. }
  579. regs->d0 = -EINTR;
  580. break;
  581. case -ERESTARTSYS:
  582. if (has_handler && !(ka->sa.sa_flags & SA_RESTART)) {
  583. regs->d0 = -EINTR;
  584. break;
  585. }
  586. /* fallthrough */
  587. case -ERESTARTNOINTR:
  588. do_restart:
  589. regs->d0 = regs->orig_d0;
  590. regs->pc -= 2;
  591. break;
  592. }
  593. }
  594. /*
  595. * OK, we're invoking a handler
  596. */
  597. static void
  598. handle_signal(int sig, struct k_sigaction *ka, siginfo_t *info,
  599. sigset_t *oldset, struct pt_regs *regs)
  600. {
  601. int err;
  602. /* are we from a system call? */
  603. if (regs->orig_d0 >= 0)
  604. /* If so, check system call restarting.. */
  605. handle_restart(regs, ka, 1);
  606. /* set up the stack frame */
  607. if (ka->sa.sa_flags & SA_SIGINFO)
  608. err = setup_rt_frame(sig, ka, info, oldset, regs);
  609. else
  610. err = setup_frame(sig, ka, oldset, regs);
  611. if (err)
  612. return;
  613. spin_lock_irq(&current->sighand->siglock);
  614. sigorsets(&current->blocked,&current->blocked,&ka->sa.sa_mask);
  615. if (!(ka->sa.sa_flags & SA_NODEFER))
  616. sigaddset(&current->blocked,sig);
  617. recalc_sigpending();
  618. spin_unlock_irq(&current->sighand->siglock);
  619. clear_thread_flag(TIF_RESTORE_SIGMASK);
  620. }
  621. /*
  622. * Note that 'init' is a special process: it doesn't get signals it doesn't
  623. * want to handle. Thus you cannot kill init even with a SIGKILL even by
  624. * mistake.
  625. */
  626. asmlinkage void do_signal(struct pt_regs *regs)
  627. {
  628. struct k_sigaction ka;
  629. siginfo_t info;
  630. int signr;
  631. sigset_t *oldset;
  632. /*
  633. * We want the common case to go fast, which
  634. * is why we may in certain cases get here from
  635. * kernel mode. Just return without doing anything
  636. * if so.
  637. */
  638. if (!user_mode(regs))
  639. return;
  640. if (test_thread_flag(TIF_RESTORE_SIGMASK))
  641. oldset = &current->saved_sigmask;
  642. else
  643. oldset = &current->blocked;
  644. signr = get_signal_to_deliver(&info, &ka, regs, NULL);
  645. if (signr > 0) {
  646. /* Whee! Actually deliver the signal. */
  647. handle_signal(signr, &ka, &info, oldset, regs);
  648. return;
  649. }
  650. /* Did we come from a system call? */
  651. if (regs->orig_d0 >= 0) {
  652. /* Restart the system call - no handlers present */
  653. handle_restart(regs, NULL, 0);
  654. }
  655. /* If there's no signal to deliver, we just restore the saved mask. */
  656. if (test_thread_flag(TIF_RESTORE_SIGMASK)) {
  657. clear_thread_flag(TIF_RESTORE_SIGMASK);
  658. sigprocmask(SIG_SETMASK, &current->saved_sigmask, NULL);
  659. }
  660. }