signal.c 20 KB

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