Linux Audio

Check our new training course

Loading...
v4.6
  1/*
  2 * arch/sh/kernel/signal_64.c
  3 *
  4 * Copyright (C) 2000, 2001  Paolo Alberelli
  5 * Copyright (C) 2003 - 2008  Paul Mundt
  6 * Copyright (C) 2004  Richard Curnow
  7 *
  8 * This file is subject to the terms and conditions of the GNU General Public
  9 * License.  See the file "COPYING" in the main directory of this archive
 10 * for more details.
 11 */
 12#include <linux/rwsem.h>
 13#include <linux/sched.h>
 14#include <linux/mm.h>
 15#include <linux/smp.h>
 16#include <linux/kernel.h>
 17#include <linux/signal.h>
 18#include <linux/errno.h>
 19#include <linux/wait.h>
 20#include <linux/personality.h>
 21#include <linux/ptrace.h>
 22#include <linux/unistd.h>
 23#include <linux/stddef.h>
 24#include <linux/tracehook.h>
 25#include <asm/ucontext.h>
 26#include <asm/uaccess.h>
 27#include <asm/pgtable.h>
 28#include <asm/cacheflush.h>
 29#include <asm/fpu.h>
 30
 31#define REG_RET 9
 32#define REG_ARG1 2
 33#define REG_ARG2 3
 34#define REG_ARG3 4
 35#define REG_SP 15
 36#define REG_PR 18
 37#define REF_REG_RET regs->regs[REG_RET]
 38#define REF_REG_SP regs->regs[REG_SP]
 39#define DEREF_REG_PR regs->regs[REG_PR]
 40
 41#define DEBUG_SIG 0
 42
 43static void
 44handle_signal(struct ksignal *ksig, struct pt_regs *regs);
 
 45
 46static inline void
 47handle_syscall_restart(struct pt_regs *regs, struct sigaction *sa)
 48{
 49	/* If we're not from a syscall, bail out */
 50	if (regs->syscall_nr < 0)
 51		return;
 52
 53	/* check for system call restart.. */
 54	switch (regs->regs[REG_RET]) {
 55		case -ERESTART_RESTARTBLOCK:
 56		case -ERESTARTNOHAND:
 57		no_system_call_restart:
 58			regs->regs[REG_RET] = -EINTR;
 59			break;
 60
 61		case -ERESTARTSYS:
 62			if (!(sa->sa_flags & SA_RESTART))
 63				goto no_system_call_restart;
 64		/* fallthrough */
 65		case -ERESTARTNOINTR:
 66			/* Decode syscall # */
 67			regs->regs[REG_RET] = regs->syscall_nr;
 68			regs->pc -= 4;
 69			break;
 70	}
 71}
 72
 73/*
 74 * Note that 'init' is a special process: it doesn't get signals it doesn't
 75 * want to handle. Thus you cannot kill init even with a SIGKILL even by
 76 * mistake.
 77 *
 78 * Note that we go through the signals twice: once to check the signals that
 79 * the kernel can handle, and then we build all the user-level signal handling
 80 * stack-frames in one go after that.
 81 */
 82static void do_signal(struct pt_regs *regs)
 83{
 84	struct ksignal ksig;
 
 
 85
 86	/*
 87	 * We want the common case to go fast, which
 88	 * is why we may in certain cases get here from
 89	 * kernel mode. Just return without doing anything
 90	 * if so.
 91	 */
 92	if (!user_mode(regs))
 93		return;
 94
 95	if (get_signal(&ksig)) {
 96		handle_syscall_restart(regs, &ksig.ka.sa);
 
 97
 98		/* Whee!  Actually deliver the signal.  */
 99		handle_signal(&ksig, regs);
100		return;
101	}
102
103	/* Did we come from a system call? */
104	if (regs->syscall_nr >= 0) {
105		/* Restart the system call - no handlers present */
106		switch (regs->regs[REG_RET]) {
107		case -ERESTARTNOHAND:
108		case -ERESTARTSYS:
109		case -ERESTARTNOINTR:
110			/* Decode Syscall # */
111			regs->regs[REG_RET] = regs->syscall_nr;
112			regs->pc -= 4;
113			break;
114
115		case -ERESTART_RESTARTBLOCK:
116			regs->regs[REG_RET] = __NR_restart_syscall;
117			regs->pc -= 4;
118			break;
119		}
120	}
121
122	/* No signal to deliver -- put the saved sigmask back */
123	restore_saved_sigmask();
124}
125
126/*
127 * Do a signal return; undo the signal stack.
128 */
129struct sigframe {
130	struct sigcontext sc;
131	unsigned long extramask[_NSIG_WORDS-1];
132	long long retcode[2];
133};
134
135struct rt_sigframe {
136	struct siginfo __user *pinfo;
137	void *puc;
138	struct siginfo info;
139	struct ucontext uc;
140	long long retcode[2];
141};
142
143#ifdef CONFIG_SH_FPU
144static inline int
145restore_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
146{
147	int err = 0;
148	int fpvalid;
149
150	err |= __get_user (fpvalid, &sc->sc_fpvalid);
151	conditional_used_math(fpvalid);
152	if (! fpvalid)
153		return err;
154
155	if (current == last_task_used_math) {
156		last_task_used_math = NULL;
157		regs->sr |= SR_FD;
158	}
159
160	err |= __copy_from_user(&current->thread.xstate->hardfpu, &sc->sc_fpregs[0],
161				(sizeof(long long) * 32) + (sizeof(int) * 1));
162
163	return err;
164}
165
166static inline int
167setup_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
168{
169	int err = 0;
170	int fpvalid;
171
172	fpvalid = !!used_math();
173	err |= __put_user(fpvalid, &sc->sc_fpvalid);
174	if (! fpvalid)
175		return err;
176
177	if (current == last_task_used_math) {
178		enable_fpu();
179		save_fpu(current);
180		disable_fpu();
181		last_task_used_math = NULL;
182		regs->sr |= SR_FD;
183	}
184
185	err |= __copy_to_user(&sc->sc_fpregs[0], &current->thread.xstate->hardfpu,
186			      (sizeof(long long) * 32) + (sizeof(int) * 1));
187	clear_used_math();
188
189	return err;
190}
191#else
192static inline int
193restore_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
194{
195	return 0;
196}
197static inline int
198setup_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
199{
200	return 0;
201}
202#endif
203
204static int
205restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc, long long *r2_p)
206{
207	unsigned int err = 0;
208        unsigned long long current_sr, new_sr;
209#define SR_MASK 0xffff8cfd
210
211#define COPY(x)		err |= __get_user(regs->x, &sc->sc_##x)
212
213	COPY(regs[0]);	COPY(regs[1]);	COPY(regs[2]);	COPY(regs[3]);
214	COPY(regs[4]);	COPY(regs[5]);	COPY(regs[6]);	COPY(regs[7]);
215	COPY(regs[8]);	COPY(regs[9]);  COPY(regs[10]);	COPY(regs[11]);
216	COPY(regs[12]);	COPY(regs[13]);	COPY(regs[14]);	COPY(regs[15]);
217	COPY(regs[16]);	COPY(regs[17]);	COPY(regs[18]);	COPY(regs[19]);
218	COPY(regs[20]);	COPY(regs[21]);	COPY(regs[22]);	COPY(regs[23]);
219	COPY(regs[24]);	COPY(regs[25]);	COPY(regs[26]);	COPY(regs[27]);
220	COPY(regs[28]);	COPY(regs[29]);	COPY(regs[30]);	COPY(regs[31]);
221	COPY(regs[32]);	COPY(regs[33]);	COPY(regs[34]);	COPY(regs[35]);
222	COPY(regs[36]);	COPY(regs[37]);	COPY(regs[38]);	COPY(regs[39]);
223	COPY(regs[40]);	COPY(regs[41]);	COPY(regs[42]);	COPY(regs[43]);
224	COPY(regs[44]);	COPY(regs[45]);	COPY(regs[46]);	COPY(regs[47]);
225	COPY(regs[48]);	COPY(regs[49]);	COPY(regs[50]);	COPY(regs[51]);
226	COPY(regs[52]);	COPY(regs[53]);	COPY(regs[54]);	COPY(regs[55]);
227	COPY(regs[56]);	COPY(regs[57]);	COPY(regs[58]);	COPY(regs[59]);
228	COPY(regs[60]);	COPY(regs[61]);	COPY(regs[62]);
229	COPY(tregs[0]);	COPY(tregs[1]);	COPY(tregs[2]);	COPY(tregs[3]);
230	COPY(tregs[4]);	COPY(tregs[5]);	COPY(tregs[6]);	COPY(tregs[7]);
231
232        /* Prevent the signal handler manipulating SR in a way that can
233           crash the kernel. i.e. only allow S, Q, M, PR, SZ, FR to be
234           modified */
235        current_sr = regs->sr;
236        err |= __get_user(new_sr, &sc->sc_sr);
237        regs->sr &= SR_MASK;
238        regs->sr |= (new_sr & ~SR_MASK);
239
240	COPY(pc);
241
242#undef COPY
243
244	/* Must do this last in case it sets regs->sr.fd (i.e. after rest of sr
245	 * has been restored above.) */
246	err |= restore_sigcontext_fpu(regs, sc);
247
248	regs->syscall_nr = -1;		/* disable syscall checks */
249	err |= __get_user(*r2_p, &sc->sc_regs[REG_RET]);
250	return err;
251}
252
253asmlinkage int sys_sigreturn(unsigned long r2, unsigned long r3,
254				   unsigned long r4, unsigned long r5,
255				   unsigned long r6, unsigned long r7,
256				   struct pt_regs * regs)
257{
258	struct sigframe __user *frame = (struct sigframe __user *) (long) REF_REG_SP;
259	sigset_t set;
260	long long ret;
261
262	/* Always make any pending restarted system calls return -EINTR */
263	current->restart_block.fn = do_no_restart_syscall;
264
265	if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
266		goto badframe;
267
268	if (__get_user(set.sig[0], &frame->sc.oldmask)
269	    || (_NSIG_WORDS > 1
270		&& __copy_from_user(&set.sig[1], &frame->extramask,
271				    sizeof(frame->extramask))))
272		goto badframe;
273
274	set_current_blocked(&set);
275
276	if (restore_sigcontext(regs, &frame->sc, &ret))
277		goto badframe;
278	regs->pc -= 4;
279
280	return (int) ret;
281
282badframe:
283	force_sig(SIGSEGV, current);
284	return 0;
285}
286
287asmlinkage int sys_rt_sigreturn(unsigned long r2, unsigned long r3,
288				unsigned long r4, unsigned long r5,
289				unsigned long r6, unsigned long r7,
290				struct pt_regs * regs)
291{
292	struct rt_sigframe __user *frame = (struct rt_sigframe __user *) (long) REF_REG_SP;
293	sigset_t set;
294	long long ret;
295
296	/* Always make any pending restarted system calls return -EINTR */
297	current->restart_block.fn = do_no_restart_syscall;
298
299	if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
300		goto badframe;
301
302	if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
303		goto badframe;
304
305	set_current_blocked(&set);
306
307	if (restore_sigcontext(regs, &frame->uc.uc_mcontext, &ret))
308		goto badframe;
309	regs->pc -= 4;
310
311	if (restore_altstack(&frame->uc.uc_stack))
312		goto badframe;
313
314	return (int) ret;
315
316badframe:
317	force_sig(SIGSEGV, current);
318	return 0;
319}
320
321/*
322 * Set up a signal frame.
323 */
324static int
325setup_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs,
326		 unsigned long mask)
327{
328	int err = 0;
329
330	/* Do this first, otherwise is this sets sr->fd, that value isn't preserved. */
331	err |= setup_sigcontext_fpu(regs, sc);
332
333#define COPY(x)		err |= __put_user(regs->x, &sc->sc_##x)
334
335	COPY(regs[0]);	COPY(regs[1]);	COPY(regs[2]);	COPY(regs[3]);
336	COPY(regs[4]);	COPY(regs[5]);	COPY(regs[6]);	COPY(regs[7]);
337	COPY(regs[8]);	COPY(regs[9]);	COPY(regs[10]);	COPY(regs[11]);
338	COPY(regs[12]);	COPY(regs[13]);	COPY(regs[14]);	COPY(regs[15]);
339	COPY(regs[16]);	COPY(regs[17]);	COPY(regs[18]);	COPY(regs[19]);
340	COPY(regs[20]);	COPY(regs[21]);	COPY(regs[22]);	COPY(regs[23]);
341	COPY(regs[24]);	COPY(regs[25]);	COPY(regs[26]);	COPY(regs[27]);
342	COPY(regs[28]);	COPY(regs[29]);	COPY(regs[30]);	COPY(regs[31]);
343	COPY(regs[32]);	COPY(regs[33]);	COPY(regs[34]);	COPY(regs[35]);
344	COPY(regs[36]);	COPY(regs[37]);	COPY(regs[38]);	COPY(regs[39]);
345	COPY(regs[40]);	COPY(regs[41]);	COPY(regs[42]);	COPY(regs[43]);
346	COPY(regs[44]);	COPY(regs[45]);	COPY(regs[46]);	COPY(regs[47]);
347	COPY(regs[48]);	COPY(regs[49]);	COPY(regs[50]);	COPY(regs[51]);
348	COPY(regs[52]);	COPY(regs[53]);	COPY(regs[54]);	COPY(regs[55]);
349	COPY(regs[56]);	COPY(regs[57]);	COPY(regs[58]);	COPY(regs[59]);
350	COPY(regs[60]);	COPY(regs[61]);	COPY(regs[62]);
351	COPY(tregs[0]);	COPY(tregs[1]);	COPY(tregs[2]);	COPY(tregs[3]);
352	COPY(tregs[4]);	COPY(tregs[5]);	COPY(tregs[6]);	COPY(tregs[7]);
353	COPY(sr);	COPY(pc);
354
355#undef COPY
356
357	err |= __put_user(mask, &sc->oldmask);
358
359	return err;
360}
361
362/*
363 * Determine which stack to use..
364 */
365static inline void __user *
366get_sigframe(struct k_sigaction *ka, unsigned long sp, size_t frame_size)
367{
368	if ((ka->sa.sa_flags & SA_ONSTACK) != 0 && ! sas_ss_flags(sp))
369		sp = current->sas_ss_sp + current->sas_ss_size;
370
371	return (void __user *)((sp - frame_size) & -8ul);
372}
373
374void sa_default_restorer(void);		/* See comments below */
375void sa_default_rt_restorer(void);	/* See comments below */
376
377static int setup_frame(struct ksignal *ksig, sigset_t *set, struct pt_regs *regs)
 
