signal.c 20 KB

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