Merge branch 'fixes' of git://git.kernel.org/pub/scm/linux/kernel/git/hskinnemoen...
[linux-2.6] / arch / mn10300 / kernel / signal.c
1 /* MN10300 Signal handling
2  *
3  * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
4  * Written by David Howells (dhowells@redhat.com)
5  *
6  * This program is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU General Public Licence
8  * as published by the Free Software Foundation; either version
9  * 2 of the Licence, or (at your option) any later version.
10  */
11
12 #include <linux/sched.h>
13 #include <linux/mm.h>
14 #include <linux/smp.h>
15 #include <linux/smp_lock.h>
16 #include <linux/kernel.h>
17 #include <linux/signal.h>
18 #include <linux/errno.h>
19 #include <linux/wait.h>
20 #include <linux/ptrace.h>
21 #include <linux/unistd.h>
22 #include <linux/stddef.h>
23 #include <linux/tty.h>
24 #include <linux/personality.h>
25 #include <linux/suspend.h>
26 #include <asm/cacheflush.h>
27 #include <asm/ucontext.h>
28 #include <asm/uaccess.h>
29 #include <asm/fpu.h>
30 #include "sigframe.h"
31
32 #define DEBUG_SIG 0
33
34 #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP)))
35
36 /*
37  * atomically swap in the new signal mask, and wait for a signal.
38  */
39 asmlinkage long sys_sigsuspend(int history0, int history1, old_sigset_t mask)
40 {
41         mask &= _BLOCKABLE;
42         spin_lock_irq(&current->sighand->siglock);
43         current->saved_sigmask = current->blocked;
44         siginitset(&current->blocked, mask);
45         recalc_sigpending();
46         spin_unlock_irq(&current->sighand->siglock);
47
48         current->state = TASK_INTERRUPTIBLE;
49         schedule();
50         set_thread_flag(TIF_RESTORE_SIGMASK);
51         return -ERESTARTNOHAND;
52 }
53
54 /*
55  * set signal action syscall
56  */
57 asmlinkage long sys_sigaction(int sig,
58                               const struct old_sigaction __user *act,
59                               struct old_sigaction __user *oact)
60 {
61         struct k_sigaction new_ka, old_ka;
62         int ret;
63
64         if (act) {
65                 old_sigset_t mask;
66                 if (verify_area(VERIFY_READ, act, sizeof(*act)) ||
67                     __get_user(new_ka.sa.sa_handler, &act->sa_handler) ||
68                     __get_user(new_ka.sa.sa_restorer, &act->sa_restorer))
69                         return -EFAULT;
70                 __get_user(new_ka.sa.sa_flags, &act->sa_flags);
71                 __get_user(mask, &act->sa_mask);
72                 siginitset(&new_ka.sa.sa_mask, mask);
73         }
74
75         ret = do_sigaction(sig, act ? &new_ka : NULL, oact ? &old_ka : NULL);
76
77         if (!ret && oact) {
78                 if (verify_area(VERIFY_WRITE, oact, sizeof(*oact)) ||
79                     __put_user(old_ka.sa.sa_handler, &oact->sa_handler) ||
80                     __put_user(old_ka.sa.sa_restorer, &oact->sa_restorer))
81                         return -EFAULT;
82                 __put_user(old_ka.sa.sa_flags, &oact->sa_flags);
83                 __put_user(old_ka.sa.sa_mask.sig[0], &oact->sa_mask);
84         }
85
86         return ret;
87 }
88
89 /*
90  * set alternate signal stack syscall
91  */
92 asmlinkage long sys_sigaltstack(const stack_t __user *uss, stack_t *uoss)
93 {
94         return do_sigaltstack(uss, uoss, __frame->sp);
95 }
96
97 /*
98  * do a signal return; undo the signal stack.
99  */
100 static int restore_sigcontext(struct pt_regs *regs,
101                               struct sigcontext __user *sc, long *_d0)
102 {
103         unsigned int err = 0;
104
105         if (is_using_fpu(current))
106                 fpu_kill_state(current);
107
108 #define COPY(x) err |= __get_user(regs->x, &sc->x)
109         COPY(d1); COPY(d2); COPY(d3);
110         COPY(a0); COPY(a1); COPY(a2); COPY(a3);
111         COPY(e0); COPY(e1); COPY(e2); COPY(e3);
112         COPY(e4); COPY(e5); COPY(e6); COPY(e7);
113         COPY(lar); COPY(lir);
114         COPY(mdr); COPY(mdrq);
115         COPY(mcvf); COPY(mcrl); COPY(mcrh);
116         COPY(sp); COPY(pc);
117 #undef COPY
118
119         {
120                 unsigned int tmpflags;
121 #ifndef CONFIG_MN10300_USING_JTAG
122 #define USER_EPSW (EPSW_FLAG_Z | EPSW_FLAG_N | EPSW_FLAG_C | EPSW_FLAG_V | \
123                    EPSW_T | EPSW_nAR)
124 #else
125 #define USER_EPSW (EPSW_FLAG_Z | EPSW_FLAG_N | EPSW_FLAG_C | EPSW_FLAG_V | \
126                    EPSW_nAR)
127 #endif
128                 err |= __get_user(tmpflags, &sc->epsw);
129                 regs->epsw = (regs->epsw & ~USER_EPSW) |
130                   (tmpflags & USER_EPSW);
131                 regs->orig_d0 = -1;             /* disable syscall checks */
132         }
133
134         {
135                 struct fpucontext *buf;
136                 err |= __get_user(buf, &sc->fpucontext);
137                 if (buf) {
138                         if (verify_area(VERIFY_READ, buf, sizeof(*buf)))
139                                 goto badframe;
140                         err |= fpu_restore_sigcontext(buf);
141                 }
142         }
143
144         err |= __get_user(*_d0, &sc->d0);
145         return err;
146
147 badframe:
148         return 1;
149 }
150
151 /*
152  * standard signal return syscall
153  */
154 asmlinkage long sys_sigreturn(void)
155 {
156         struct sigframe __user *frame = (struct sigframe __user *) __frame->sp;
157         sigset_t set;
158         long d0;
159
160         if (verify_area(VERIFY_READ, frame, sizeof(*frame)))
161                 goto badframe;
162         if (__get_user(set.sig[0], &frame->sc.oldmask))
163                 goto badframe;
164
165         if (_NSIG_WORDS > 1 &&
166             __copy_from_user(&set.sig[1], &frame->extramask,
167                              sizeof(frame->extramask)))
168                 goto badframe;
169
170         sigdelsetmask(&set, ~_BLOCKABLE);
171         spin_lock_irq(&current->sighand->siglock);
172         current->blocked = set;
173         recalc_sigpending();
174         spin_unlock_irq(&current->sighand->siglock);
175
176         if (restore_sigcontext(__frame, &frame->sc, &d0))
177                 goto badframe;
178
179         return d0;
180
181 badframe:
182         force_sig(SIGSEGV, current);
183         return 0;
184 }
185
186 /*
187  * realtime signal return syscall
188  */
189 asmlinkage long sys_rt_sigreturn(void)
190 {
191         struct rt_sigframe __user *frame =
192                 (struct rt_sigframe __user *) __frame->sp;
193         sigset_t set;
194         unsigned long d0;
195
196         if (verify_area(VERIFY_READ, frame, sizeof(*frame)))
197                 goto badframe;
198         if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
199                 goto badframe;
200
201         sigdelsetmask(&set, ~_BLOCKABLE);
202         spin_lock_irq(&current->sighand->siglock);
203         current->blocked = set;
204         recalc_sigpending();
205         spin_unlock_irq(&current->sighand->siglock);
206
207         if (restore_sigcontext(__frame, &frame->uc.uc_mcontext, &d0))
208                 goto badframe;
209
210         if (do_sigaltstack(&frame->uc.uc_stack, NULL, __frame->sp) == -EFAULT)
211                 goto badframe;
212
213         return d0;
214
215 badframe:
216         force_sig(SIGSEGV, current);
217         return 0;
218 }
219
220 /*
221  * store the userspace context into a signal frame
222  */
223 static int setup_sigcontext(struct sigcontext __user *sc,
224                             struct fpucontext *fpuctx,
225                             struct pt_regs *regs,
226                             unsigned long mask)
227 {
228         int tmp, err = 0;
229
230 #define COPY(x) err |= __put_user(regs->x, &sc->x)
231         COPY(d0); COPY(d1); COPY(d2); COPY(d3);
232         COPY(a0); COPY(a1); COPY(a2); COPY(a3);
233         COPY(e0); COPY(e1); COPY(e2); COPY(e3);
234         COPY(e4); COPY(e5); COPY(e6); COPY(e7);
235         COPY(lar); COPY(lir);
236         COPY(mdr); COPY(mdrq);
237         COPY(mcvf); COPY(mcrl); COPY(mcrh);
238         COPY(sp); COPY(epsw); COPY(pc);
239 #undef COPY
240
241         tmp = fpu_setup_sigcontext(fpuctx);
242         if (tmp < 0)
243                 err = 1;
244         else
245                 err |= __put_user(tmp ? fpuctx : NULL, &sc->fpucontext);
246
247         /* non-iBCS2 extensions.. */
248         err |= __put_user(mask, &sc->oldmask);
249
250         return err;
251 }
252
253 /*
254  * determine which stack to use..
255  */
256 static inline void __user *get_sigframe(struct k_sigaction *ka,
257                                         struct pt_regs *regs,
258                                         size_t frame_size)
259 {
260         unsigned long sp;
261
262         /* default to using normal stack */
263         sp = regs->sp;
264
265         /* this is the X/Open sanctioned signal stack switching.  */
266         if (ka->sa.sa_flags & SA_ONSTACK) {
267                 if (!on_sig_stack(sp))
268                         sp = current->sas_ss_sp + current->sas_ss_size;
269         }
270
271         return (void __user *) ((sp - frame_size) & ~7UL);
272 }
273
274 /*
275  * set up a normal signal frame
276  */
277 static int setup_frame(int sig, struct k_sigaction *ka, sigset_t *set,
278                        struct pt_regs *regs)
279 {
280         struct sigframe __user *frame;
281         int rsig;
282
283         frame = get_sigframe(ka, regs, sizeof(*frame));
284
285         if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
286                 goto give_sigsegv;
287
288         rsig = sig;
289         if (sig < 32 &&
290             current_thread_info()->exec_domain &&
291             current_thread_info()->exec_domain->signal_invmap)
292                 rsig = current_thread_info()->exec_domain->signal_invmap[sig];
293
294         if (__put_user(rsig, &frame->sig) < 0 ||
295             __put_user(&frame->sc, &frame->psc) < 0)
296                 goto give_sigsegv;
297
298         if (setup_sigcontext(&frame->sc, &frame->fpuctx, regs, set->sig[0]))
299                 goto give_sigsegv;
300
301         if (_NSIG_WORDS > 1) {
302                 if (__copy_to_user(frame->extramask, &set->sig[1],
303                                    sizeof(frame->extramask)))
304                         goto give_sigsegv;
305         }
306
307         /* set up to return from userspace.  If provided, use a stub already in
308          * userspace */
309         if (ka->sa.sa_flags & SA_RESTORER) {
310                 if (__put_user(ka->sa.sa_restorer, &frame->pretcode))
311                         goto give_sigsegv;
312         } else {
313                 if (__put_user((void (*)(void))frame->retcode,
314                                &frame->pretcode))
315                         goto give_sigsegv;
316                 /* this is mov $,d0; syscall 0 */
317                 if (__put_user(0x2c, (char *)(frame->retcode + 0)) ||
318                     __put_user(__NR_sigreturn, (char *)(frame->retcode + 1)) ||
319                     __put_user(0x00, (char *)(frame->retcode + 2)) ||
320                     __put_user(0xf0, (char *)(frame->retcode + 3)) ||
321                     __put_user(0xe0, (char *)(frame->retcode + 4)))
322                         goto give_sigsegv;
323                 flush_icache_range((unsigned long) frame->retcode,
324                                    (unsigned long) frame->retcode + 5);
325         }
326
327         /* set up registers for signal handler */
328         regs->sp = (unsigned long) frame;
329         regs->pc = (unsigned long) ka->sa.sa_handler;
330         regs->d0 = sig;
331         regs->d1 = (unsigned long) &frame->sc;
332
333         set_fs(USER_DS);
334
335         /* the tracer may want to single-step inside the handler */
336         if (test_thread_flag(TIF_SINGLESTEP))
337                 ptrace_notify(SIGTRAP);
338
339 #if DEBUG_SIG
340         printk(KERN_DEBUG "SIG deliver %d (%s:%d): sp=%p pc=%lx ra=%p\n",
341                sig, current->comm, current->pid, frame, regs->pc,
342                frame->pretcode);
343 #endif
344
345         return 0;
346
347 give_sigsegv:
348         force_sig(SIGSEGV, current);
349         return -EFAULT;
350 }
351
352 /*
353  * set up a realtime signal frame
354  */
355 static int setup_rt_frame(int sig, struct k_sigaction *ka, siginfo_t *info,
356                           sigset_t *set, struct pt_regs *regs)
357 {
358         struct rt_sigframe __user *frame;
359         int rsig;
360
361         frame = get_sigframe(ka, regs, sizeof(*frame));
362
363         if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
364                 goto give_sigsegv;
365
366         rsig = sig;
367         if (sig < 32 &&
368             current_thread_info()->exec_domain &&
369             current_thread_info()->exec_domain->signal_invmap)
370                 rsig = current_thread_info()->exec_domain->signal_invmap[sig];
371
372         if (__put_user(rsig, &frame->sig) ||
373             __put_user(&frame->info, &frame->pinfo) ||
374             __put_user(&frame->uc, &frame->puc) ||
375             copy_siginfo_to_user(&frame->info, info))
376                 goto give_sigsegv;
377
378         /* create the ucontext.  */
379         if (__put_user(0, &frame->uc.uc_flags) ||
380             __put_user(0, &frame->uc.uc_link) ||
381             __put_user((void *)current->sas_ss_sp, &frame->uc.uc_stack.ss_sp) ||
382             __put_user(sas_ss_flags(regs->sp), &frame->uc.uc_stack.ss_flags) ||
383             __put_user(current->sas_ss_size, &frame->uc.uc_stack.ss_size) ||
384             setup_sigcontext(&frame->uc.uc_mcontext,
385                              &frame->fpuctx, regs, set->sig[0]) ||
386             __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set)))
387                 goto give_sigsegv;
388
389         /* set up to return from userspace.  If provided, use a stub already in
390          * userspace */
391         if (ka->sa.sa_flags & SA_RESTORER) {
392                 if (__put_user(ka->sa.sa_restorer, &frame->pretcode))
393                         goto give_sigsegv;
394         } else {
395                 if (__put_user((void(*)(void))frame->retcode,
396                                &frame->pretcode) ||
397                     /* This is mov $,d0; syscall 0 */
398                     __put_user(0x2c, (char *)(frame->retcode + 0)) ||
399                     __put_user(__NR_rt_sigreturn,
400                                (char *)(frame->retcode + 1)) ||
401                     __put_user(0x00, (char *)(frame->retcode + 2)) ||
402                     __put_user(0xf0, (char *)(frame->retcode + 3)) ||
403                     __put_user(0xe0, (char *)(frame->retcode + 4)))
404                         goto give_sigsegv;
405
406                 flush_icache_range((u_long) frame->retcode,
407                                    (u_long) frame->retcode + 5);
408         }
409
410         /* Set up registers for signal handler */
411         regs->sp = (unsigned long) frame;
412         regs->pc = (unsigned long) ka->sa.sa_handler;
413         regs->d0 = sig;
414         regs->d1 = (long) &frame->info;
415
416         set_fs(USER_DS);
417
418         /* the tracer may want to single-step inside the handler */
419         if (test_thread_flag(TIF_SINGLESTEP))
420                 ptrace_notify(SIGTRAP);
421
422 #if DEBUG_SIG
423         printk(KERN_DEBUG "SIG deliver %d (%s:%d): sp=%p pc=%lx ra=%p\n",
424                sig, current->comm, current->pid, frame, regs->pc,
425                frame->pretcode);
426 #endif
427
428         return 0;
429
430 give_sigsegv:
431         force_sig(SIGSEGV, current);
432         return -EFAULT;
433 }
434
435 /*
436  * handle the actual delivery of a signal to userspace
437  */
438 static int handle_signal(int sig,
439                          siginfo_t *info, struct k_sigaction *ka,
440                          sigset_t *oldset, struct pt_regs *regs)
441 {
442         int ret;
443
444         /* Are we from a system call? */
445         if (regs->orig_d0 >= 0) {
446                 /* If so, check system call restarting.. */
447                 switch (regs->d0) {
448                 case -ERESTART_RESTARTBLOCK:
449                 case -ERESTARTNOHAND:
450                         regs->d0 = -EINTR;
451                         break;
452
453                 case -ERESTARTSYS:
454                         if (!(ka->sa.sa_flags & SA_RESTART)) {
455                                 regs->d0 = -EINTR;
456                                 break;
457                         }
458
459                         /* fallthrough */
460                 case -ERESTARTNOINTR:
461                         regs->d0 = regs->orig_d0;
462                         regs->pc -= 2;
463                 }
464         }
465
466         /* Set up the stack frame */
467         if (ka->sa.sa_flags & SA_SIGINFO)
468                 ret = setup_rt_frame(sig, ka, info, oldset, regs);
469         else
470                 ret = setup_frame(sig, ka, oldset, regs);
471
472         if (ret == 0) {
473                 spin_lock_irq(&current->sighand->siglock);
474                 sigorsets(&current->blocked, &current->blocked,
475                           &ka->sa.sa_mask);
476                 if (!(ka->sa.sa_flags & SA_NODEFER))
477                         sigaddset(&current->blocked, sig);
478                 recalc_sigpending();
479                 spin_unlock_irq(&current->sighand->siglock);
480         }
481
482         return ret;
483 }
484
485 /*
486  * handle a potential signal
487  */
488 static void do_signal(struct pt_regs *regs)
489 {
490         struct k_sigaction ka;
491         siginfo_t info;
492         sigset_t *oldset;
493         int signr;
494
495         /* we want the common case to go fast, which is why we may in certain
496          * cases get here from kernel mode */
497         if (!user_mode(regs))
498                 return;
499
500         if (test_thread_flag(TIF_RESTORE_SIGMASK))
501                 oldset = &current->saved_sigmask;
502         else
503                 oldset = &current->blocked;
504
505         signr = get_signal_to_deliver(&info, &ka, regs, NULL);
506         if (signr > 0) {
507                 if (handle_signal(signr, &info, &ka, oldset, regs) == 0) {
508                         /* a signal was successfully delivered; the saved
509                          * sigmask will have been stored in the signal frame,
510                          * and will be restored by sigreturn, so we can simply
511                          * clear the TIF_RESTORE_SIGMASK flag */
512                         if (test_thread_flag(TIF_RESTORE_SIGMASK))
513                                 clear_thread_flag(TIF_RESTORE_SIGMASK);
514                 }
515
516                 return;
517         }
518
519         /* did we come from a system call? */
520         if (regs->orig_d0 >= 0) {
521                 /* restart the system call - no handlers present */
522                 switch (regs->d0) {
523                 case -ERESTARTNOHAND:
524                 case -ERESTARTSYS:
525                 case -ERESTARTNOINTR:
526                         regs->d0 = regs->orig_d0;
527                         regs->pc -= 2;
528                         break;
529
530                 case -ERESTART_RESTARTBLOCK:
531                         regs->d0 = __NR_restart_syscall;
532                         regs->pc -= 2;
533                         break;
534                 }
535         }
536
537         /* if there's no signal to deliver, we just put the saved sigmask
538          * back */
539         if (test_thread_flag(TIF_RESTORE_SIGMASK)) {
540                 clear_thread_flag(TIF_RESTORE_SIGMASK);
541                 sigprocmask(SIG_SETMASK, &current->saved_sigmask, NULL);
542         }
543 }
544
545 /*
546  * notification of userspace execution resumption
547  * - triggered by current->work.notify_resume
548  */
549 asmlinkage void do_notify_resume(struct pt_regs *regs, u32 thread_info_flags)
550 {
551         /* Pending single-step? */
552         if (thread_info_flags & _TIF_SINGLESTEP) {
553 #ifndef CONFIG_MN10300_USING_JTAG
554                 regs->epsw |= EPSW_T;
555                 clear_thread_flag(TIF_SINGLESTEP);
556 #else
557                 BUG(); /* no h/w single-step if using JTAG unit */
558 #endif
559         }
560
561         /* deal with pending signal delivery */
562         if (thread_info_flags & (_TIF_SIGPENDING | _TIF_RESTORE_SIGMASK))
563                 do_signal(regs);
564 }