378{
379	struct sigframe __user *frame;
380	int err = 0, sig = ksig->sig;
381	int signal;
382
383	frame = get_sigframe(&ksig->ka, regs->regs[REG_SP], sizeof(*frame));
384
385	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
386		return -EFAULT;
 
 
 
 
 
 
387
388	err |= setup_sigcontext(&frame->sc, regs, set->sig[0]);
389
390	/* Give up earlier as i386, in case */
391	if (err)
392		return -EFAULT;
393
394	if (_NSIG_WORDS > 1) {
395		err |= __copy_to_user(frame->extramask, &set->sig[1],
396				      sizeof(frame->extramask)); }
397
398	/* Give up earlier as i386, in case */
399	if (err)
400		return -EFAULT;
401
402	/* Set up to return from userspace.  If provided, use a stub
403	   already in userspace.  */
404	if (ksig->ka.sa.sa_flags & SA_RESTORER) {
405		/*
406		 * On SH5 all edited pointers are subject to NEFF
407		 */
408		DEREF_REG_PR = neff_sign_extend((unsigned long)
409			ksig->ka->sa.sa_restorer | 0x1);
410	} else {
411		/*
412		 * Different approach on SH5.
413	         * . Endianness independent asm code gets placed in entry.S .
414		 *   This is limited to four ASM instructions corresponding
415		 *   to two long longs in size.
416		 * . err checking is done on the else branch only
417		 * . flush_icache_range() is called upon __put_user() only
418		 * . all edited pointers are subject to NEFF
419		 * . being code, linker turns ShMedia bit on, always
420		 *   dereference index -1.
421		 */
422		DEREF_REG_PR = neff_sign_extend((unsigned long)
423			frame->retcode | 0x01);
424
425		if (__copy_to_user(frame->retcode,
426			(void *)((unsigned long)sa_default_restorer & (~1)), 16) != 0)
427			return -EFAULT;
428
429		/* Cohere the trampoline with the I-cache. */
430		flush_cache_sigtramp(DEREF_REG_PR-1);
431	}
432
433	/*
434	 * Set up registers for signal handler.
435	 * All edited pointers are subject to NEFF.
436	 */
437	regs->regs[REG_SP] = neff_sign_extend((unsigned long)frame);
438	regs->regs[REG_ARG1] = sig; /* Arg for signal handler */
439
440        /* FIXME:
441           The glibc profiling support for SH-5 needs to be passed a sigcontext
442           so it can retrieve the PC.  At some point during 2003 the glibc
443           support was changed to receive the sigcontext through the 2nd
444           argument, but there are still versions of libc.so in use that use
445           the 3rd argument.  Until libc.so is stabilised, pass the sigcontext
446           through both 2nd and 3rd arguments.
447        */
448
449	regs->regs[REG_ARG2] = (unsigned long long)(unsigned long)(signed long)&frame->sc;
450	regs->regs[REG_ARG3] = (unsigned long long)(unsigned long)(signed long)&frame->sc;
451
452	regs->pc = neff_sign_extend((unsigned long)ksig->ka.sa.sa_handler);
 
 
453
454	/* Broken %016Lx */
455	pr_debug("SIG deliver (#%d,%s:%d): sp=%p pc=%08Lx%08Lx link=%08Lx%08Lx\n",
456		 sig, current->comm, current->pid, frame,
457		 regs->pc >> 32, regs->pc & 0xffffffff,
458		 DEREF_REG_PR >> 32, DEREF_REG_PR & 0xffffffff);
459
460	return 0;
 
 
 
 
461}
462
463static int setup_rt_frame(struct ksignal *kig, sigset_t *set,
464			  struct pt_regs *regs)
465{
466	struct rt_sigframe __user *frame;
467	int err = 0, sig = ksig->sig;
 
468
469	frame = get_sigframe(&ksig->ka, regs->regs[REG_SP], sizeof(*frame));
470
471	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
472		return -EFAULT;
 
 
 
 
 
 
473
474	err |= __put_user(&frame->info, &frame->pinfo);
475	err |= __put_user(&frame->uc, &frame->puc);
476	err |= copy_siginfo_to_user(&frame->info, &ksig->info);
477
478	/* Give up earlier as i386, in case */
479	if (err)
480		return -EFAULT;
481
482	/* Create the ucontext.  */
483	err |= __put_user(0, &frame->uc.uc_flags);
484	err |= __put_user(0, &frame->uc.uc_link);
485	err |= __save_altstack(&frame->uc.uc_stack, regs->regs[REG_SP]);
486	err |= setup_sigcontext(&frame->uc.uc_mcontext,
487			        regs, set->sig[0]);
488	err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
489
490	/* Give up earlier as i386, in case */
491	if (err)
492		return -EFAULT;
493
494	/* Set up to return from userspace.  If provided, use a stub
495	   already in userspace.  */
496	if (ksig->ka.sa.sa_flags & SA_RESTORER) {
497		/*
498		 * On SH5 all edited pointers are subject to NEFF
499		 */
500		DEREF_REG_PR = neff_sign_extend((unsigned long)
501			ksig->ka.sa.sa_restorer | 0x1);
502	} else {
503		/*
504		 * Different approach on SH5.
505	         * . Endianness independent asm code gets placed in entry.S .
506		 *   This is limited to four ASM instructions corresponding
507		 *   to two long longs in size.
508		 * . err checking is done on the else branch only
509		 * . flush_icache_range() is called upon __put_user() only
510		 * . all edited pointers are subject to NEFF
511		 * . being code, linker turns ShMedia bit on, always
512		 *   dereference index -1.
513		 */
514		DEREF_REG_PR = neff_sign_extend((unsigned long)
515			frame->retcode | 0x01);
516
517		if (__copy_to_user(frame->retcode,
518			(void *)((unsigned long)sa_default_rt_restorer & (~1)), 16) != 0)
519			return -EFAULT;
520
521		/* Cohere the trampoline with the I-cache. */
522		flush_icache_range(DEREF_REG_PR-1, DEREF_REG_PR-1+15);
523	}
524
525	/*
526	 * Set up registers for signal handler.
527	 * All edited pointers are subject to NEFF.
528	 */
529	regs->regs[REG_SP] = neff_sign_extend((unsigned long)frame);
530	regs->regs[REG_ARG1] = sig; /* Arg for signal handler */
531	regs->regs[REG_ARG2] = (unsigned long long)(unsigned long)(signed long)&frame->info;
532	regs->regs[REG_ARG3] = (unsigned long long)(unsigned long)(signed long)&frame->uc.uc_mcontext;
533	regs->pc = neff_sign_extend((unsigned long)ksig->ka.sa.sa_handler);
 
 
534
535	pr_debug("SIG deliver (#%d,%s:%d): sp=%p pc=%08Lx%08Lx link=%08Lx%08Lx\n",
536		 sig, current->comm, current->pid, frame,
537		 regs->pc >> 32, regs->pc & 0xffffffff,
538		 DEREF_REG_PR >> 32, DEREF_REG_PR & 0xffffffff);
539
540	return 0;
 
 
 
 
541}
542
543/*
544 * OK, we're invoking a handler
545 */
546static void
547handle_signal(struct ksignal *ksig, struct pt_regs *regs)
 
