signal.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774
  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. /* get previous context */
  243. if (copy_from_user(&context, usc, sizeof(context)))
  244. goto badframe;
  245. /* restore passed registers */
  246. regs->d1 = context.sc_d1;
  247. regs->a0 = context.sc_a0;
  248. regs->a1 = context.sc_a1;
  249. ((struct switch_stack *)regs - 1)->a5 = context.sc_a5;
  250. regs->sr = (regs->sr & 0xff00) | (context.sc_sr & 0xff);
  251. regs->pc = context.sc_pc;
  252. regs->orig_d0 = -1; /* disable syscall checks */
  253. wrusp(context.sc_usp);
  254. formatvec = context.sc_formatvec;
  255. regs->format = formatvec >> 12;
  256. regs->vector = formatvec & 0xfff;
  257. #ifdef CONFIG_FPU
  258. err = restore_fpu_state(&context);
  259. #endif
  260. *pd0 = context.sc_d0;
  261. return err;
  262. badframe:
  263. return 1;
  264. }
  265. static inline int
  266. rt_restore_ucontext(struct pt_regs *regs, struct switch_stack *sw,
  267. struct ucontext *uc, int *pd0)
  268. {
  269. int temp;
  270. greg_t *gregs = uc->uc_mcontext.gregs;
  271. unsigned long usp;
  272. int err;
  273. err = __get_user(temp, &uc->uc_mcontext.version);
  274. if (temp != MCONTEXT_VERSION)
  275. goto badframe;
  276. /* restore passed registers */
  277. err |= __get_user(regs->d0, &gregs[0]);
  278. err |= __get_user(regs->d1, &gregs[1]);
  279. err |= __get_user(regs->d2, &gregs[2]);
  280. err |= __get_user(regs->d3, &gregs[3]);
  281. err |= __get_user(regs->d4, &gregs[4]);
  282. err |= __get_user(regs->d5, &gregs[5]);
  283. err |= __get_user(sw->d6, &gregs[6]);
  284. err |= __get_user(sw->d7, &gregs[7]);
  285. err |= __get_user(regs->a0, &gregs[8]);
  286. err |= __get_user(regs->a1, &gregs[9]);
  287. err |= __get_user(regs->a2, &gregs[10]);
  288. err |= __get_user(sw->a3, &gregs[11]);
  289. err |= __get_user(sw->a4, &gregs[12]);
  290. err |= __get_user(sw->a5, &gregs[13]);
  291. err |= __get_user(sw->a6, &gregs[14]);
  292. err |= __get_user(usp, &gregs[15]);
  293. wrusp(usp);
  294. err |= __get_user(regs->pc, &gregs[16]);
  295. err |= __get_user(temp, &gregs[17]);
  296. regs->sr = (regs->sr & 0xff00) | (temp & 0xff);
  297. regs->orig_d0 = -1; /* disable syscall checks */
  298. regs->format = temp >> 12;
  299. regs->vector = temp & 0xfff;
  300. if (do_sigaltstack(&uc->uc_stack, NULL, usp) == -EFAULT)
  301. goto badframe;
  302. *pd0 = regs->d0;
  303. return err;
  304. badframe:
  305. return 1;
  306. }
  307. asmlinkage int do_sigreturn(unsigned long __unused)
  308. {
  309. struct switch_stack *sw = (struct switch_stack *) &__unused;
  310. struct pt_regs *regs = (struct pt_regs *) (sw + 1);
  311. unsigned long usp = rdusp();
  312. struct sigframe *frame = (struct sigframe *)(usp - 4);
  313. sigset_t set;
  314. int d0;
  315. if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
  316. goto badframe;
  317. if (__get_user(set.sig[0], &frame->sc.sc_mask) ||
  318. (_NSIG_WORDS > 1 &&
  319. __copy_from_user(&set.sig[1], &frame->extramask,
  320. sizeof(frame->extramask))))
  321. goto badframe;
  322. sigdelsetmask(&set, ~_BLOCKABLE);
  323. spin_lock_irq(&current->sighand->siglock);
  324. current->blocked = set;
  325. recalc_sigpending();
  326. spin_unlock_irq(&current->sighand->siglock);
  327. if (restore_sigcontext(regs, &frame->sc, frame + 1, &d0))
  328. goto badframe;
  329. return d0;
  330. badframe:
  331. force_sig(SIGSEGV, current);
  332. return 0;
  333. }
  334. asmlinkage int do_rt_sigreturn(unsigned long __unused)
  335. {
  336. struct switch_stack *sw = (struct switch_stack *) &__unused;
  337. struct pt_regs *regs = (struct pt_regs *) (sw + 1);
  338. unsigned long usp = rdusp();
  339. struct rt_sigframe *frame = (struct rt_sigframe *)(usp - 4);
  340. sigset_t set;
  341. int d0;
  342. if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
  343. goto badframe;
  344. if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
  345. goto badframe;
  346. sigdelsetmask(&set, ~_BLOCKABLE);
  347. spin_lock_irq(&current->sighand->siglock);
  348. current->blocked = set;
  349. recalc_sigpending();
  350. spin_unlock_irq(&current->sighand->siglock);
  351. if (rt_restore_ucontext(regs, sw, &frame->uc, &d0))
  352. goto badframe;
  353. return d0;
  354. badframe:
  355. force_sig(SIGSEGV, current);
  356. return 0;
  357. }
  358. #ifdef CONFIG_FPU
  359. /*
  360. * Set up a signal frame.
  361. */
  362. static inline void save_fpu_state(struct sigcontext *sc, struct pt_regs *regs)
  363. {
  364. if (FPU_IS_EMU) {
  365. /* save registers */
  366. memcpy(sc->sc_fpcntl, current->thread.fpcntl, 12);
  367. memcpy(sc->sc_fpregs, current->thread.fp, 24);
  368. return;
  369. }
  370. __asm__ volatile (".chip 68k/68881\n\t"
  371. "fsave %0\n\t"
  372. ".chip 68k"
  373. : : "m" (*sc->sc_fpstate) : "memory");
  374. if (sc->sc_fpstate[0]) {
  375. fpu_version = sc->sc_fpstate[0];
  376. __asm__ volatile (".chip 68k/68881\n\t"
  377. "fmovemx %/fp0-%/fp1,%0\n\t"
  378. "fmoveml %/fpcr/%/fpsr/%/fpiar,%1\n\t"
  379. ".chip 68k"
  380. : /* no outputs */
  381. : "m" (*sc->sc_fpregs),
  382. "m" (*sc->sc_fpcntl)
  383. : "memory");
  384. }
  385. }
  386. static inline int rt_save_fpu_state(struct ucontext *uc, struct pt_regs *regs)
  387. {
  388. unsigned char fpstate[FPCONTEXT_SIZE];
  389. int context_size = 0;
  390. int err = 0;
  391. if (FPU_IS_EMU) {
  392. /* save fpu control register */
  393. err |= copy_to_user(&uc->uc_mcontext.fpregs.f_pcr,
  394. current->thread.fpcntl, 12);
  395. /* save all other fpu register */
  396. err |= copy_to_user(uc->uc_mcontext.fpregs.f_fpregs,
  397. current->thread.fp, 96);
  398. return err;
  399. }
  400. __asm__ volatile (".chip 68k/68881\n\t"
  401. "fsave %0\n\t"
  402. ".chip 68k"
  403. : : "m" (*fpstate) : "memory");
  404. err |= __put_user(*(long *)fpstate, (long *)&uc->uc_fpstate);
  405. if (fpstate[0]) {
  406. fpregset_t fpregs;
  407. context_size = fpstate[1];
  408. fpu_version = fpstate[0];
  409. __asm__ volatile (".chip 68k/68881\n\t"
  410. "fmovemx %/fp0-%/fp7,%0\n\t"
  411. "fmoveml %/fpcr/%/fpsr/%/fpiar,%1\n\t"
  412. ".chip 68k"
  413. : /* no outputs */
  414. : "m" (*fpregs.f_fpregs),
  415. "m" (fpregs.f_pcr)
  416. : "memory");
  417. err |= copy_to_user(&uc->uc_mcontext.fpregs, &fpregs,
  418. sizeof(fpregs));
  419. }
  420. if (context_size)
  421. err |= copy_to_user((long *)&uc->uc_fpstate + 1, fpstate + 4,
  422. context_size);
  423. return err;
  424. }
  425. #endif
  426. static void setup_sigcontext(struct sigcontext *sc, struct pt_regs *regs,
  427. unsigned long mask)
  428. {
  429. sc->sc_mask = mask;
  430. sc->sc_usp = rdusp();
  431. sc->sc_d0 = regs->d0;
  432. sc->sc_d1 = regs->d1;
  433. sc->sc_a0 = regs->a0;
  434. sc->sc_a1 = regs->a1;
  435. sc->sc_a5 = ((struct switch_stack *)regs - 1)->a5;
  436. sc->sc_sr = regs->sr;
  437. sc->sc_pc = regs->pc;
  438. sc->sc_formatvec = regs->format << 12 | regs->vector;
  439. #ifdef CONFIG_FPU
  440. save_fpu_state(sc, regs);
  441. #endif
  442. }
  443. static inline int rt_setup_ucontext(struct ucontext *uc, struct pt_regs *regs)
  444. {
  445. struct switch_stack *sw = (struct switch_stack *)regs - 1;
  446. greg_t *gregs = uc->uc_mcontext.gregs;
  447. int err = 0;
  448. err |= __put_user(MCONTEXT_VERSION, &uc->uc_mcontext.version);
  449. err |= __put_user(regs->d0, &gregs[0]);
  450. err |= __put_user(regs->d1, &gregs[1]);
  451. err |= __put_user(regs->d2, &gregs[2]);
  452. err |= __put_user(regs->d3, &gregs[3]);
  453. err |= __put_user(regs->d4, &gregs[4]);
  454. err |= __put_user(regs->d5, &gregs[5]);
  455. err |= __put_user(sw->d6, &gregs[6]);
  456. err |= __put_user(sw->d7, &gregs[7]);
  457. err |= __put_user(regs->a0, &gregs[8]);
  458. err |= __put_user(regs->a1, &gregs[9]);
  459. err |= __put_user(regs->a2, &gregs[10]);
  460. err |= __put_user(sw->a3, &gregs[11]);
  461. err |= __put_user(sw->a4, &gregs[12]);
  462. err |= __put_user(sw->a5, &gregs[13]);
  463. err |= __put_user(sw->a6, &gregs[14]);
  464. err |= __put_user(rdusp(), &gregs[15]);
  465. err |= __put_user(regs->pc, &gregs[16]);
  466. err |= __put_user(regs->sr, &gregs[17]);
  467. #ifdef CONFIG_FPU
  468. err |= rt_save_fpu_state(uc, regs);
  469. #endif
  470. return err;
  471. }
  472. static inline void *
  473. get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, size_t frame_size)
  474. {
  475. unsigned long usp;
  476. /* Default to using normal stack. */
  477. usp = rdusp();
  478. /* This is the X/Open sanctioned signal stack switching. */
  479. if (ka->sa.sa_flags & SA_ONSTACK) {
  480. if (!sas_ss_flags(usp))
  481. usp = current->sas_ss_sp + current->sas_ss_size;
  482. }
  483. return (void *)((usp - frame_size) & -8UL);
  484. }
  485. static void setup_frame (int sig, struct k_sigaction *ka,
  486. sigset_t *set, struct pt_regs *regs)
  487. {
  488. struct sigframe *frame;
  489. struct sigcontext context;
  490. int err = 0;
  491. frame = get_sigframe(ka, regs, sizeof(*frame));
  492. err |= __put_user((current_thread_info()->exec_domain
  493. && current_thread_info()->exec_domain->signal_invmap
  494. && sig < 32
  495. ? current_thread_info()->exec_domain->signal_invmap[sig]
  496. : sig),
  497. &frame->sig);
  498. err |= __put_user(regs->vector, &frame->code);
  499. err |= __put_user(&frame->sc, &frame->psc);
  500. if (_NSIG_WORDS > 1)
  501. err |= copy_to_user(frame->extramask, &set->sig[1],
  502. sizeof(frame->extramask));
  503. setup_sigcontext(&context, regs, set->sig[0]);
  504. err |= copy_to_user (&frame->sc, &context, sizeof(context));
  505. /* Set up to return from userspace. */
  506. err |= __put_user((void *) ret_from_user_signal, &frame->pretcode);
  507. if (err)
  508. goto give_sigsegv;
  509. /* Set up registers for signal handler */
  510. wrusp ((unsigned long) frame);
  511. regs->pc = (unsigned long) ka->sa.sa_handler;
  512. ((struct switch_stack *)regs - 1)->a5 = current->mm->start_data;
  513. regs->format = 0x4; /*set format byte to make stack appear modulo 4
  514. which it will be when doing the rte */
  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 defined(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((void *) ret_from_user_rt_signal, &frame->pretcode);
  562. if (err)
  563. goto give_sigsegv;
  564. /* Set up registers for signal handler */
  565. wrusp ((unsigned long) frame);
  566. regs->pc = (unsigned long) ka->sa.sa_handler;
  567. ((struct switch_stack *)regs - 1)->a5 = current->mm->start_data;
  568. regs->format = 0x4; /*set format byte to make stack appear modulo 4
  569. which it will be when doing the rte */
  570. adjust_stack:
  571. /* Prepare to skip over the extra stuff in the exception frame. */
  572. if (regs->stkadj) {
  573. struct pt_regs *tregs =
  574. (struct pt_regs *)((ulong)regs + regs->stkadj);
  575. #if defined(DEBUG)
  576. printk(KERN_DEBUG "Performing stackadjust=%04x\n", regs->stkadj);
  577. #endif
  578. /* This must be copied with decreasing addresses to
  579. handle overlaps. */
  580. tregs->vector = 0;
  581. tregs->format = 0;
  582. tregs->pc = regs->pc;
  583. tregs->sr = regs->sr;
  584. }
  585. return;
  586. give_sigsegv:
  587. force_sigsegv(sig, current);
  588. goto adjust_stack;
  589. }
  590. static inline void
  591. handle_restart(struct pt_regs *regs, struct k_sigaction *ka, int has_handler)
  592. {
  593. switch (regs->d0) {
  594. case -ERESTARTNOHAND:
  595. if (!has_handler)
  596. goto do_restart;
  597. regs->d0 = -EINTR;
  598. break;
  599. case -ERESTARTSYS:
  600. if (has_handler && !(ka->sa.sa_flags & SA_RESTART)) {
  601. regs->d0 = -EINTR;
  602. break;
  603. }
  604. /* fallthrough */
  605. case -ERESTARTNOINTR:
  606. do_restart:
  607. regs->d0 = regs->orig_d0;
  608. regs->pc -= 2;
  609. break;
  610. }
  611. }
  612. /*
  613. * OK, we're invoking a handler
  614. */
  615. static void
  616. handle_signal(int sig, struct k_sigaction *ka, siginfo_t *info,
  617. sigset_t *oldset, struct pt_regs *regs)
  618. {
  619. /* are we from a system call? */
  620. if (regs->orig_d0 >= 0)
  621. /* If so, check system call restarting.. */
  622. handle_restart(regs, ka, 1);
  623. /* set up the stack frame */
  624. if (ka->sa.sa_flags & SA_SIGINFO)
  625. setup_rt_frame(sig, ka, info, oldset, regs);
  626. else
  627. setup_frame(sig, ka, oldset, regs);
  628. if (ka->sa.sa_flags & SA_ONESHOT)
  629. ka->sa.sa_handler = SIG_DFL;
  630. spin_lock_irq(&current->sighand->siglock);
  631. sigorsets(&current->blocked,&current->blocked,&ka->sa.sa_mask);
  632. if (!(ka->sa.sa_flags & SA_NODEFER))
  633. sigaddset(&current->blocked,sig);
  634. recalc_sigpending();
  635. spin_unlock_irq(&current->sighand->siglock);
  636. }
  637. /*
  638. * Note that 'init' is a special process: it doesn't get signals it doesn't
  639. * want to handle. Thus you cannot kill init even with a SIGKILL even by
  640. * mistake.
  641. */
  642. asmlinkage int do_signal(sigset_t *oldset, struct pt_regs *regs)
  643. {
  644. struct k_sigaction ka;
  645. siginfo_t info;
  646. int signr;
  647. /*
  648. * We want the common case to go fast, which
  649. * is why we may in certain cases get here from
  650. * kernel mode. Just return without doing anything
  651. * if so.
  652. */
  653. if (!user_mode(regs))
  654. return 1;
  655. if (!oldset)
  656. oldset = &current->blocked;
  657. signr = get_signal_to_deliver(&info, &ka, regs, NULL);
  658. if (signr > 0) {
  659. /* Whee! Actually deliver the signal. */
  660. handle_signal(signr, &ka, &info, oldset, regs);
  661. return 1;
  662. }
  663. /* Did we come from a system call? */
  664. if (regs->orig_d0 >= 0) {
  665. /* Restart the system call - no handlers present */
  666. handle_restart(regs, NULL, 0);
  667. }
  668. return 0;
  669. }