?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
m68k: Switch to saner sigsuspend()
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / arch / m68k / kernel / signal.c
blobfa8200d03de27fea5484f60bf0ea2c39e802f2a3
1 /*
2 * linux/arch/m68k/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 /*
12 * Linux/m68k support by Hamish Macdonald
13 *
14 * 68060 fixes by Jesper Skov
15 *
16 * 1997-12-01 Modified for POSIX.1b signals by Andreas Schwab
17 *
18 * mathemu support by Roman Zippel
19 * (Note: fpstate in the signal context is completely ignored for the emulator
20 * and the internal floating point format is put on stack)
21 */
22
23 /*
24 * ++roman (07/09/96): implemented signal stacks (specially for tosemu on
25 * Atari :-) Current limitation: Only one sigstack can be active at one time.
26 * If a second signal with SA_ONSTACK set arrives while working on a sigstack,
27 * SA_ONSTACK is ignored. This behaviour avoids lots of trouble with nested
28 * signal handlers!
29 */
30
31 #include <linux/sched.h>
32 #include <linux/mm.h>
33 #include <linux/kernel.h>
34 #include <linux/signal.h>
35 #include <linux/syscalls.h>
36 #include <linux/errno.h>
37 #include <linux/wait.h>
38 #include <linux/ptrace.h>
39 #include <linux/unistd.h>
40 #include <linux/stddef.h>
41 #include <linux/highuid.h>
42 #include <linux/personality.h>
43 #include <linux/tty.h>
44 #include <linux/binfmts.h>
45
46 #include <asm/setup.h>
47 #include <asm/uaccess.h>
48 #include <asm/pgtable.h>
49 #include <asm/traps.h>
50 #include <asm/ucontext.h>
51
52 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
53
54 const int frame_extra_sizes[16] = {
55 [1] = -1, /* sizeof(((struct frame *)0)->un.fmt1), */
56 [2] = sizeof(((struct frame *)0)->un.fmt2),
57 [3] = sizeof(((struct frame *)0)->un.fmt3),
58 [4] = sizeof(((struct frame *)0)->un.fmt4),
59 [5] = -1, /* sizeof(((struct frame *)0)->un.fmt5), */
60 [6] = -1, /* sizeof(((struct frame *)0)->un.fmt6), */
61 [7] = sizeof(((struct frame *)0)->un.fmt7),
62 [8] = -1, /* sizeof(((struct frame *)0)->un.fmt8), */
63 [9] = sizeof(((struct frame *)0)->un.fmt9),
64 [10] = sizeof(((struct frame *)0)->un.fmta),
65 [11] = sizeof(((struct frame *)0)->un.fmtb),
66 [12] = -1, /* sizeof(((struct frame *)0)->un.fmtc), */
67 [13] = -1, /* sizeof(((struct frame *)0)->un.fmtd), */
68 [14] = -1, /* sizeof(((struct frame *)0)->un.fmte), */
69 [15] = -1, /* sizeof(((struct frame *)0)->un.fmtf), */
70 };
71
72 /*
73 * Atomically swap in the new signal mask, and wait for a signal.
74 */
75 asmlinkage int
76 sys_sigsuspend(int unused0, int unused1, old_sigset_t mask)
77 {
78 mask &= _BLOCKABLE;
79 spin_lock_irq(&current->sighand->siglock);
80 current->saved_sigmask = current->blocked;
81 siginitset(&current->blocked, mask);
82 recalc_sigpending();
83 spin_unlock_irq(&current->sighand->siglock);
84
85 current->state = TASK_INTERRUPTIBLE;
86 schedule();
87 set_restore_sigmask();
88
89 return -ERESTARTNOHAND;
90 }
91
92 asmlinkage int
93 sys_sigaction(int sig, const struct old_sigaction __user *act,
94 struct old_sigaction __user *oact)
95 {
96 struct k_sigaction new_ka, old_ka;
97 int ret;
98
99 if (act) {
100 old_sigset_t mask;
101 if (!access_ok(VERIFY_READ, act, sizeof(*act)) ||
102 __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
103 __get_user(new_ka.sa.sa_restorer, &act->sa_restorer))
104 return -EFAULT;
105 __get_user(new_ka.sa.sa_flags, &act->sa_flags);
106 __get_user(mask, &act->sa_mask);
107 siginitset(&new_ka.sa.sa_mask, mask);
108 }
109
110 ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
111
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
121 return ret;
122 }
123
124 asmlinkage int
125 sys_sigaltstack(const stack_t __user *uss, stack_t __user *uoss)
126 {
127 return do_sigaltstack(uss, uoss, rdusp());
128 }
129
130
131 /*
132 * Do a signal return; undo the signal stack.
133 *
134 * Keep the return code on the stack quadword aligned!
135 * That makes the cache flush below easier.
136 */
137
138 struct sigframe
139 {
140 char __user *pretcode;
141 int sig;
142 int code;
143 struct sigcontext __user *psc;
144 char retcode[8];
145 unsigned long extramask[_NSIG_WORDS-1];
146 struct sigcontext sc;
147 };
148
149 struct rt_sigframe
150 {
151 char __user *pretcode;
152 int sig;
153 struct siginfo __user *pinfo;
154 void __user *puc;
155 char retcode[8];
156 struct siginfo info;
157 struct ucontext uc;
158 };
159
160
161 static unsigned char fpu_version; /* version number of fpu, set by setup_frame */
162
163 static inline int restore_fpu_state(struct sigcontext *sc)
164 {
165 int err = 1;
166
167 if (FPU_IS_EMU) {
168 /* restore registers */
169 memcpy(current->thread.fpcntl, sc->sc_fpcntl, 12);
170 memcpy(current->thread.fp, sc->sc_fpregs, 24);
171 return 0;
172 }
173
174 if (CPU_IS_060 ? sc->sc_fpstate[2] : sc->sc_fpstate[0]) {
175 /* Verify the frame format. */
176 if (!CPU_IS_060 && (sc->sc_fpstate[0] != fpu_version))
177 goto out;
178 if (CPU_IS_020_OR_030) {
179 if (m68k_fputype & FPU_68881 &&
180 !(sc->sc_fpstate[1] == 0x18 || sc->sc_fpstate[1] == 0xb4))
181 goto out;
182 if (m68k_fputype & FPU_68882 &&
183 !(sc->sc_fpstate[1] == 0x38 || sc->sc_fpstate[1] == 0xd4))
184 goto out;
185 } else if (CPU_IS_040) {
186 if (!(sc->sc_fpstate[1] == 0x00 ||
187 sc->sc_fpstate[1] == 0x28 ||
188 sc->sc_fpstate[1] == 0x60))
189 goto out;
190 } else if (CPU_IS_060) {
191 if (!(sc->sc_fpstate[3] == 0x00 ||
192 sc->sc_fpstate[3] == 0x60 ||
193 sc->sc_fpstate[3] == 0xe0))
194 goto out;
195 } else
196 goto out;
197
198 __asm__ volatile (".chip 68k/68881\n\t"
199 "fmovemx %0,%%fp0-%%fp1\n\t"
200 "fmoveml %1,%%fpcr/%%fpsr/%%fpiar\n\t"
201 ".chip 68k"
202 : /* no outputs */
203 : "m" (*sc->sc_fpregs), "m" (*sc->sc_fpcntl));
204 }
205 __asm__ volatile (".chip 68k/68881\n\t"
206 "frestore %0\n\t"
207 ".chip 68k" : : "m" (*sc->sc_fpstate));
208 err = 0;
209
210 out:
211 return err;
212 }
213
214 #define FPCONTEXT_SIZE 216
215 #define uc_fpstate uc_filler[0]
216 #define uc_formatvec uc_filler[FPCONTEXT_SIZE/4]
217 #define uc_extra uc_filler[FPCONTEXT_SIZE/4+1]
218
219 static inline int rt_restore_fpu_state(struct ucontext __user *uc)
220 {
221 unsigned char fpstate[FPCONTEXT_SIZE];
222 int context_size = CPU_IS_060 ? 8 : 0;
223 fpregset_t fpregs;
224 int err = 1;
225
226 if (FPU_IS_EMU) {
227 /* restore fpu control register */
228 if (__copy_from_user(current->thread.fpcntl,
229 uc->uc_mcontext.fpregs.f_fpcntl, 12))
230 goto out;
231 /* restore all other fpu register */
232 if (__copy_from_user(current->thread.fp,
233 uc->uc_mcontext.fpregs.f_fpregs, 96))
234 goto out;
235 return 0;
236 }
237
238 if (__get_user(*(long *)fpstate, (long __user *)&uc->uc_fpstate))
239 goto out;
240 if (CPU_IS_060 ? fpstate[2] : fpstate[0]) {
241 if (!CPU_IS_060)
242 context_size = fpstate[1];
243 /* Verify the frame format. */
244 if (!CPU_IS_060 && (fpstate[0] != fpu_version))
245 goto out;
246 if (CPU_IS_020_OR_030) {
247 if (m68k_fputype & FPU_68881 &&
248 !(context_size == 0x18 || context_size == 0xb4))
249 goto out;
250 if (m68k_fputype & FPU_68882 &&
251 !(context_size == 0x38 || context_size == 0xd4))
252 goto out;
253 } else if (CPU_IS_040) {
254 if (!(context_size == 0x00 ||
255 context_size == 0x28 ||
256 context_size == 0x60))
257 goto out;
258 } else if (CPU_IS_060) {
259 if (!(fpstate[3] == 0x00 ||
260 fpstate[3] == 0x60 ||
261 fpstate[3] == 0xe0))
262 goto out;
263 } else
264 goto out;
265 if (__copy_from_user(&fpregs, &uc->uc_mcontext.fpregs,
266 sizeof(fpregs)))
267 goto out;
268 __asm__ volatile (".chip 68k/68881\n\t"
269 "fmovemx %0,%%fp0-%%fp7\n\t"
270 "fmoveml %1,%%fpcr/%%fpsr/%%fpiar\n\t"
271 ".chip 68k"
272 : /* no outputs */
273 : "m" (*fpregs.f_fpregs),
274 "m" (*fpregs.f_fpcntl));
275 }
276 if (context_size &&
277 __copy_from_user(fpstate + 4, (long __user *)&uc->uc_fpstate + 1,
278 context_size))
279 goto out;
280 __asm__ volatile (".chip 68k/68881\n\t"
281 "frestore %0\n\t"
282 ".chip 68k" : : "m" (*fpstate));
283 err = 0;
284
285 out:
286 return err;
287 }
288
289 static inline int
290 restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *usc, void __user *fp,
291 int *pd0)
292 {
293 int fsize, formatvec;
294 struct sigcontext context;
295 int err;
296
297 /* Always make any pending restarted system calls return -EINTR */
298 current_thread_info()->restart_block.fn = do_no_restart_syscall;
299
300 /* get previous context */
301 if (copy_from_user(&context, usc, sizeof(context)))
302 goto badframe;
303
304 /* restore passed registers */
305 regs->d1 = context.sc_d1;
306 regs->a0 = context.sc_a0;
307 regs->a1 = context.sc_a1;
308 regs->sr = (regs->sr & 0xff00) | (context.sc_sr & 0xff);
309 regs->pc = context.sc_pc;
310 regs->orig_d0 = -1; /* disable syscall checks */
311 wrusp(context.sc_usp);
312 formatvec = context.sc_formatvec;
313 regs->format = formatvec >> 12;
314 regs->vector = formatvec & 0xfff;
315
316 err = restore_fpu_state(&context);
317
318 fsize = frame_extra_sizes[regs->format];
319 if (fsize < 0) {
320 /*
321 * user process trying to return with weird frame format
322 */
323 #ifdef DEBUG
324 printk("user process returning with weird frame format\n");
325 #endif
326 goto badframe;
327 }
328
329 /* OK. Make room on the supervisor stack for the extra junk,
330 * if necessary.
331 */
332
333 if (fsize) {
334 struct switch_stack *sw = (struct switch_stack *)regs - 1;
335 regs->d0 = context.sc_d0;
336 #define frame_offset (sizeof(struct pt_regs)+sizeof(struct switch_stack))
337 __asm__ __volatile__
338 (" movel %0,%/a0\n\t"
339 " subl %1,%/a0\n\t" /* make room on stack */
340 " movel %/a0,%/sp\n\t" /* set stack pointer */
341 /* move switch_stack and pt_regs */
342 "1: movel %0@+,%/a0@+\n\t"
343 " dbra %2,1b\n\t"
344 " lea %/sp@(%c3),%/a0\n\t" /* add offset of fmt */
345 " lsrl #2,%1\n\t"
346 " subql #1,%1\n\t"
347 "2: movesl %4@+,%2\n\t"
348 "3: movel %2,%/a0@+\n\t"
349 " dbra %1,2b\n\t"
350 " bral ret_from_signal\n"
351 "4:\n"
352 ".section __ex_table,\"a\"\n"
353 " .align 4\n"
354 " .long 2b,4b\n"
355 " .long 3b,4b\n"
356 ".previous"
357 : /* no outputs, it doesn't ever return */
358 : "a" (sw), "d" (fsize), "d" (frame_offset/4-1),
359 "n" (frame_offset), "a" (fp)
360 : "a0");
361 #undef frame_offset
362 /*
363 * If we ever get here an exception occurred while
364 * building the above stack-frame.
365 */
366 goto badframe;
367 }
368
369 *pd0 = context.sc_d0;
370 return err;
371
372 badframe:
373 return 1;
374 }
375
376 static inline int
377 rt_restore_ucontext(struct pt_regs *regs, struct switch_stack *sw,
378 struct ucontext __user *uc, int *pd0)
379 {
380 int fsize, temp;
381 greg_t __user *gregs = uc->uc_mcontext.gregs;
382 unsigned long usp;
383 int err;
384
385 /* Always make any pending restarted system calls return -EINTR */
386 current_thread_info()->restart_block.fn = do_no_restart_syscall;
387
388 err = __get_user(temp, &uc->uc_mcontext.version);
389 if (temp != MCONTEXT_VERSION)
390 goto badframe;
391 /* restore passed registers */
392 err |= __get_user(regs->d0, &gregs[0]);
393 err |= __get_user(regs->d1, &gregs[1]);
394 err |= __get_user(regs->d2, &gregs[2]);
395 err |= __get_user(regs->d3, &gregs[3]);
396 err |= __get_user(regs->d4, &gregs[4]);
397 err |= __get_user(regs->d5, &gregs[5]);
398 err |= __get_user(sw->d6, &gregs[6]);
399 err |= __get_user(sw->d7, &gregs[7]);
400 err |= __get_user(regs->a0, &gregs[8]);
401 err |= __get_user(regs->a1, &gregs[9]);
402 err |= __get_user(regs->a2, &gregs[10]);
403 err |= __get_user(sw->a3, &gregs[11]);
404 err |= __get_user(sw->a4, &gregs[12]);
405 err |= __get_user(sw->a5, &gregs[13]);
406 err |= __get_user(sw->a6, &gregs[14]);
407 err |= __get_user(usp, &gregs[15]);
408 wrusp(usp);
409 err |= __get_user(regs->pc, &gregs[16]);
410 err |= __get_user(temp, &gregs[17]);
411 regs->sr = (regs->sr & 0xff00) | (temp & 0xff);
412 regs->orig_d0 = -1; /* disable syscall checks */
413 err |= __get_user(temp, &uc->uc_formatvec);
414 regs->format = temp >> 12;
415 regs->vector = temp & 0xfff;
416
417 err |= rt_restore_fpu_state(uc);
418
419 if (do_sigaltstack(&uc->uc_stack, NULL, usp) == -EFAULT)
420 goto badframe;
421
422 fsize = frame_extra_sizes[regs->format];
423 if (fsize < 0) {
424 /*
425 * user process trying to return with weird frame format
426 */
427 #ifdef DEBUG
428 printk("user process returning with weird frame format\n");
429 #endif
430 goto badframe;
431 }
432
433 /* OK. Make room on the supervisor stack for the extra junk,
434 * if necessary.
435 */
436
437 if (fsize) {
438 #define frame_offset (sizeof(struct pt_regs)+sizeof(struct switch_stack))
439 __asm__ __volatile__
440 (" movel %0,%/a0\n\t"
441 " subl %1,%/a0\n\t" /* make room on stack */
442 " movel %/a0,%/sp\n\t" /* set stack pointer */
443 /* move switch_stack and pt_regs */
444 "1: movel %0@+,%/a0@+\n\t"
445 " dbra %2,1b\n\t"
446 " lea %/sp@(%c3),%/a0\n\t" /* add offset of fmt */
447 " lsrl #2,%1\n\t"
448 " subql #1,%1\n\t"
449 "2: movesl %4@+,%2\n\t"
450 "3: movel %2,%/a0@+\n\t"
451 " dbra %1,2b\n\t"
452 " bral ret_from_signal\n"
453 "4:\n"
454 ".section __ex_table,\"a\"\n"
455 " .align 4\n"
456 " .long 2b,4b\n"
457 " .long 3b,4b\n"
458 ".previous"
459 : /* no outputs, it doesn't ever return */
460 : "a" (sw), "d" (fsize), "d" (frame_offset/4-1),
461 "n" (frame_offset), "a" (&uc->uc_extra)
462 : "a0");
463 #undef frame_offset
464 /*
465 * If we ever get here an exception occurred while
466 * building the above stack-frame.
467 */
468 goto badframe;
469 }
470
471 *pd0 = regs->d0;
472 return err;
473
474 badframe:
475 return 1;
476 }
477
478 asmlinkage int do_sigreturn(unsigned long __unused)
479 {
480 struct switch_stack *sw = (struct switch_stack *) &__unused;
481 struct pt_regs *regs = (struct pt_regs *) (sw + 1);
482 unsigned long usp = rdusp();
483 struct sigframe __user *frame = (struct sigframe __user *)(usp - 4);
484 sigset_t set;
485 int d0;
486
487 if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
488 goto badframe;
489 if (__get_user(set.sig[0], &frame->sc.sc_mask) ||
490 (_NSIG_WORDS > 1 &&
491 __copy_from_user(&set.sig[1], &frame->extramask,
492 sizeof(frame->extramask))))
493 goto badframe;
494
495 sigdelsetmask(&set, ~_BLOCKABLE);
496 current->blocked = set;
497 recalc_sigpending();
498
499 if (restore_sigcontext(regs, &frame->sc, frame + 1, &d0))
500 goto badframe;
501 return d0;
502
503 badframe:
504 force_sig(SIGSEGV, current);
505 return 0;
506 }
507
508 asmlinkage int do_rt_sigreturn(unsigned long __unused)
509 {
510 struct switch_stack *sw = (struct switch_stack *) &__unused;
511 struct pt_regs *regs = (struct pt_regs *) (sw + 1);
512 unsigned long usp = rdusp();
513 struct rt_sigframe __user *frame = (struct rt_sigframe __user *)(usp - 4);
514 sigset_t set;
515 int d0;
516
517 if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
518 goto badframe;
519 if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
520 goto badframe;
521
522 sigdelsetmask(&set, ~_BLOCKABLE);
523 current->blocked = set;
524 recalc_sigpending();
525
526 if (rt_restore_ucontext(regs, sw, &frame->uc, &d0))
527 goto badframe;
528 return d0;
529
530 badframe:
531 force_sig(SIGSEGV, current);
532 return 0;
533 }
534
535 /*
536 * Set up a signal frame.
537 */
538
539 static inline void save_fpu_state(struct sigcontext *sc, struct pt_regs *regs)
540 {
541 if (FPU_IS_EMU) {
542 /* save registers */
543 memcpy(sc->sc_fpcntl, current->thread.fpcntl, 12);
544 memcpy(sc->sc_fpregs, current->thread.fp, 24);
545 return;
546 }
547
548 __asm__ volatile (".chip 68k/68881\n\t"
549 "fsave %0\n\t"
550 ".chip 68k"
551 : : "m" (*sc->sc_fpstate) : "memory");
552
553 if (CPU_IS_060 ? sc->sc_fpstate[2] : sc->sc_fpstate[0]) {
554 fpu_version = sc->sc_fpstate[0];
555 if (CPU_IS_020_OR_030 &&
556 regs->vector >= (VEC_FPBRUC * 4) &&
557 regs->vector <= (VEC_FPNAN * 4)) {
558 /* Clear pending exception in 68882 idle frame */
559 if (*(unsigned short *) sc->sc_fpstate == 0x1f38)
560 sc->sc_fpstate[0x38] |= 1 << 3;
561 }
562 __asm__ volatile (".chip 68k/68881\n\t"
563 "fmovemx %%fp0-%%fp1,%0\n\t"
564 "fmoveml %%fpcr/%%fpsr/%%fpiar,%1\n\t"
565 ".chip 68k"
566 : "=m" (*sc->sc_fpregs),
567 "=m" (*sc->sc_fpcntl)
568 : /* no inputs */
569 : "memory");
570 }
571 }
572
573 static inline int rt_save_fpu_state(struct ucontext __user *uc, struct pt_regs *regs)
574 {
575 unsigned char fpstate[FPCONTEXT_SIZE];
576 int context_size = CPU_IS_060 ? 8 : 0;
577 int err = 0;
578
579 if (FPU_IS_EMU) {
580 /* save fpu control register */
581 err |= copy_to_user(uc->uc_mcontext.fpregs.f_fpcntl,
582 current->thread.fpcntl, 12);
583 /* save all other fpu register */
584 err |= copy_to_user(uc->uc_mcontext.fpregs.f_fpregs,
585 current->thread.fp, 96);
586 return err;
587 }
588
589 __asm__ volatile (".chip 68k/68881\n\t"
590 "fsave %0\n\t"
591 ".chip 68k"
592 : : "m" (*fpstate) : "memory");
593
594 err |= __put_user(*(long *)fpstate, (long __user *)&uc->uc_fpstate);
595 if (CPU_IS_060 ? fpstate[2] : fpstate[0]) {
596 fpregset_t fpregs;
597 if (!CPU_IS_060)
598 context_size = fpstate[1];
599 fpu_version = fpstate[0];
600 if (CPU_IS_020_OR_030 &&
601 regs->vector >= (VEC_FPBRUC * 4) &&
602 regs->vector <= (VEC_FPNAN * 4)) {
603 /* Clear pending exception in 68882 idle frame */
604 if (*(unsigned short *) fpstate == 0x1f38)
605 fpstate[0x38] |= 1 << 3;
606 }
607 __asm__ volatile (".chip 68k/68881\n\t"
608 "fmovemx %%fp0-%%fp7,%0\n\t"
609 "fmoveml %%fpcr/%%fpsr/%%fpiar,%1\n\t"
610 ".chip 68k"
611 : "=m" (*fpregs.f_fpregs),
612 "=m" (*fpregs.f_fpcntl)
613 : /* no inputs */
614 : "memory");
615 err |= copy_to_user(&uc->uc_mcontext.fpregs, &fpregs,
616 sizeof(fpregs));
617 }
618 if (context_size)
619 err |= copy_to_user((long __user *)&uc->uc_fpstate + 1, fpstate + 4,
620 context_size);
621 return err;
622 }
623
624 static void setup_sigcontext(struct sigcontext *sc, struct pt_regs *regs,
625 unsigned long mask)
626 {
627 sc->sc_mask = mask;
628 sc->sc_usp = rdusp();
629 sc->sc_d0 = regs->d0;
630 sc->sc_d1 = regs->d1;
631 sc->sc_a0 = regs->a0;
632 sc->sc_a1 = regs->a1;
633 sc->sc_sr = regs->sr;
634 sc->sc_pc = regs->pc;
635 sc->sc_formatvec = regs->format << 12 | regs->vector;
636 save_fpu_state(sc, regs);
637 }
638
639 static inline int rt_setup_ucontext(struct ucontext __user *uc, struct pt_regs *regs)
640 {
641 struct switch_stack *sw = (struct switch_stack *)regs - 1;
642 greg_t __user *gregs = uc->uc_mcontext.gregs;
643 int err = 0;
644
645 err |= __put_user(MCONTEXT_VERSION, &uc->uc_mcontext.version);
646 err |= __put_user(regs->d0, &gregs[0]);
647 err |= __put_user(regs->d1, &gregs[1]);
648 err |= __put_user(regs->d2, &gregs[2]);
649 err |= __put_user(regs->d3, &gregs[3]);
650 err |= __put_user(regs->d4, &gregs[4]);
651 err |= __put_user(regs->d5, &gregs[5]);
652 err |= __put_user(sw->d6, &gregs[6]);
653 err |= __put_user(sw->d7, &gregs[7]);
654 err |= __put_user(regs->a0, &gregs[8]);
655 err |= __put_user(regs->a1, &gregs[9]);
656 err |= __put_user(regs->a2, &gregs[10]);
657 err |= __put_user(sw->a3, &gregs[11]);
658 err |= __put_user(sw->a4, &gregs[12]);
659 err |= __put_user(sw->a5, &gregs[13]);
660 err |= __put_user(sw->a6, &gregs[14]);
661 err |= __put_user(rdusp(), &gregs[15]);
662 err |= __put_user(regs->pc, &gregs[16]);
663 err |= __put_user(regs->sr, &gregs[17]);
664 err |= __put_user((regs->format << 12) | regs->vector, &uc->uc_formatvec);
665 err |= rt_save_fpu_state(uc, regs);
666 return err;
667 }
668
669 static inline void push_cache (unsigned long vaddr)
670 {
671 /*
672 * Using the old cache_push_v() was really a big waste.
673 *
674 * What we are trying to do is to flush 8 bytes to ram.
675 * Flushing 2 cache lines of 16 bytes is much cheaper than
676 * flushing 1 or 2 pages, as previously done in
677 * cache_push_v().
678 * Jes
679 */
680 if (CPU_IS_040) {
681 unsigned long temp;
682
683 __asm__ __volatile__ (".chip 68040\n\t"
684 "nop\n\t"
685 "ptestr (%1)\n\t"
686 "movec %%mmusr,%0\n\t"
687 ".chip 68k"
688 : "=r" (temp)
689 : "a" (vaddr));
690
691 temp &= PAGE_MASK;
692 temp |= vaddr & ~PAGE_MASK;
693
694 __asm__ __volatile__ (".chip 68040\n\t"
695 "nop\n\t"
696 "cpushl %%bc,(%0)\n\t"
697 ".chip 68k"
698 : : "a" (temp));
699 }
700 else if (CPU_IS_060) {
701 unsigned long temp;
702 __asm__ __volatile__ (".chip 68060\n\t"
703 "plpar (%0)\n\t"
704 ".chip 68k"
705 : "=a" (temp)
706 : "0" (vaddr));
707 __asm__ __volatile__ (".chip 68060\n\t"
708 "cpushl %%bc,(%0)\n\t"
709 ".chip 68k"
710 : : "a" (temp));
711 }
712 else {
713 /*
714 * 68030/68020 have no writeback cache;
715 * still need to clear icache.
716 * Note that vaddr is guaranteed to be long word aligned.
717 */
718 unsigned long temp;
719 asm volatile ("movec %%cacr,%0" : "=r" (temp));
720 temp += 4;
721 asm volatile ("movec %0,%%caar\n\t"
722 "movec %1,%%cacr"
723 : : "r" (vaddr), "r" (temp));
724 asm volatile ("movec %0,%%caar\n\t"
725 "movec %1,%%cacr"
726 : : "r" (vaddr + 4), "r" (temp));
727 }
728 }
729
730 static inline void __user *
731 get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, size_t frame_size)
732 {
733 unsigned long usp;
734
735 /* Default to using normal stack. */
736 usp = rdusp();
737
738 /* This is the X/Open sanctioned signal stack switching. */
739 if (ka->sa.sa_flags & SA_ONSTACK) {
740 if (!sas_ss_flags(usp))
741 usp = current->sas_ss_sp + current->sas_ss_size;
742 }
743 return (void __user *)((usp - frame_size) & -8UL);
744 }
745
746 static void setup_frame (int sig, struct k_sigaction *ka,
747 sigset_t *set, struct pt_regs *regs)
748 {
749 struct sigframe __user *frame;
750 int fsize = frame_extra_sizes[regs->format];
751 struct sigcontext context;
752 int err = 0;
753
754 if (fsize < 0) {
755 #ifdef DEBUG
756 printk ("setup_frame: Unknown frame format %#x\n",
757 regs->format);
758 #endif
759 goto give_sigsegv;
760 }
761
762 frame = get_sigframe(ka, regs, sizeof(*frame) + fsize);
763
764 if (fsize) {
765 err |= copy_to_user (frame + 1, regs + 1, fsize);
766 regs->stkadj = fsize;
767 }
768
769 err |= __put_user((current_thread_info()->exec_domain
770 && current_thread_info()->exec_domain->signal_invmap
771 && sig < 32
772 ? current_thread_info()->exec_domain->signal_invmap[sig]
773 : sig),
774 &frame->sig);
775
776 err |= __put_user(regs->vector, &frame->code);
777 err |= __put_user(&frame->sc, &frame->psc);
778
779 if (_NSIG_WORDS > 1)
780 err |= copy_to_user(frame->extramask, &set->sig[1],
781 sizeof(frame->extramask));
782
783 setup_sigcontext(&context, regs, set->sig[0]);
784 err |= copy_to_user (&frame->sc, &context, sizeof(context));
785
786 /* Set up to return from userspace. */
787 err |= __put_user(frame->retcode, &frame->pretcode);
788 /* moveq #,d0; trap #0 */
789 err |= __put_user(0x70004e40 + (__NR_sigreturn << 16),
790 (long __user *)(frame->retcode));
791
792 if (err)
793 goto give_sigsegv;
794
795 push_cache ((unsigned long) &frame->retcode);
796
797 /* Set up registers for signal handler */
798 wrusp ((unsigned long) frame);
799 regs->pc = (unsigned long) ka->sa.sa_handler;
800
801 adjust_stack:
802 /* Prepare to skip over the extra stuff in the exception frame. */
803 if (regs->stkadj) {
804 struct pt_regs *tregs =
805 (struct pt_regs *)((ulong)regs + regs->stkadj);
806 #ifdef DEBUG
807 printk("Performing stackadjust=%04x\n", regs->stkadj);
808 #endif
809 /* This must be copied with decreasing addresses to
810 handle overlaps. */
811 tregs->vector = 0;
812 tregs->format = 0;
813 tregs->pc = regs->pc;
814 tregs->sr = regs->sr;
815 }
816 return;
817
818 give_sigsegv:
819 force_sigsegv(sig, current);
820 goto adjust_stack;
821 }
822
823 static void setup_rt_frame (int sig, struct k_sigaction *ka, siginfo_t *info,
824 sigset_t *set, struct pt_regs *regs)
825 {
826 struct rt_sigframe __user *frame;
827 int fsize = frame_extra_sizes[regs->format];
828 int err = 0;
829
830 if (fsize < 0) {
831 #ifdef DEBUG
832 printk ("setup_frame: Unknown frame format %#x\n",
833 regs->format);
834 #endif
835 goto give_sigsegv;
836 }
837
838 frame = get_sigframe(ka, regs, sizeof(*frame));
839
840 if (fsize) {
841 err |= copy_to_user (&frame->uc.uc_extra, regs + 1, fsize);
842 regs->stkadj = fsize;
843 }
844
845 err |= __put_user((current_thread_info()->exec_domain
846 && current_thread_info()->exec_domain->signal_invmap
847 && sig < 32
848 ? current_thread_info()->exec_domain->signal_invmap[sig]
849 : sig),
850 &frame->sig);
851 err |= __put_user(&frame->info, &frame->pinfo);
852 err |= __put_user(&frame->uc, &frame->puc);
853 err |= copy_siginfo_to_user(&frame->info, info);
854
855 /* Create the ucontext. */
856 err |= __put_user(0, &frame->uc.uc_flags);
857 err |= __put_user(NULL, &frame->uc.uc_link);
858 err |= __put_user((void __user *)current->sas_ss_sp,
859 &frame->uc.uc_stack.ss_sp);
860 err |= __put_user(sas_ss_flags(rdusp()),
861 &frame->uc.uc_stack.ss_flags);
862 err |= __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size);
863 err |= rt_setup_ucontext(&frame->uc, regs);
864 err |= copy_to_user (&frame->uc.uc_sigmask, set, sizeof(*set));
865
866 /* Set up to return from userspace. */
867 err |= __put_user(frame->retcode, &frame->pretcode);
868 #ifdef __mcoldfire__
869 /* movel #__NR_rt_sigreturn,d0; trap #0 */
870 err |= __put_user(0x203c0000, (long __user *)(frame->retcode + 0));
871 err |= __put_user(0x00004e40 + (__NR_rt_sigreturn << 16),
872 (long __user *)(frame->retcode + 4));
873 #else
874 /* moveq #,d0; notb d0; trap #0 */
875 err |= __put_user(0x70004600 + ((__NR_rt_sigreturn ^ 0xff) << 16),
876 (long __user *)(frame->retcode + 0));
877 err |= __put_user(0x4e40, (short __user *)(frame->retcode + 4));
878 #endif
879
880 if (err)
881 goto give_sigsegv;
882
883 push_cache ((unsigned long) &frame->retcode);
884
885 /* Set up registers for signal handler */
886 wrusp ((unsigned long) frame);
887 regs->pc = (unsigned long) ka->sa.sa_handler;
888
889 adjust_stack:
890 /* Prepare to skip over the extra stuff in the exception frame. */
891 if (regs->stkadj) {
892 struct pt_regs *tregs =
893 (struct pt_regs *)((ulong)regs + regs->stkadj);
894 #ifdef DEBUG
895 printk("Performing stackadjust=%04x\n", regs->stkadj);
896 #endif
897 /* This must be copied with decreasing addresses to
898 handle overlaps. */
899 tregs->vector = 0;
900 tregs->format = 0;
901 tregs->pc = regs->pc;
902 tregs->sr = regs->sr;
903 }
904 return;
905
906 give_sigsegv:
907 force_sigsegv(sig, current);
908 goto adjust_stack;
909 }
910
911 static inline void
912 handle_restart(struct pt_regs *regs, struct k_sigaction *ka, int has_handler)
913 {
914 switch (regs->d0) {
915 case -ERESTARTNOHAND:
916 if (!has_handler)
917 goto do_restart;
918 regs->d0 = -EINTR;
919 break;
920
921 case -ERESTART_RESTARTBLOCK:
922 if (!has_handler) {
923 regs->d0 = __NR_restart_syscall;
924 regs->pc -= 2;
925 break;
926 }
927 regs->d0 = -EINTR;
928 break;
929
930 case -ERESTARTSYS:
931 if (has_handler && !(ka->sa.sa_flags & SA_RESTART)) {
932 regs->d0 = -EINTR;
933 break;
934 }
935 /* fallthrough */
936 case -ERESTARTNOINTR:
937 do_restart:
938 regs->d0 = regs->orig_d0;
939 regs->pc -= 2;
940 break;
941 }
942 }
943
944 void ptrace_signal_deliver(struct pt_regs *regs, void *cookie)
945 {
946 if (regs->orig_d0 < 0)
947 return;
948 switch (regs->d0) {
949 case -ERESTARTNOHAND:
950 case -ERESTARTSYS:
951 case -ERESTARTNOINTR:
952 regs->d0 = regs->orig_d0;
953 regs->orig_d0 = -1;
954 regs->pc -= 2;
955 break;
956 }
957 }
958
959 /*
960 * OK, we're invoking a handler
961 */
962 static void
963 handle_signal(int sig, struct k_sigaction *ka, siginfo_t *info,
964 sigset_t *oldset, struct pt_regs *regs)
965 {
966 /* are we from a system call? */
967 if (regs->orig_d0 >= 0)
968 /* If so, check system call restarting.. */
969 handle_restart(regs, ka, 1);
970
971 /* set up the stack frame */
972 if (ka->sa.sa_flags & SA_SIGINFO)
973 setup_rt_frame(sig, ka, info, oldset, regs);
974 else
975 setup_frame(sig, ka, oldset, regs);
976
977 sigorsets(&current->blocked,&current->blocked,&ka->sa.sa_mask);
978 if (!(ka->sa.sa_flags & SA_NODEFER))
979 sigaddset(&current->blocked,sig);
980 recalc_sigpending();
981 }
982
983 /*
984 * Note that 'init' is a special process: it doesn't get signals it doesn't
985 * want to handle. Thus you cannot kill init even with a SIGKILL even by
986 * mistake.
987 */
988 asmlinkage int do_signal(struct pt_regs *regs)
989 {
990 siginfo_t info;
991 struct k_sigaction ka;
992 int signr;
993 sigset_t *oldset;
994
995 current->thread.esp0 = (unsigned long) regs;
996
997 if (test_thread_flag(TIF_RESTORE_SIGMASK))
998 oldset = &current->saved_sigmask;
999 else
1000 oldset = &current->blocked;
1001
1002 signr = get_signal_to_deliver(&info, &ka, regs, NULL);
1003 if (signr > 0) {
1004 /* Whee! Actually deliver the signal. */
1005 handle_signal(signr, &ka, &info, oldset, regs);
1006 clear_thread_flag(TIF_RESTORE_SIGMASK);
1007 return 1;
1008 }
1009
1010 /* Did we come from a system call? */
1011 if (regs->orig_d0 >= 0)
1012 /* Restart the system call - no handlers present */
1013 handle_restart(regs, NULL, 0);
1014
1015 /* If there's no signal to deliver, we just restore the saved mask. */
1016 if (test_thread_flag(TIF_RESTORE_SIGMASK)) {
1017 clear_thread_flag(TIF_RESTORE_SIGMASK);
1018 sigprocmask(SIG_SETMASK, &current->saved_sigmask, NULL);
1019 }
1020
1021 return 0;
1022 }
Linux 2.6 ibm-acpi/thinkpad-acpi driver git tree