548{
549	sigset_t *oldset = sigmask_to_save();
550	int ret;
551
552	/* Set up the stack frame */
553	if (ksig->ka.sa.sa_flags & SA_SIGINFO)
554		ret = setup_rt_frame(ksig, oldset, regs);
555	else
556		ret = setup_frame(ksig, oldset, regs);
 
 
 
557
558	signal_setup_done(ret, ksig, test_thread_flag(TIF_SINGLESTEP));
 
559}
560
561asmlinkage void do_notify_resume(struct pt_regs *regs, unsigned long thread_info_flags)
562{
563	if (thread_info_flags & _TIF_SIGPENDING)
564		do_signal(regs);
565
566	if (thread_info_flags & _TIF_NOTIFY_RESUME) {
567		clear_thread_flag(TIF_NOTIFY_RESUME);
568		tracehook_notify_resume(regs);
569	}
570}
v3.15
  1/*
  2 * arch/sh/kernel/signal_64.c
  3 *
  4 * Copyright (C) 2000, 2001  Paolo Alberelli
  5 * Copyright (C) 2003 - 2008  Paul Mundt
  6 * Copyright (C) 2004  Richard Curnow
  7 *
  8 * This file is subject to the terms and conditions of the GNU General Public
  9 * License.  See the file "COPYING" in the main directory of this archive
 10 * for more details.
 11 */
 12#include <linux/rwsem.h>
 13#include <linux/sched.h>
 14#include <linux/mm.h>
 15#include <linux/smp.h>
 16#include <linux/kernel.h>
 17#include <linux/signal.h>
 18#include <linux/errno.h>
 19#include <linux/wait.h>
 20#include <linux/personality.h>
 21#include <linux/ptrace.h>
 22#include <linux/unistd.h>
 23#include <linux/stddef.h>
 24#include <linux/tracehook.h>
 25#include <asm/ucontext.h>
 26#include <asm/uaccess.h>
 27#include <asm/pgtable.h>
 28#include <asm/cacheflush.h>
 29#include <asm/fpu.h>
 30
 31#define REG_RET 9
 32#define REG_ARG1 2
 33#define REG_ARG2 3
 34#define REG_ARG3 4
 35#define REG_SP 15
 36#define REG_PR 18
 37#define REF_REG_RET regs->regs[REG_RET]
 38#define REF_REG_SP regs->regs[REG_SP]
 39#define DEREF_REG_PR regs->regs[REG_PR]
 40
 41#define DEBUG_SIG 0
 42
 43static void
 44handle_signal(unsigned long sig, siginfo_t *info, struct k_sigaction *ka,
 45		struct pt_regs * regs);
 46
 47static inline void
 48handle_syscall_restart(struct pt_regs *regs, struct sigaction *sa)
 49{
 50	/* If we're not from a syscall, bail out */
 51	if (regs->syscall_nr < 0)
 52		return;
 53
 54	/* check for system call restart.. */
 55	switch (regs->regs[REG_RET]) {
 56		case -ERESTART_RESTARTBLOCK:
 57		case -ERESTARTNOHAND:
 58		no_system_call_restart:
 59			regs->regs[REG_RET] = -EINTR;
 60			break;
 61
 62		case -ERESTARTSYS:
 63			if (!(sa->sa_flags & SA_RESTART))
 64				goto no_system_call_restart;
 65		/* fallthrough */
 66		case -ERESTARTNOINTR:
 67			/* Decode syscall # */
 68			regs->regs[REG_RET] = regs->syscall_nr;
 69			regs->pc -= 4;
 70			break;
 71	}
 72}
 73
 74/*
 75 * Note that 'init' is a special process: it doesn't get signals it doesn't
 76 * want to handle. Thus you cannot kill init even with a SIGKILL even by
 77 * mistake.
 78 *
 79 * Note that we go through the signals twice: once to check the signals that
 80 * the kernel can handle, and then we build all the user-level signal handling
 81 * stack-frames in one go after that.
 82 */
 83static void do_signal(struct pt_regs *regs)
 84{
 85	siginfo_t info;
 86	int signr;
 87	struct k_sigaction ka;
 88
 89	/*
 90	 * We want the common case to go fast, which
 91	 * is why we may in certain cases get here from
 92	 * kernel mode. Just return without doing anything
 93	 * if so.
 94	 */
 95	if (!user_mode(regs))
 96		return;
 97
 98	signr = get_signal_to_deliver(&info, &ka, regs, 0);
 99	if (signr > 0) {
100		handle_syscall_restart(regs, &ka.sa);
101
102		/* Whee!  Actually deliver the signal.  */
103		handle_signal(signr, &info, &ka, regs);
104		return;
105	}
106
107	/* Did we come from a system call? */
108	if (regs->syscall_nr >= 0) {
109		/* Restart the system call - no handlers present */
110		switch (regs->regs[REG_RET]) {
111		case -ERESTARTNOHAND:
112		case -ERESTARTSYS:
113		case -ERESTARTNOINTR:
114			/* Decode Syscall # */
115			regs->regs[REG_RET] = regs->syscall_nr;
116			regs->pc -= 4;
117			break;
118
119		case -ERESTART_RESTARTBLOCK:
120			regs->regs[REG_RET] = __NR_restart_syscall;
121			regs->pc -= 4;
122			break;
123		}
124	}
125
126	/* No signal to deliver -- put the saved sigmask back */
127	restore_saved_sigmask();
128}
129
130/*
131 * Do a signal return; undo the signal stack.
132 */
133struct sigframe {
134	struct sigcontext sc;
135	unsigned long extramask[_NSIG_WORDS-1];
136	long long retcode[2];
137};
138
139struct rt_sigframe {
140	struct siginfo __user *pinfo;
141	void *puc;
142	struct siginfo info;
143	struct ucontext uc;
144	long long retcode[2];
145};
146
147#ifdef CONFIG_SH_FPU
148static inline int
149restore_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
150{
151	int err = 0;
152	int fpvalid;
153
154	err |= __get_user (fpvalid, &sc->sc_fpvalid);
155	conditional_used_math(fpvalid);
156	if (! fpvalid)
157		return err;
158
159	if (current == last_task_used_math) {
160		last_task_used_math = NULL;
161		regs->sr |= SR_FD;
162	}
163
164	err |= __copy_from_user(&current->thread.xstate->hardfpu, &sc->sc_fpregs[0],
165				(sizeof(long long) * 32) + (sizeof(int) * 1));
166
167	return err;
168}
169
170static inline int
171setup_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
172{
173	int err = 0;
174	int fpvalid;
175
176	fpvalid = !!used_math();
177	err |= __put_user(fpvalid, &sc->sc_fpvalid);
178	if (! fpvalid)
179		return err;
180
181	if (current == last_task_used_math) {
182		enable_fpu();
183		save_fpu(current);
184		disable_fpu();
185		last_task_used_math = NULL;
186		regs->sr |= SR_FD;
187	}
188
189	err |= __copy_to_user(&sc->sc_fpregs[0], &current->thread.xstate->hardfpu,
190			      (sizeof(long long) * 32) + (sizeof(int) * 1));
191	clear_used_math();
192
193	return err;
194}
195#else
196static inline int
197restore_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
198{
199	return 0;
200}
201static inline int
202setup_sigcontext_fpu(struct pt_regs *regs, struct sigcontext __user *sc)
203{
204	return 0;
205}
206#endif
207
208static int
209restore_sigcontext(struct pt_regs *regs, struct sigcontext __user *sc, long long *r2_p)
210{
211	unsigned int err = 0;
212        unsigned long long current_sr, new_sr;
213#define SR_MASK 0xffff8cfd
214
215#define COPY(x)		err |= __get_user(regs->x, &sc->sc_##x)
216
217	COPY(regs[0]);	COPY(regs[1]);	COPY(regs[2]);	COPY(regs[3]);
218	COPY(regs[4]);	COPY(regs[5]);	COPY(regs[6]);	COPY(regs[7]);
219	COPY(regs[8]);	COPY(regs[9]);  COPY(regs[10]);	COPY(regs[11]);
220	COPY(regs[12]);	COPY(regs[13]);	COPY(regs[14]);	COPY(regs[15]);
221	COPY(regs[16]);	COPY(regs[17]);	COPY(regs[18]);	COPY(regs[19]);
222	COPY(regs[20]);	COPY(regs[21]);	COPY(regs[22]);	COPY(regs[23]);
223	COPY(regs[24]);	COPY(regs[25]);	COPY(regs[26]);	COPY(regs[27]);
224	COPY(regs[28]);	COPY(regs[29]);	COPY(regs[30]);	COPY(regs[31]);
225	COPY(regs[32]);	COPY(regs[33]);	COPY(regs[34]);	COPY(regs[35]);
226	COPY(regs[36]);	COPY(regs[37]);	COPY(regs[38]);	COPY(regs[39]);
227	COPY(regs[40]);	COPY(regs[41]);	COPY(regs[42]);	COPY(regs[43]);
228	COPY(regs[44]);	COPY(regs[45]);	COPY(regs[46]);	COPY(regs[47]);
229	COPY(regs[48]);	COPY(regs[49]);	COPY(regs[50]);	COPY(regs[51]);
230	COPY(regs[52]);	COPY(regs[53]);	COPY(regs[54]);	COPY(regs[55]);
231	COPY(regs[56]);	COPY(regs[57]);	COPY(regs[58]);	COPY(regs[59]);
232	COPY(regs[60]);	COPY(regs[61]);	COPY(regs[62]);
233	COPY(tregs[0]);	COPY(tregs[1]);	COPY(tregs[2]);	COPY(tregs[3]);
234	COPY(tregs[4]);	COPY(tregs[5]);	COPY(tregs[6]);	COPY(tregs[7]);
235
236        /* Prevent the signal handler manipulating SR in a way that can
237           crash the kernel. i.e. only allow S, Q, M, PR, SZ, FR to be
238           modified */
239        current_sr = regs->sr;
240        err |= __get_user(new_sr, &sc->sc_sr);
241        regs->sr &= SR_MASK;
242        regs->sr |= (new_sr & ~SR_MASK);
243
244	COPY(pc);
245
246#undef COPY
247
248	/* Must do this last in case it sets regs->sr.fd (i.e. after rest of sr
249	 * has been restored above.) */
250	err |= restore_sigcontext_fpu(regs, sc);
251
252	regs->syscall_nr = -1;		/* disable syscall checks */
253	err |= __get_user(*r2_p, &sc->sc_regs[REG_RET]);
254	return err;
255}
256
257asmlinkage int sys_sigreturn(unsigned long r2, unsigned long r3,
258				   unsigned long r4, unsigned long r5,
259				   unsigned long r6, unsigned long r7,
260				   struct pt_regs * regs)
261{
262	struct sigframe __user *frame = (struct sigframe __user *) (long) REF_REG_SP;
263	sigset_t set;
264	long long ret;
265
266	/* Always make any pending restarted system calls return -EINTR */
267	current_thread_info()->restart_block.fn = do_no_restart_syscall;
268
269	if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
270		goto badframe;
271
272	if (__get_user(set.sig[0], &frame->sc.oldmask)
273	    || (_NSIG_WORDS > 1
274		&& __copy_from_user(&set.sig[1], &frame->extramask,
275				    sizeof(frame->extramask))))
276		goto badframe;
277
278	set_current_blocked(&set);
279
280	if (restore_sigcontext(regs, &frame->sc, &ret))
281		goto badframe;
282	regs->pc -= 4;
283
284	return (int) ret;
285
286badframe:
287	force_sig(SIGSEGV, current);
288	return 0;
289}
290
291asmlinkage int sys_rt_sigreturn(unsigned long r2, unsigned long r3,
292				unsigned long r4, unsigned long r5,
293				unsigned long r6, unsigned long r7,
294				struct pt_regs * regs)
295{
296	struct rt_sigframe __user *frame = (struct rt_sigframe __user *) (long) REF_REG_SP;
297	sigset_t set;
298	long long ret;
299
300	/* Always make any pending restarted system calls return -EINTR */
301	current_thread_info()->restart_block.fn = do_no_restart_syscall;
302
303	if (!access_ok(VERIFY_READ, frame, sizeof(*frame)))
304		goto badframe;
305
306	if (__copy_from_user(&set, &frame->uc.uc_sigmask, sizeof(set)))
307		goto badframe;
308
309	set_current_blocked(&set);
310
311	if (restore_sigcontext(regs, &frame->uc.uc_mcontext, &ret))
312		goto badframe;
313	regs->pc -= 4;
314
315	if (restore_altstack(&frame->uc.uc_stack))
316		goto badframe;
317
318	return (int) ret;
319
320badframe:
321	force_sig(SIGSEGV, current);
322	return 0;
323}
324
325/*
326 * Set up a signal frame.
327 */
328static int
329setup_sigcontext(struct sigcontext __user *sc, struct pt_regs *regs,
330		 unsigned long mask)
331{
332	int err = 0;
333
334	/* Do this first, otherwise is this sets sr->fd, that value isn't preserved. */
335	err |= setup_sigcontext_fpu(regs, sc);
336
337#define COPY(x)		err |= __put_user(regs->x, &sc->sc_##x)
338
339	COPY(regs[0]);	COPY(regs[1]);	COPY(regs[2]);	COPY(regs[3]);
340	COPY(regs[4]);	COPY(regs[5]);	COPY(regs[6]);	COPY(regs[7]);
341	COPY(regs[8]);	COPY(regs[9]);	COPY(regs[10]);	COPY(regs[11]);
342	COPY(regs[12]);	COPY(regs[13]);	COPY(regs[14]);	COPY(regs[15]);
343	COPY(regs[16]);	COPY(regs[17]);	COPY(regs[18]);	COPY(regs[19]);
344	COPY(regs[20]);	COPY(regs[21]);	COPY(regs[22]);	COPY(regs[23]);
345	COPY(regs[24]);	COPY(regs[25]);	COPY(regs[26]);	COPY(regs[27]);
346	COPY(regs[28]);	COPY(regs[29]);	COPY(regs[30]);	COPY(regs[31]);
347	COPY(regs[32]);	COPY(regs[33]);	COPY(regs[34]);	COPY(regs[35]);
348	COPY(regs[36]);	COPY(regs[37]);	COPY(regs[38]);	COPY(regs[39]);
349	COPY(regs[40]);	COPY(regs[41]);	COPY(regs[42]);	COPY(regs[43]);
350	COPY(regs[44]);	COPY(regs[45]);	COPY(regs[46]);	COPY(regs[47]);
351	COPY(regs[48]);	COPY(regs[49]);	COPY(regs[50]);	COPY(regs[51]);
352	COPY(regs[52]);	COPY(regs[53]);	COPY(regs[54]);	COPY(regs[55]);
353	COPY(regs[56]);	COPY(regs[57]);	COPY(regs[58]);	COPY(regs[59]);
354	COPY(regs[60]);	COPY(regs[61]);	COPY(regs[62]);
355	COPY(tregs[0]);	COPY(tregs[1]);	COPY(tregs[2]);	COPY(tregs[3]);
356	COPY(tregs[4]);	COPY(tregs[5]);	COPY(tregs[6]);	COPY(tregs[7]);
357	COPY(sr);	COPY(pc);
358
359#undef COPY
360
361	err |= __put_user(mask, &sc->oldmask);
362
363	return err;
364}
365
366/*
367 * Determine which stack to use..
368 */
369static inline void __user *
370get_sigframe(struct k_sigaction *ka, unsigned long sp, size_t frame_size)
371{
372	if ((ka->sa.sa_flags & SA_ONSTACK) != 0 && ! sas_ss_flags(sp))
373		sp = current->sas_ss_sp + current->sas_ss_size;
374
375	return (void __user *)((sp - frame_size) & -8ul);
376}
377
378void sa_default_restorer(void);		/* See comments below */
379void sa_default_rt_restorer(void);	/* See comments below */
380
381static int setup_frame(int sig, struct k_sigaction *ka,
382		       sigset_t *set, struct pt_regs *regs)
383{
384	struct sigframe __user *frame;
385	int err = 0;
386	int signal;
387
388	frame = get_sigframe(ka, regs->regs[REG_SP], sizeof(*frame));
389
390	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
391		goto give_sigsegv;
392
393	signal = current_thread_info()->exec_domain
394		&& current_thread_info()->exec_domain->signal_invmap
395		&& sig < 32
396		? current_thread_info()->exec_domain->signal_invmap[sig]
397		: sig;
398
399	err |= setup_sigcontext(&frame->sc, regs, set->sig[0]);
400
401	/* Give up earlier as i386, in case */
402	if (err)
403		goto give_sigsegv;
404
405	if (_NSIG_WORDS > 1) {
406		err |= __copy_to_user(frame->extramask, &set->sig[1],
407				      sizeof(frame->extramask)); }
408
409	/* Give up earlier as i386, in case */
410	if (err)
411		goto give_sigsegv;
412
413	/* Set up to return from userspace.  If provided, use a stub
414	   already in userspace.  */
415	if (ka->sa.sa_flags & SA_RESTORER) {
416		/*
417		 * On SH5 all edited pointers are subject to NEFF
418		 */
419		DEREF_REG_PR = neff_sign_extend((unsigned long)
420			ka->sa.sa_restorer | 0x1);
421	} else {
422		/*
423		 * Different approach on SH5.
424	         * . Endianness independent asm code gets placed in entry.S .
425		 *   This is limited to four ASM instructions corresponding
426		 *   to two long longs in size.
427		 * . err checking is done on the else branch only
428		 * . flush_icache_range() is called upon __put_user() only
429		 * . all edited pointers are subject to NEFF
430		 * . being code, linker turns ShMedia bit on, always
431		 *   dereference index -1.
432		 */
433		DEREF_REG_PR = neff_sign_extend((unsigned long)
434			frame->retcode | 0x01);
435
436		if (__copy_to_user(frame->retcode,
437			(void *)((unsigned long)sa_default_restorer & (~1)), 16) != 0)
438			goto give_sigsegv;
439
440		/* Cohere the trampoline with the I-cache. */
441		flush_cache_sigtramp(DEREF_REG_PR-1);
442	}
443
444	/*
445	 * Set up registers for signal handler.
446	 * All edited pointers are subject to NEFF.
447	 */
448	regs->regs[REG_SP] = neff_sign_extend((unsigned long)frame);
449	regs->regs[REG_ARG1] = signal; /* Arg for signal handler */
450
451        /* FIXME:
452           The glibc profiling support for SH-5 needs to be passed a sigcontext
453           so it can retrieve the PC.  At some point during 2003 the glibc
454           support was changed to receive the sigcontext through the 2nd
455           argument, but there are still versions of libc.so in use that use
456           the 3rd argument.  Until libc.so is stabilised, pass the sigcontext
457           through both 2nd and 3rd arguments.
458        */
459
460	regs->regs[REG_ARG2] = (unsigned long long)(unsigned long)(signed long)&frame->sc;
461	regs->regs[REG_ARG3] = (unsigned long long)(unsigned long)(signed long)&frame->sc;
462
463	regs->pc = neff_sign_extend((unsigned long)ka->sa.sa_handler);
464
465	set_fs(USER_DS);
466
467	/* Broken %016Lx */
468	pr_debug("SIG deliver (#%d,%s:%d): sp=%p pc=%08Lx%08Lx link=%08Lx%08Lx\n",
469		 signal, current->comm, current->pid, frame,
470		 regs->pc >> 32, regs->pc & 0xffffffff,
471		 DEREF_REG_PR >> 32, DEREF_REG_PR & 0xffffffff);
472
473	return 0;
474
475give_sigsegv:
476	force_sigsegv(sig, current);
477	return -EFAULT;
478}
479
480static int setup_rt_frame(int sig, struct k_sigaction *ka, siginfo_t *info,
481			  sigset_t *set, struct pt_regs *regs)
482{
483	struct rt_sigframe __user *frame;
484	int err = 0;
485	int signal;
486
487	frame = get_sigframe(ka, regs->regs[REG_SP], sizeof(*frame));
488
489	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
490		goto give_sigsegv;
491
492	signal = 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
498	err |= __put_user(&frame->info, &frame->pinfo);
499	err |= __put_user(&frame->uc, &frame->puc);
500	err |= copy_siginfo_to_user(&frame->info, info);
501
502	/* Give up earlier as i386, in case */
503	if (err)
504		goto give_sigsegv;
505
506	/* Create the ucontext.  */
507	err |= __put_user(0, &frame->uc.uc_flags);
508	err |= __put_user(0, &frame->uc.uc_link);
509	err |= __save_altstack(&frame->uc.uc_stack, regs->regs[REG_SP]);
510	err |= setup_sigcontext(&frame->uc.uc_mcontext,
511			        regs, set->sig[0]);
512	err |= __copy_to_user(&frame->uc.uc_sigmask, set, sizeof(*set));
513
514	/* Give up earlier as i386, in case */
515	if (err)
516		goto give_sigsegv;
517
518	/* Set up to return from userspace.  If provided, use a stub
519	   already in userspace.  */
520	if (ka->sa.sa_flags & SA_RESTORER) {
521		/*
522		 * On SH5 all edited pointers are subject to NEFF
523		 */
524		DEREF_REG_PR = neff_sign_extend((unsigned long)
525			ka->sa.sa_restorer | 0x1);
526	} else {
527		/*
528		 * Different approach on SH5.
529	         * . Endianness independent asm code gets placed in entry.S .
530		 *   This is limited to four ASM instructions corresponding
531		 *   to two long longs in size.
532		 * . err checking is done on the else branch only
533		 * . flush_icache_range() is called upon __put_user() only
534		 * . all edited pointers are subject to NEFF
535		 * . being code, linker turns ShMedia bit on, always
536		 *   dereference index -1.
537		 */
538		DEREF_REG_PR = neff_sign_extend((unsigned long)
539			frame->retcode | 0x01);
540
541		if (__copy_to_user(frame->retcode,
542			(void *)((unsigned long)sa_default_rt_restorer & (~1)), 16) != 0)
543			goto give_sigsegv;
544
545		/* Cohere the trampoline with the I-cache. */
546		flush_icache_range(DEREF_REG_PR-1, DEREF_REG_PR-1+15);
547	}
548
549	/*
550	 * Set up registers for signal handler.
551	 * All edited pointers are subject to NEFF.
552	 */
553	regs->regs[REG_SP] = neff_sign_extend((unsigned long)frame);
554	regs->regs[REG_ARG1] = signal; /* Arg for signal handler */
555	regs->regs[REG_ARG2] = (unsigned long long)(unsigned long)(signed long)&frame->info;
556	regs->regs[REG_ARG3] = (unsigned long long)(unsigned long)(signed long)&frame->uc.uc_mcontext;
557	regs->pc = neff_sign_extend((unsigned long)ka->sa.sa_handler);
558
559	set_fs(USER_DS);
560
561	pr_debug("SIG deliver (#%d,%s:%d): sp=%p pc=%08Lx%08Lx link=%08Lx%08Lx\n",
562		 signal, current->comm, current->pid, frame,
563		 regs->pc >> 32, regs->pc & 0xffffffff,
564		 DEREF_REG_PR >> 32, DEREF_REG_PR & 0xffffffff);
565
566	return 0;
567
568give_sigsegv:
569	force_sigsegv(sig, current);
570	return -EFAULT;
571}
572
573/*
574 * OK, we're invoking a handler
575 */
576static void
577handle_signal(unsigned long sig, siginfo_t *info, struct k_sigaction *ka,
578		struct pt_regs * regs)
579{
580	sigset_t *oldset = sigmask_to_save();
581	int ret;
582
583	/* Set up the stack frame */
584	if (ka->sa.sa_flags & SA_SIGINFO)
585		ret = setup_rt_frame(sig, ka, info, oldset, regs);
586	else
587		ret = setup_frame(sig, ka, oldset, regs);
588
589	if (ret)
590		return;
591
592	signal_delivered(sig, info, ka, regs,
593			test_thread_flag(TIF_SINGLESTEP));
594}
595
596asmlinkage void do_notify_resume(struct pt_regs *regs, unsigned long thread_info_flags)
597{
598	if (thread_info_flags & _TIF_SIGPENDING)
599		do_signal(regs);
600
601	if (thread_info_flags & _TIF_NOTIFY_RESUME) {
602		clear_thread_flag(TIF_NOTIFY_RESUME);
603		tracehook_notify_resume(regs);
604	}
605}