08d30617699589f7becf333381d0643c468cef25
[pandora-kernel.git] / arch / um / os-Linux / signal.c
1 /*
2  * Copyright (C) 2004 PathScale, Inc
3  * Copyright (C) 2004 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
4  * Licensed under the GPL
5  */
6
7 #include <stdlib.h>
8 #include <stdarg.h>
9 #include <errno.h>
10 #include <signal.h>
11 #include <strings.h>
12 #include "as-layout.h"
13 #include "kern_util.h"
14 #include "os.h"
15 #include "process.h"
16 #include "sysdep/barrier.h"
17 #include "sysdep/sigcontext.h"
18
19 void (*sig_info[NSIG])(int, struct uml_pt_regs *) = {
20         [SIGTRAP]       = relay_signal,
21         [SIGFPE]        = relay_signal,
22         [SIGILL]        = relay_signal,
23         [SIGWINCH]      = winch,
24         [SIGBUS]        = bus_handler,
25         [SIGSEGV]       = segv_handler,
26         [SIGIO]         = sigio_handler,
27         [SIGVTALRM]     = timer_handler };
28
29 static void sig_handler_common(int sig, struct sigcontext *sc)
30 {
31         struct uml_pt_regs r;
32         int save_errno = errno;
33
34         r.is_user = 0;
35         if (sig == SIGSEGV) {
36                 /* For segfaults, we want the data from the sigcontext. */
37                 copy_sc(&r, sc);
38                 GET_FAULTINFO_FROM_SC(r.faultinfo, sc);
39         }
40
41         /* enable signals if sig isn't IRQ signal */
42         if ((sig != SIGIO) && (sig != SIGWINCH) && (sig != SIGVTALRM))
43                 unblock_signals();
44
45         (*sig_info[sig])(sig, &r);
46
47         errno = save_errno;
48 }
49
50 /*
51  * These are the asynchronous signals.  SIGPROF is excluded because we want to
52  * be able to profile all of UML, not just the non-critical sections.  If
53  * profiling is not thread-safe, then that is not my problem.  We can disable
54  * profiling when SMP is enabled in that case.
55  */
56 #define SIGIO_BIT 0
57 #define SIGIO_MASK (1 << SIGIO_BIT)
58
59 #define SIGVTALRM_BIT 1
60 #define SIGVTALRM_MASK (1 << SIGVTALRM_BIT)
61
62 static int signals_enabled;
63 static unsigned int signals_pending;
64
65 void sig_handler(int sig, struct sigcontext *sc)
66 {
67         int enabled;
68
69         enabled = signals_enabled;
70         if (!enabled && (sig == SIGIO)) {
71                 signals_pending |= SIGIO_MASK;
72                 return;
73         }
74
75         block_signals();
76
77         sig_handler_common(sig, sc);
78
79         set_signals(enabled);
80 }
81
82 static void real_alarm_handler(struct sigcontext *sc)
83 {
84         struct uml_pt_regs regs;
85
86         if (sc != NULL)
87                 copy_sc(&regs, sc);
88         regs.is_user = 0;
89         unblock_signals();
90         timer_handler(SIGVTALRM, &regs);
91 }
92
93 void alarm_handler(int sig, struct sigcontext *sc)
94 {
95         int enabled;
96
97         enabled = signals_enabled;
98         if (!signals_enabled) {
99                 signals_pending |= SIGVTALRM_MASK;
100                 return;
101         }
102
103         block_signals();
104
105         real_alarm_handler(sc);
106         set_signals(enabled);
107 }
108
109 void timer_init(void)
110 {
111         set_handler(SIGVTALRM);
112 }
113
114 void set_sigstack(void *sig_stack, int size)
115 {
116         stack_t stack = ((stack_t) { .ss_flags  = 0,
117                                      .ss_sp     = (__ptr_t) sig_stack,
118                                      .ss_size   = size - sizeof(void *) });
119
120         if (sigaltstack(&stack, NULL) != 0)
121                 panic("enabling signal stack failed, errno = %d\n", errno);
122 }
123
124 static void (*handlers[_NSIG])(int sig, struct sigcontext *sc) = {
125         [SIGSEGV] = sig_handler,
126         [SIGBUS] = sig_handler,
127         [SIGILL] = sig_handler,
128         [SIGFPE] = sig_handler,
129         [SIGTRAP] = sig_handler,
130
131         [SIGIO] = sig_handler,
132         [SIGWINCH] = sig_handler,
133         [SIGVTALRM] = alarm_handler
134 };
135
136 static void handle_signal(int sig, struct sigcontext *sc)
137 {
138         unsigned long pending = 1UL << sig;
139
140         do {
141                 int nested, bail;
142
143                 /*
144                  * pending comes back with one bit set for each
145                  * interrupt that arrived while setting up the stack,
146                  * plus a bit for this interrupt, plus the zero bit is
147                  * set if this is a nested interrupt.
148                  * If bail is true, then we interrupted another
149                  * handler setting up the stack.  In this case, we
150                  * have to return, and the upper handler will deal
151                  * with this interrupt.
152                  */
153                 bail = to_irq_stack(&pending);
154                 if (bail)
155                         return;
156
157                 nested = pending & 1;
158                 pending &= ~1;
159
160                 while ((sig = ffs(pending)) != 0){
161                         sig--;
162                         pending &= ~(1 << sig);
163                         (*handlers[sig])(sig, sc);
164                 }
165
166                 /*
167                  * Again, pending comes back with a mask of signals
168                  * that arrived while tearing down the stack.  If this
169                  * is non-zero, we just go back, set up the stack
170                  * again, and handle the new interrupts.
171                  */
172                 if (!nested)
173                         pending = from_irq_stack(nested);
174         } while (pending);
175 }
176
177 static void hard_handler(int sig, siginfo_t *info, void *p)
178 {
179         struct ucontext *uc = p;
180         handle_signal(sig, (struct sigcontext *) &uc->uc_mcontext);
181 }
182
183 void set_handler(int sig)
184 {
185         struct sigaction action;
186         int flags = SA_SIGINFO | SA_ONSTACK;
187         sigset_t sig_mask;
188
189         action.sa_sigaction = hard_handler;
190
191         /* block irq ones */
192         sigemptyset(&action.sa_mask);
193         sigaddset(&action.sa_mask, SIGVTALRM);
194         sigaddset(&action.sa_mask, SIGIO);
195         sigaddset(&action.sa_mask, SIGWINCH);
196
197         if (sig == SIGSEGV)
198                 flags |= SA_NODEFER;
199
200         if (sigismember(&action.sa_mask, sig))
201                 flags |= SA_RESTART; /* if it's an irq signal */
202
203         action.sa_flags = flags;
204         action.sa_restorer = NULL;
205         if (sigaction(sig, &action, NULL) < 0)
206                 panic("sigaction failed - errno = %d\n", errno);
207
208         sigemptyset(&sig_mask);
209         sigaddset(&sig_mask, sig);
210         if (sigprocmask(SIG_UNBLOCK, &sig_mask, NULL) < 0)
211                 panic("sigprocmask failed - errno = %d\n", errno);
212 }
213
214 int change_sig(int signal, int on)
215 {
216         sigset_t sigset;
217
218         sigemptyset(&sigset);
219         sigaddset(&sigset, signal);
220         if (sigprocmask(on ? SIG_UNBLOCK : SIG_BLOCK, &sigset, NULL) < 0)
221                 return -errno;
222
223         return 0;
224 }
225
226 void block_signals(void)
227 {
228         signals_enabled = 0;
229         /*
230          * This must return with signals disabled, so this barrier
231          * ensures that writes are flushed out before the return.
232          * This might matter if gcc figures out how to inline this and
233          * decides to shuffle this code into the caller.
234          */
235         barrier();
236 }
237
238 void unblock_signals(void)
239 {
240         int save_pending;
241
242         if (signals_enabled == 1)
243                 return;
244
245         /*
246          * We loop because the IRQ handler returns with interrupts off.  So,
247          * interrupts may have arrived and we need to re-enable them and
248          * recheck signals_pending.
249          */
250         while (1) {
251                 /*
252                  * Save and reset save_pending after enabling signals.  This
253                  * way, signals_pending won't be changed while we're reading it.
254                  */
255                 signals_enabled = 1;
256
257                 /*
258                  * Setting signals_enabled and reading signals_pending must
259                  * happen in this order.
260                  */
261                 barrier();
262
263                 save_pending = signals_pending;
264                 if (save_pending == 0)
265                         return;
266
267                 signals_pending = 0;
268
269                 /*
270                  * We have pending interrupts, so disable signals, as the
271                  * handlers expect them off when they are called.  They will
272                  * be enabled again above.
273                  */
274
275                 signals_enabled = 0;
276
277                 /*
278                  * Deal with SIGIO first because the alarm handler might
279                  * schedule, leaving the pending SIGIO stranded until we come
280                  * back here.
281                  */
282                 if (save_pending & SIGIO_MASK)
283                         sig_handler_common(SIGIO, NULL);
284
285                 if (save_pending & SIGVTALRM_MASK)
286                         real_alarm_handler(NULL);
287         }
288 }
289
290 int get_signals(void)
291 {
292         return signals_enabled;
293 }
294
295 int set_signals(int enable)
296 {
297         int ret;
298         if (signals_enabled == enable)
299                 return enable;
300
301         ret = signals_enabled;
302         if (enable)
303                 unblock_signals();
304         else block_signals();
305
306         return ret;
307 }