diff options
Diffstat (limited to 'arch/sparc64/kernel/signal.c')
-rw-r--r-- | arch/sparc64/kernel/signal.c | 688 |
1 files changed, 688 insertions, 0 deletions
diff --git a/arch/sparc64/kernel/signal.c b/arch/sparc64/kernel/signal.c new file mode 100644 index 000000000000..b27934671c35 --- /dev/null +++ b/arch/sparc64/kernel/signal.c | |||
@@ -0,0 +1,688 @@ | |||
1 | /* $Id: signal.c,v 1.60 2002/02/09 19:49:31 davem Exp $ | ||
2 | * arch/sparc64/kernel/signal.c | ||
3 | * | ||
4 | * Copyright (C) 1991, 1992 Linus Torvalds | ||
5 | * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu) | ||
6 | * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx) | ||
7 | * Copyright (C) 1997 Eddie C. Dost (ecd@skynet.be) | ||
8 | * Copyright (C) 1997,1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz) | ||
9 | */ | ||
10 | |||
11 | #include <linux/config.h> | ||
12 | #ifdef CONFIG_SPARC32_COMPAT | ||
13 | #include <linux/compat.h> /* for compat_old_sigset_t */ | ||
14 | #endif | ||
15 | #include <linux/sched.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/mm.h> | ||
23 | #include <linux/tty.h> | ||
24 | #include <linux/smp_lock.h> | ||
25 | #include <linux/binfmts.h> | ||
26 | #include <linux/bitops.h> | ||
27 | |||
28 | #include <asm/uaccess.h> | ||
29 | #include <asm/ptrace.h> | ||
30 | #include <asm/svr4.h> | ||
31 | #include <asm/pgtable.h> | ||
32 | #include <asm/fpumacro.h> | ||
33 | #include <asm/uctx.h> | ||
34 | #include <asm/siginfo.h> | ||
35 | #include <asm/visasm.h> | ||
36 | |||
37 | #define _BLOCKABLE (~(sigmask(SIGKILL) | sigmask(SIGSTOP))) | ||
38 | |||
39 | static int do_signal(sigset_t *oldset, struct pt_regs * regs, | ||
40 | unsigned long orig_o0, int ret_from_syscall); | ||
41 | |||
42 | /* {set, get}context() needed for 64-bit SparcLinux userland. */ | ||
43 | asmlinkage void sparc64_set_context(struct pt_regs *regs) | ||
44 | { | ||
45 | struct ucontext __user *ucp = (struct ucontext __user *) | ||
46 | regs->u_regs[UREG_I0]; | ||
47 | mc_gregset_t __user *grp; | ||
48 | unsigned long pc, npc, tstate; | ||
49 | unsigned long fp, i7; | ||
50 | unsigned char fenab; | ||
51 | int err; | ||
52 | |||
53 | flush_user_windows(); | ||
54 | if (get_thread_wsaved() || | ||
55 | (((unsigned long)ucp) & (sizeof(unsigned long)-1)) || | ||
56 | (!__access_ok(ucp, sizeof(*ucp)))) | ||
57 | goto do_sigsegv; | ||
58 | grp = &ucp->uc_mcontext.mc_gregs; | ||
59 | err = __get_user(pc, &((*grp)[MC_PC])); | ||
60 | err |= __get_user(npc, &((*grp)[MC_NPC])); | ||
61 | if (err || ((pc | npc) & 3)) | ||
62 | goto do_sigsegv; | ||
63 | if (regs->u_regs[UREG_I1]) { | ||
64 | sigset_t set; | ||
65 | |||
66 | if (_NSIG_WORDS == 1) { | ||
67 | if (__get_user(set.sig[0], &ucp->uc_sigmask.sig[0])) | ||
68 | goto do_sigsegv; | ||
69 | } else { | ||
70 | if (__copy_from_user(&set, &ucp->uc_sigmask, sizeof(sigset_t))) | ||
71 | goto do_sigsegv; | ||
72 | } | ||
73 | sigdelsetmask(&set, ~_BLOCKABLE); | ||
74 | spin_lock_irq(¤t->sighand->siglock); | ||
75 | current->blocked = set; | ||
76 | recalc_sigpending(); | ||
77 | spin_unlock_irq(¤t->sighand->siglock); | ||
78 | } | ||
79 | if (test_thread_flag(TIF_32BIT)) { | ||
80 | pc &= 0xffffffff; | ||
81 | npc &= 0xffffffff; | ||
82 | } | ||
83 | regs->tpc = pc; | ||
84 | regs->tnpc = npc; | ||
85 | err |= __get_user(regs->y, &((*grp)[MC_Y])); | ||
86 | err |= __get_user(tstate, &((*grp)[MC_TSTATE])); | ||
87 | regs->tstate &= ~(TSTATE_ASI | TSTATE_ICC | TSTATE_XCC); | ||
88 | regs->tstate |= (tstate & (TSTATE_ASI | TSTATE_ICC | TSTATE_XCC)); | ||
89 | err |= __get_user(regs->u_regs[UREG_G1], (&(*grp)[MC_G1])); | ||
90 | err |= __get_user(regs->u_regs[UREG_G2], (&(*grp)[MC_G2])); | ||
91 | err |= __get_user(regs->u_regs[UREG_G3], (&(*grp)[MC_G3])); | ||
92 | err |= __get_user(regs->u_regs[UREG_G4], (&(*grp)[MC_G4])); | ||
93 | err |= __get_user(regs->u_regs[UREG_G5], (&(*grp)[MC_G5])); | ||
94 | err |= __get_user(regs->u_regs[UREG_G6], (&(*grp)[MC_G6])); | ||
95 | err |= __get_user(regs->u_regs[UREG_G7], (&(*grp)[MC_G7])); | ||
96 | err |= __get_user(regs->u_regs[UREG_I0], (&(*grp)[MC_O0])); | ||
97 | err |= __get_user(regs->u_regs[UREG_I1], (&(*grp)[MC_O1])); | ||
98 | err |= __get_user(regs->u_regs[UREG_I2], (&(*grp)[MC_O2])); | ||
99 | err |= __get_user(regs->u_regs[UREG_I3], (&(*grp)[MC_O3])); | ||
100 | err |= __get_user(regs->u_regs[UREG_I4], (&(*grp)[MC_O4])); | ||
101 | err |= __get_user(regs->u_regs[UREG_I5], (&(*grp)[MC_O5])); | ||
102 | err |= __get_user(regs->u_regs[UREG_I6], (&(*grp)[MC_O6])); | ||
103 | err |= __get_user(regs->u_regs[UREG_I7], (&(*grp)[MC_O7])); | ||
104 | |||
105 | err |= __get_user(fp, &(ucp->uc_mcontext.mc_fp)); | ||
106 | err |= __get_user(i7, &(ucp->uc_mcontext.mc_i7)); | ||
107 | err |= __put_user(fp, | ||
108 | (&(((struct reg_window __user *)(STACK_BIAS+regs->u_regs[UREG_I6]))->ins[6]))); | ||
109 | err |= __put_user(i7, | ||
110 | (&(((struct reg_window __user *)(STACK_BIAS+regs->u_regs[UREG_I6]))->ins[7]))); | ||
111 | |||
112 | err |= __get_user(fenab, &(ucp->uc_mcontext.mc_fpregs.mcfpu_enab)); | ||
113 | if (fenab) { | ||
114 | unsigned long *fpregs = current_thread_info()->fpregs; | ||
115 | unsigned long fprs; | ||
116 | |||
117 | fprs_write(0); | ||
118 | err |= __get_user(fprs, &(ucp->uc_mcontext.mc_fpregs.mcfpu_fprs)); | ||
119 | if (fprs & FPRS_DL) | ||
120 | err |= copy_from_user(fpregs, | ||
121 | &(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs), | ||
122 | (sizeof(unsigned int) * 32)); | ||
123 | if (fprs & FPRS_DU) | ||
124 | err |= copy_from_user(fpregs+16, | ||
125 | ((unsigned long __user *)&(ucp->uc_mcontext.mc_fpregs.mcfpu_fregs))+16, | ||
126 | (sizeof(unsigned int) * 32)); | ||
127 | err |= __get_user(current_thread_info()->xfsr[0], | ||
128 | &(ucp->uc_mcontext.mc_fpregs.mcfpu_fsr)); | ||
129 | err |= __get_user(current_thread_info()->gsr[0], | ||
130 | &(ucp->uc_mcontext.mc_fpregs.mcfpu_gsr)); | ||
131 | regs->tstate &= ~TSTATE_PEF; | ||
132 | } | ||
133 | if (err) | ||
134 | goto do_sigsegv; | ||
135 | |||
136 | return; | ||
137 | do_sigsegv: | ||
138 | force_sig(SIGSEGV, current); | ||
139 | } | ||
140 | |||
141 | asmlinkage void sparc64_get_context(struct pt_regs *regs) | ||
142 | { | ||
143 | struct ucontext __user *ucp = (struct ucontext __user *) | ||
144 | regs->u_regs[UREG_I0]; | ||
145 | mc_gregset_t __user *grp; | ||
146 | mcontext_t __user *mcp; | ||
147 | unsigned long fp, i7; | ||
148 | unsigned char fenab; | ||
149 | int err; | ||
150 | |||
151 | synchronize_user_stack(); | ||
152 | if (get_thread_wsaved() || clear_user(ucp, sizeof(*ucp))) | ||
153 | goto do_sigsegv; | ||
154 | |||
155 | #if 1 | ||
156 | fenab = 0; /* IMO get_context is like any other system call, thus modifies FPU state -jj */ | ||
157 | #else | ||
158 | fenab = (current_thread_info()->fpsaved[0] & FPRS_FEF); | ||
159 | #endif | ||
160 | |||
161 | mcp = &ucp->uc_mcontext; | ||
162 | grp = &mcp->mc_gregs; | ||
163 | |||
164 | /* Skip over the trap instruction, first. */ | ||
165 | if (test_thread_flag(TIF_32BIT)) { | ||
166 | regs->tpc = (regs->tnpc & 0xffffffff); | ||
167 | regs->tnpc = (regs->tnpc + 4) & 0xffffffff; | ||
168 | } else { | ||
169 | regs->tpc = regs->tnpc; | ||
170 | regs->tnpc += 4; | ||
171 | } | ||
172 | err = 0; | ||
173 | if (_NSIG_WORDS == 1) | ||
174 | err |= __put_user(current->blocked.sig[0], | ||
175 | (unsigned long __user *)&ucp->uc_sigmask); | ||
176 | else | ||
177 | err |= __copy_to_user(&ucp->uc_sigmask, ¤t->blocked, | ||
178 | sizeof(sigset_t)); | ||
179 | |||
180 | err |= __put_user(regs->tstate, &((*grp)[MC_TSTATE])); | ||
181 | err |= __put_user(regs->tpc, &((*grp)[MC_PC])); | ||
182 | err |= __put_user(regs->tnpc, &((*grp)[MC_NPC])); | ||
183 | err |= __put_user(regs->y, &((*grp)[MC_Y])); | ||
184 | err |= __put_user(regs->u_regs[UREG_G1], &((*grp)[MC_G1])); | ||
185 | err |= __put_user(regs->u_regs[UREG_G2], &((*grp)[MC_G2])); | ||
186 | err |= __put_user(regs->u_regs[UREG_G3], &((*grp)[MC_G3])); | ||
187 | err |= __put_user(regs->u_regs[UREG_G4], &((*grp)[MC_G4])); | ||
188 | err |= __put_user(regs->u_regs[UREG_G5], &((*grp)[MC_G5])); | ||
189 | err |= __put_user(regs->u_regs[UREG_G6], &((*grp)[MC_G6])); | ||
190 | err |= __put_user(regs->u_regs[UREG_G7], &((*grp)[MC_G7])); | ||
191 | err |= __put_user(regs->u_regs[UREG_I0], &((*grp)[MC_O0])); | ||
192 | err |= __put_user(regs->u_regs[UREG_I1], &((*grp)[MC_O1])); | ||
193 | err |= __put_user(regs->u_regs[UREG_I2], &((*grp)[MC_O2])); | ||
194 | err |= __put_user(regs->u_regs[UREG_I3], &((*grp)[MC_O3])); | ||
195 | err |= __put_user(regs->u_regs[UREG_I4], &((*grp)[MC_O4])); | ||
196 | err |= __put_user(regs->u_regs[UREG_I5], &((*grp)[MC_O5])); | ||
197 | err |= __put_user(regs->u_regs[UREG_I6], &((*grp)[MC_O6])); | ||
198 | err |= __put_user(regs->u_regs[UREG_I7], &((*grp)[MC_O7])); | ||
199 | |||
200 | err |= __get_user(fp, | ||
201 | (&(((struct reg_window __user *)(STACK_BIAS+regs->u_regs[UREG_I6]))->ins[6]))); | ||
202 | err |= __get_user(i7, | ||
203 | (&(((struct reg_window __user *)(STACK_BIAS+regs->u_regs[UREG_I6]))->ins[7]))); | ||
204 | err |= __put_user(fp, &(mcp->mc_fp)); | ||
205 | err |= __put_user(i7, &(mcp->mc_i7)); | ||
206 | |||
207 | err |= __put_user(fenab, &(mcp->mc_fpregs.mcfpu_enab)); | ||
208 | if (fenab) { | ||
209 | unsigned long *fpregs = current_thread_info()->fpregs; | ||
210 | unsigned long fprs; | ||
211 | |||
212 | fprs = current_thread_info()->fpsaved[0]; | ||
213 | if (fprs & FPRS_DL) | ||
214 | err |= copy_to_user(&(mcp->mc_fpregs.mcfpu_fregs), fpregs, | ||
215 | (sizeof(unsigned int) * 32)); | ||
216 | if (fprs & FPRS_DU) | ||
217 | err |= copy_to_user( | ||
218 | ((unsigned long __user *)&(mcp->mc_fpregs.mcfpu_fregs))+16, fpregs+16, | ||
219 | (sizeof(unsigned int) * 32)); | ||
220 | err |= __put_user(current_thread_info()->xfsr[0], &(mcp->mc_fpregs.mcfpu_fsr)); | ||
221 | err |= __put_user(current_thread_info()->gsr[0], &(mcp->mc_fpregs.mcfpu_gsr)); | ||
222 | err |= __put_user(fprs, &(mcp->mc_fpregs.mcfpu_fprs)); | ||
223 | } | ||
224 | if (err) | ||
225 | goto do_sigsegv; | ||
226 | |||
227 | return; | ||
228 | do_sigsegv: | ||
229 | force_sig(SIGSEGV, current); | ||
230 | } | ||
231 | |||
232 | struct rt_signal_frame { | ||
233 | struct sparc_stackf ss; | ||
234 | siginfo_t info; | ||
235 | struct pt_regs regs; | ||
236 | __siginfo_fpu_t __user *fpu_save; | ||
237 | stack_t stack; | ||
238 | sigset_t mask; | ||
239 | __siginfo_fpu_t fpu_state; | ||
240 | }; | ||
241 | |||
242 | /* Align macros */ | ||
243 | #define RT_ALIGNEDSZ (((sizeof(struct rt_signal_frame) + 7) & (~7))) | ||
244 | |||
245 | /* | ||
246 | * atomically swap in the new signal mask, and wait for a signal. | ||
247 | * This is really tricky on the Sparc, watch out... | ||
248 | */ | ||
249 | asmlinkage void _sigpause_common(old_sigset_t set, struct pt_regs *regs) | ||
250 | { | ||
251 | sigset_t saveset; | ||
252 | |||
253 | #ifdef CONFIG_SPARC32_COMPAT | ||
254 | if (test_thread_flag(TIF_32BIT)) { | ||
255 | extern asmlinkage void _sigpause32_common(compat_old_sigset_t, | ||
256 | struct pt_regs *); | ||
257 | _sigpause32_common(set, regs); | ||
258 | return; | ||
259 | } | ||
260 | #endif | ||
261 | set &= _BLOCKABLE; | ||
262 | spin_lock_irq(¤t->sighand->siglock); | ||
263 | saveset = current->blocked; | ||
264 | siginitset(¤t->blocked, set); | ||
265 | recalc_sigpending(); | ||
266 | spin_unlock_irq(¤t->sighand->siglock); | ||
267 | |||
268 | if (test_thread_flag(TIF_32BIT)) { | ||
269 | regs->tpc = (regs->tnpc & 0xffffffff); | ||
270 | regs->tnpc = (regs->tnpc + 4) & 0xffffffff; | ||
271 | } else { | ||
272 | regs->tpc = regs->tnpc; | ||
273 | regs->tnpc += 4; | ||
274 | } | ||
275 | |||
276 | /* Condition codes and return value where set here for sigpause, | ||
277 | * and so got used by setup_frame, which again causes sigreturn() | ||
278 | * to return -EINTR. | ||
279 | */ | ||
280 | while (1) { | ||
281 | current->state = TASK_INTERRUPTIBLE; | ||
282 | schedule(); | ||
283 | /* | ||
284 | * Return -EINTR and set condition code here, | ||
285 | * so the interrupted system call actually returns | ||
286 | * these. | ||
287 | */ | ||
288 | regs->tstate |= (TSTATE_ICARRY|TSTATE_XCARRY); | ||
289 | regs->u_regs[UREG_I0] = EINTR; | ||
290 | if (do_signal(&saveset, regs, 0, 0)) | ||
291 | return; | ||
292 | } | ||
293 | } | ||
294 | |||
295 | asmlinkage void do_sigpause(unsigned int set, struct pt_regs *regs) | ||
296 | { | ||
297 | _sigpause_common(set, regs); | ||
298 | } | ||
299 | |||
300 | asmlinkage void do_sigsuspend(struct pt_regs *regs) | ||
301 | { | ||
302 | _sigpause_common(regs->u_regs[UREG_I0], regs); | ||
303 | } | ||
304 | |||
305 | asmlinkage void do_rt_sigsuspend(sigset_t __user *uset, size_t sigsetsize, struct pt_regs *regs) | ||
306 | { | ||
307 | sigset_t oldset, set; | ||
308 | |||
309 | /* XXX: Don't preclude handling different sized sigset_t's. */ | ||
310 | if (sigsetsize != sizeof(sigset_t)) { | ||
311 | regs->tstate |= (TSTATE_ICARRY|TSTATE_XCARRY); | ||
312 | regs->u_regs[UREG_I0] = EINVAL; | ||
313 | return; | ||
314 | } | ||
315 | if (copy_from_user(&set, uset, sizeof(set))) { | ||
316 | regs->tstate |= (TSTATE_ICARRY|TSTATE_XCARRY); | ||
317 | regs->u_regs[UREG_I0] = EFAULT; | ||
318 | return; | ||
319 | } | ||
320 | |||
321 | sigdelsetmask(&set, ~_BLOCKABLE); | ||
322 | spin_lock_irq(¤t->sighand->siglock); | ||
323 | oldset = current->blocked; | ||
324 | current->blocked = set; | ||
325 | recalc_sigpending(); | ||
326 | spin_unlock_irq(¤t->sighand->siglock); | ||
327 | |||
328 | if (test_thread_flag(TIF_32BIT)) { | ||
329 | regs->tpc = (regs->tnpc & 0xffffffff); | ||
330 | regs->tnpc = (regs->tnpc + 4) & 0xffffffff; | ||
331 | } else { | ||
332 | regs->tpc = regs->tnpc; | ||
333 | regs->tnpc += 4; | ||
334 | } | ||
335 | |||
336 | /* Condition codes and return value where set here for sigpause, | ||
337 | * and so got used by setup_frame, which again causes sigreturn() | ||
338 | * to return -EINTR. | ||
339 | */ | ||
340 | while (1) { | ||
341 | current->state = TASK_INTERRUPTIBLE; | ||
342 | schedule(); | ||
343 | /* | ||
344 | * Return -EINTR and set condition code here, | ||
345 | * so the interrupted system call actually returns | ||
346 | * these. | ||
347 | */ | ||
348 | regs->tstate |= (TSTATE_ICARRY|TSTATE_XCARRY); | ||
349 | regs->u_regs[UREG_I0] = EINTR; | ||
350 | if (do_signal(&oldset, regs, 0, 0)) | ||
351 | return; | ||
352 | } | ||
353 | } | ||
354 | |||
355 | static inline int | ||
356 | restore_fpu_state(struct pt_regs *regs, __siginfo_fpu_t __user *fpu) | ||
357 | { | ||
358 | unsigned long *fpregs = current_thread_info()->fpregs; | ||
359 | unsigned long fprs; | ||
360 | int err; | ||
361 | |||
362 | err = __get_user(fprs, &fpu->si_fprs); | ||
363 | fprs_write(0); | ||
364 | regs->tstate &= ~TSTATE_PEF; | ||
365 | if (fprs & FPRS_DL) | ||
366 | err |= copy_from_user(fpregs, &fpu->si_float_regs[0], | ||
367 | (sizeof(unsigned int) * 32)); | ||
368 | if (fprs & FPRS_DU) | ||
369 | err |= copy_from_user(fpregs+16, &fpu->si_float_regs[32], | ||
370 | (sizeof(unsigned int) * 32)); | ||
371 | err |= __get_user(current_thread_info()->xfsr[0], &fpu->si_fsr); | ||
372 | err |= __get_user(current_thread_info()->gsr[0], &fpu->si_gsr); | ||
373 | current_thread_info()->fpsaved[0] |= fprs; | ||
374 | return err; | ||
375 | } | ||
376 | |||
377 | void do_rt_sigreturn(struct pt_regs *regs) | ||
378 | { | ||
379 | struct rt_signal_frame __user *sf; | ||
380 | unsigned long tpc, tnpc, tstate; | ||
381 | __siginfo_fpu_t __user *fpu_save; | ||
382 | mm_segment_t old_fs; | ||
383 | sigset_t set; | ||
384 | stack_t st; | ||
385 | int err; | ||
386 | |||
387 | /* Always make any pending restarted system calls return -EINTR */ | ||
388 | current_thread_info()->restart_block.fn = do_no_restart_syscall; | ||
389 | |||
390 | synchronize_user_stack (); | ||
391 | sf = (struct rt_signal_frame __user *) | ||
392 | (regs->u_regs [UREG_FP] + STACK_BIAS); | ||
393 | |||
394 | /* 1. Make sure we are not getting garbage from the user */ | ||
395 | if (((unsigned long) sf) & 3) | ||
396 | goto segv; | ||
397 | |||
398 | err = get_user(tpc, &sf->regs.tpc); | ||
399 | err |= __get_user(tnpc, &sf->regs.tnpc); | ||
400 | if (test_thread_flag(TIF_32BIT)) { | ||
401 | tpc &= 0xffffffff; | ||
402 | tnpc &= 0xffffffff; | ||
403 | } | ||
404 | err |= ((tpc | tnpc) & 3); | ||
405 | |||
406 | /* 2. Restore the state */ | ||
407 | err |= __get_user(regs->y, &sf->regs.y); | ||
408 | err |= __get_user(tstate, &sf->regs.tstate); | ||
409 | err |= copy_from_user(regs->u_regs, sf->regs.u_regs, sizeof(regs->u_regs)); | ||
410 | |||
411 | /* User can only change condition codes and %asi in %tstate. */ | ||
412 | regs->tstate &= ~(TSTATE_ASI | TSTATE_ICC | TSTATE_XCC); | ||
413 | regs->tstate |= (tstate & (TSTATE_ASI | TSTATE_ICC | TSTATE_XCC)); | ||
414 | |||
415 | err |= __get_user(fpu_save, &sf->fpu_save); | ||
416 | if (fpu_save) | ||
417 | err |= restore_fpu_state(regs, &sf->fpu_state); | ||
418 | |||
419 | err |= __copy_from_user(&set, &sf->mask, sizeof(sigset_t)); | ||
420 | err |= __copy_from_user(&st, &sf->stack, sizeof(stack_t)); | ||
421 | |||
422 | if (err) | ||
423 | goto segv; | ||
424 | |||
425 | regs->tpc = tpc; | ||
426 | regs->tnpc = tnpc; | ||
427 | |||
428 | /* It is more difficult to avoid calling this function than to | ||
429 | call it and ignore errors. */ | ||
430 | old_fs = get_fs(); | ||
431 | set_fs(KERNEL_DS); | ||
432 | do_sigaltstack((const stack_t __user *) &st, NULL, (unsigned long)sf); | ||
433 | set_fs(old_fs); | ||
434 | |||
435 | sigdelsetmask(&set, ~_BLOCKABLE); | ||
436 | spin_lock_irq(¤t->sighand->siglock); | ||
437 | current->blocked = set; | ||
438 | recalc_sigpending(); | ||
439 | spin_unlock_irq(¤t->sighand->siglock); | ||
440 | return; | ||
441 | segv: | ||
442 | force_sig(SIGSEGV, current); | ||
443 | } | ||
444 | |||
445 | /* Checks if the fp is valid */ | ||
446 | static int invalid_frame_pointer(void __user *fp, int fplen) | ||
447 | { | ||
448 | if (((unsigned long) fp) & 7) | ||
449 | return 1; | ||
450 | return 0; | ||
451 | } | ||
452 | |||
453 | static inline int | ||
454 | save_fpu_state(struct pt_regs *regs, __siginfo_fpu_t __user *fpu) | ||
455 | { | ||
456 | unsigned long *fpregs = (unsigned long *)(regs+1); | ||
457 | unsigned long fprs; | ||
458 | int err = 0; | ||
459 | |||
460 | fprs = current_thread_info()->fpsaved[0]; | ||
461 | if (fprs & FPRS_DL) | ||
462 | err |= copy_to_user(&fpu->si_float_regs[0], fpregs, | ||
463 | (sizeof(unsigned int) * 32)); | ||
464 | if (fprs & FPRS_DU) | ||
465 | err |= copy_to_user(&fpu->si_float_regs[32], fpregs+16, | ||
466 | (sizeof(unsigned int) * 32)); | ||
467 | err |= __put_user(current_thread_info()->xfsr[0], &fpu->si_fsr); | ||
468 | err |= __put_user(current_thread_info()->gsr[0], &fpu->si_gsr); | ||
469 | err |= __put_user(fprs, &fpu->si_fprs); | ||
470 | |||
471 | return err; | ||
472 | } | ||
473 | |||
474 | static inline void __user *get_sigframe(struct k_sigaction *ka, struct pt_regs *regs, unsigned long framesize) | ||
475 | { | ||
476 | unsigned long sp; | ||
477 | |||
478 | sp = regs->u_regs[UREG_FP] + STACK_BIAS; | ||
479 | |||
480 | /* This is the X/Open sanctioned signal stack switching. */ | ||
481 | if (ka->sa.sa_flags & SA_ONSTACK) { | ||
482 | if (!on_sig_stack(sp) && | ||
483 | !((current->sas_ss_sp + current->sas_ss_size) & 7)) | ||
484 | sp = current->sas_ss_sp + current->sas_ss_size; | ||
485 | } | ||
486 | return (void __user *)(sp - framesize); | ||
487 | } | ||
488 | |||
489 | static inline void | ||
490 | setup_rt_frame(struct k_sigaction *ka, struct pt_regs *regs, | ||
491 | int signo, sigset_t *oldset, siginfo_t *info) | ||
492 | { | ||
493 | struct rt_signal_frame __user *sf; | ||
494 | int sigframe_size, err; | ||
495 | |||
496 | /* 1. Make sure everything is clean */ | ||
497 | synchronize_user_stack(); | ||
498 | save_and_clear_fpu(); | ||
499 | |||
500 | sigframe_size = RT_ALIGNEDSZ; | ||
501 | if (!(current_thread_info()->fpsaved[0] & FPRS_FEF)) | ||
502 | sigframe_size -= sizeof(__siginfo_fpu_t); | ||
503 | |||
504 | sf = (struct rt_signal_frame __user *) | ||
505 | get_sigframe(ka, regs, sigframe_size); | ||
506 | |||
507 | if (invalid_frame_pointer (sf, sigframe_size)) | ||
508 | goto sigill; | ||
509 | |||
510 | if (get_thread_wsaved() != 0) | ||
511 | goto sigill; | ||
512 | |||
513 | /* 2. Save the current process state */ | ||
514 | err = copy_to_user(&sf->regs, regs, sizeof (*regs)); | ||
515 | |||
516 | if (current_thread_info()->fpsaved[0] & FPRS_FEF) { | ||
517 | err |= save_fpu_state(regs, &sf->fpu_state); | ||
518 | err |= __put_user((u64)&sf->fpu_state, &sf->fpu_save); | ||
519 | } else { | ||
520 | err |= __put_user(0, &sf->fpu_save); | ||
521 | } | ||
522 | |||
523 | /* Setup sigaltstack */ | ||
524 | err |= __put_user(current->sas_ss_sp, &sf->stack.ss_sp); | ||
525 | err |= __put_user(sas_ss_flags(regs->u_regs[UREG_FP]), &sf->stack.ss_flags); | ||
526 | err |= __put_user(current->sas_ss_size, &sf->stack.ss_size); | ||
527 | |||
528 | err |= copy_to_user(&sf->mask, oldset, sizeof(sigset_t)); | ||
529 | |||
530 | err |= copy_in_user((u64 __user *)sf, | ||
531 | (u64 __user *)(regs->u_regs[UREG_FP]+STACK_BIAS), | ||
532 | sizeof(struct reg_window)); | ||
533 | |||
534 | if (info) | ||
535 | err |= copy_siginfo_to_user(&sf->info, info); | ||
536 | else { | ||
537 | err |= __put_user(signo, &sf->info.si_signo); | ||
538 | err |= __put_user(SI_NOINFO, &sf->info.si_code); | ||
539 | } | ||
540 | if (err) | ||
541 | goto sigsegv; | ||
542 | |||
543 | /* 3. signal handler back-trampoline and parameters */ | ||
544 | regs->u_regs[UREG_FP] = ((unsigned long) sf) - STACK_BIAS; | ||
545 | regs->u_regs[UREG_I0] = signo; | ||
546 | regs->u_regs[UREG_I1] = (unsigned long) &sf->info; | ||
547 | |||
548 | /* The sigcontext is passed in this way because of how it | ||
549 | * is defined in GLIBC's /usr/include/bits/sigcontext.h | ||
550 | * for sparc64. It includes the 128 bytes of siginfo_t. | ||
551 | */ | ||
552 | regs->u_regs[UREG_I2] = (unsigned long) &sf->info; | ||
553 | |||
554 | /* 5. signal handler */ | ||
555 | regs->tpc = (unsigned long) ka->sa.sa_handler; | ||
556 | regs->tnpc = (regs->tpc + 4); | ||
557 | if (test_thread_flag(TIF_32BIT)) { | ||
558 | regs->tpc &= 0xffffffff; | ||
559 | regs->tnpc &= 0xffffffff; | ||
560 | } | ||
561 | /* 4. return to kernel instructions */ | ||
562 | regs->u_regs[UREG_I7] = (unsigned long)ka->ka_restorer; | ||
563 | return; | ||
564 | |||
565 | sigill: | ||
566 | do_exit(SIGILL); | ||
567 | sigsegv: | ||
568 | force_sigsegv(signo, current); | ||
569 | } | ||
570 | |||
571 | static inline void handle_signal(unsigned long signr, struct k_sigaction *ka, | ||
572 | siginfo_t *info, | ||
573 | sigset_t *oldset, struct pt_regs *regs) | ||
574 | { | ||
575 | setup_rt_frame(ka, regs, signr, oldset, | ||
576 | (ka->sa.sa_flags & SA_SIGINFO) ? info : NULL); | ||
577 | if (!(ka->sa.sa_flags & SA_NOMASK)) { | ||
578 | spin_lock_irq(¤t->sighand->siglock); | ||
579 | sigorsets(¤t->blocked,¤t->blocked,&ka->sa.sa_mask); | ||
580 | sigaddset(¤t->blocked,signr); | ||
581 | recalc_sigpending(); | ||
582 | spin_unlock_irq(¤t->sighand->siglock); | ||
583 | } | ||
584 | } | ||
585 | |||
586 | static inline void syscall_restart(unsigned long orig_i0, struct pt_regs *regs, | ||
587 | struct sigaction *sa) | ||
588 | { | ||
589 | switch (regs->u_regs[UREG_I0]) { | ||
590 | case ERESTART_RESTARTBLOCK: | ||
591 | case ERESTARTNOHAND: | ||
592 | no_system_call_restart: | ||
593 | regs->u_regs[UREG_I0] = EINTR; | ||
594 | regs->tstate |= (TSTATE_ICARRY|TSTATE_XCARRY); | ||
595 | break; | ||
596 | case ERESTARTSYS: | ||
597 | if (!(sa->sa_flags & SA_RESTART)) | ||
598 | goto no_system_call_restart; | ||
599 | /* fallthrough */ | ||
600 | case ERESTARTNOINTR: | ||
601 | regs->u_regs[UREG_I0] = orig_i0; | ||
602 | regs->tpc -= 4; | ||
603 | regs->tnpc -= 4; | ||
604 | } | ||
605 | } | ||
606 | |||
607 | /* Note that 'init' is a special process: it doesn't get signals it doesn't | ||
608 | * want to handle. Thus you cannot kill init even with a SIGKILL even by | ||
609 | * mistake. | ||
610 | */ | ||
611 | static int do_signal(sigset_t *oldset, struct pt_regs * regs, | ||
612 | unsigned long orig_i0, int restart_syscall) | ||
613 | { | ||
614 | siginfo_t info; | ||
615 | struct signal_deliver_cookie cookie; | ||
616 | struct k_sigaction ka; | ||
617 | int signr; | ||
618 | |||
619 | cookie.restart_syscall = restart_syscall; | ||
620 | cookie.orig_i0 = orig_i0; | ||
621 | |||
622 | if (!oldset) | ||
623 | oldset = ¤t->blocked; | ||
624 | |||
625 | #ifdef CONFIG_SPARC32_COMPAT | ||
626 | if (test_thread_flag(TIF_32BIT)) { | ||
627 | extern int do_signal32(sigset_t *, struct pt_regs *, | ||
628 | unsigned long, int); | ||
629 | return do_signal32(oldset, regs, orig_i0, | ||
630 | cookie.restart_syscall); | ||
631 | } | ||
632 | #endif | ||
633 | |||
634 | signr = get_signal_to_deliver(&info, &ka, regs, &cookie); | ||
635 | if (signr > 0) { | ||
636 | if (cookie.restart_syscall) | ||
637 | syscall_restart(orig_i0, regs, &ka.sa); | ||
638 | handle_signal(signr, &ka, &info, oldset, regs); | ||
639 | return 1; | ||
640 | } | ||
641 | if (cookie.restart_syscall && | ||
642 | (regs->u_regs[UREG_I0] == ERESTARTNOHAND || | ||
643 | regs->u_regs[UREG_I0] == ERESTARTSYS || | ||
644 | regs->u_regs[UREG_I0] == ERESTARTNOINTR)) { | ||
645 | /* replay the system call when we are done */ | ||
646 | regs->u_regs[UREG_I0] = cookie.orig_i0; | ||
647 | regs->tpc -= 4; | ||
648 | regs->tnpc -= 4; | ||
649 | } | ||
650 | if (cookie.restart_syscall && | ||
651 | regs->u_regs[UREG_I0] == ERESTART_RESTARTBLOCK) { | ||
652 | regs->u_regs[UREG_G1] = __NR_restart_syscall; | ||
653 | regs->tpc -= 4; | ||
654 | regs->tnpc -= 4; | ||
655 | } | ||
656 | return 0; | ||
657 | } | ||
658 | |||
659 | void do_notify_resume(sigset_t *oldset, struct pt_regs *regs, | ||
660 | unsigned long orig_i0, int restart_syscall, | ||
661 | unsigned long thread_info_flags) | ||
662 | { | ||
663 | if (thread_info_flags & _TIF_SIGPENDING) | ||
664 | do_signal(oldset, regs, orig_i0, restart_syscall); | ||
665 | } | ||
666 | |||
667 | void ptrace_signal_deliver(struct pt_regs *regs, void *cookie) | ||
668 | { | ||
669 | struct signal_deliver_cookie *cp = cookie; | ||
670 | |||
671 | if (cp->restart_syscall && | ||
672 | (regs->u_regs[UREG_I0] == ERESTARTNOHAND || | ||
673 | regs->u_regs[UREG_I0] == ERESTARTSYS || | ||
674 | regs->u_regs[UREG_I0] == ERESTARTNOINTR)) { | ||
675 | /* replay the system call when we are done */ | ||
676 | regs->u_regs[UREG_I0] = cp->orig_i0; | ||
677 | regs->tpc -= 4; | ||
678 | regs->tnpc -= 4; | ||
679 | cp->restart_syscall = 0; | ||
680 | } | ||
681 | if (cp->restart_syscall && | ||
682 | regs->u_regs[UREG_I0] == ERESTART_RESTARTBLOCK) { | ||
683 | regs->u_regs[UREG_G1] = __NR_restart_syscall; | ||
684 | regs->tpc -= 4; | ||
685 | regs->tnpc -= 4; | ||
686 | cp->restart_syscall = 0; | ||
687 | } | ||
688 | } | ||