Linux Audio

Check our new training course

Loading...
v6.13.7
  1/*
  2 * Copyright (C) 2003 PathScale, Inc.
  3 * Copyright (C) 2003 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
  4 * Licensed under the GPL
  5 */
  6
  7
  8#include <linux/personality.h>
  9#include <linux/ptrace.h>
 10#include <linux/kernel.h>
 11#include <linux/syscalls.h>
 12#include <asm/unistd.h>
 13#include <linux/uaccess.h>
 14#include <asm/ucontext.h>
 15#include <frame_kern.h>
 16#include <registers.h>
 17#include <skas.h>
 18
 19#include <linux/regset.h>
 20#include <asm/sigframe.h>
 21
 22#ifdef CONFIG_X86_32
 23struct _xstate_64 {
 24	struct _fpstate_64		fpstate;
 25	struct _header			xstate_hdr;
 26	struct _ymmh_state		ymmh;
 27	/* New processor state extensions go here: */
 28};
 29#else
 30#define _xstate_64 _xstate
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 31#endif
 32
 33static int copy_sc_from_user(struct pt_regs *regs,
 34			     struct sigcontext __user *from)
 35{
 36	struct _xstate_64 __user *from_fp64;
 37	struct sigcontext sc;
 38	int err;
 39
 40	/* Always make any pending restarted system calls return -EINTR */
 41	current->restart_block.fn = do_no_restart_syscall;
 42
 43	err = copy_from_user(&sc, from, sizeof(sc));
 44	if (err)
 45		return err;
 46
 47#define GETREG(regno, regname) regs->regs.gp[HOST_##regno] = sc.regname
 48
 49#ifdef CONFIG_X86_32
 50	GETREG(GS, gs);
 51	GETREG(FS, fs);
 52	GETREG(ES, es);
 53	GETREG(DS, ds);
 54#endif
 55	GETREG(DI, di);
 56	GETREG(SI, si);
 57	GETREG(BP, bp);
 58	GETREG(SP, sp);
 59	GETREG(BX, bx);
 60	GETREG(DX, dx);
 61	GETREG(CX, cx);
 62	GETREG(AX, ax);
 63	GETREG(IP, ip);
 64
 65#ifdef CONFIG_X86_64
 66	GETREG(R8, r8);
 67	GETREG(R9, r9);
 68	GETREG(R10, r10);
 69	GETREG(R11, r11);
 70	GETREG(R12, r12);
 71	GETREG(R13, r13);
 72	GETREG(R14, r14);
 73	GETREG(R15, r15);
 74#endif
 75
 76	GETREG(CS, cs);
 77	GETREG(EFLAGS, flags);
 78#ifdef CONFIG_X86_32
 79	GETREG(SS, ss);
 80#endif
 81
 82#undef GETREG
 83
 
 84#ifdef CONFIG_X86_32
 85	from_fp64 = ((void __user *)sc.fpstate) +
 86		    offsetof(struct _fpstate_32, _fxsr_env);
 87#else
 88	from_fp64 = (void __user *)sc.fpstate;
 89#endif
 90
 91	err = copy_from_user(regs->regs.fp, from_fp64, host_fp_size);
 92	if (err)
 93		return 1;
 
 
 94
 95#ifdef CONFIG_X86_32
 96	/* Data is duplicated and this copy is the important one */
 97	err = copy_regset_from_user(current,
 98				    task_user_regset_view(current),
 99				    REGSET_FP_LEGACY, 0,
100				    sizeof(struct user_i387_struct),
101				    (void __user *)sc.fpstate);
102	if (err < 0)
103		return err;
 
 
 
104#endif
 
 
105
 
 
 
 
 
 
 
 
 
 
 
 
 
106	return 0;
107}
108
109static int copy_sc_to_user(struct sigcontext __user *to,
110			   struct _xstate __user *to_fp, struct pt_regs *regs,
111			   unsigned long mask)
112{
113	struct _xstate_64 __user *to_fp64;
114	struct sigcontext sc;
115	struct faultinfo * fi = &current->thread.arch.faultinfo;
116	int err;
117	memset(&sc, 0, sizeof(struct sigcontext));
118
119#define PUTREG(regno, regname) sc.regname = regs->regs.gp[HOST_##regno]
120
121#ifdef CONFIG_X86_32
122	PUTREG(GS, gs);
123	PUTREG(FS, fs);
124	PUTREG(ES, es);
125	PUTREG(DS, ds);
126#endif
127	PUTREG(DI, di);
128	PUTREG(SI, si);
129	PUTREG(BP, bp);
130	PUTREG(SP, sp);
131	PUTREG(BX, bx);
132	PUTREG(DX, dx);
133	PUTREG(CX, cx);
134	PUTREG(AX, ax);
135#ifdef CONFIG_X86_64
136	PUTREG(R8, r8);
137	PUTREG(R9, r9);
138	PUTREG(R10, r10);
139	PUTREG(R11, r11);
140	PUTREG(R12, r12);
141	PUTREG(R13, r13);
142	PUTREG(R14, r14);
143	PUTREG(R15, r15);
144#endif
145
146	sc.cr2 = fi->cr2;
147	sc.err = fi->error_code;
148	sc.trapno = fi->trap_no;
149	PUTREG(IP, ip);
150	PUTREG(CS, cs);
151	PUTREG(EFLAGS, flags);
152#ifdef CONFIG_X86_32
153	PUTREG(SP, sp_at_signal);
154	PUTREG(SS, ss);
155#endif
156#undef PUTREG
157	sc.oldmask = mask;
158	sc.fpstate = (unsigned long)to_fp;
159
160	err = copy_to_user(to, &sc, sizeof(struct sigcontext));
161	if (err)
162		return 1;
163
 
 
164#ifdef CONFIG_X86_32
165	err = copy_regset_to_user(current,
166				  task_user_regset_view(current),
167				  REGSET_FP_LEGACY, 0,
168				  sizeof(struct _fpstate_32), to_fp);
169	if (err < 0)
170		return err;
171
172	__put_user(X86_FXSR_MAGIC, &to_fp->fpstate.magic);
 
 
 
 
 
173
174	BUILD_BUG_ON(offsetof(struct _xstate, xstate_hdr) !=
175		     offsetof(struct _xstate_64, xstate_hdr) +
176			offsetof(struct _fpstate_32, _fxsr_env));
177	to_fp64 = (void __user *)to_fp +
178		  offsetof(struct _fpstate_32, _fxsr_env);
179#else
180	to_fp64 = to_fp;
181#endif /* CONFIG_X86_32 */
182
183	if (copy_to_user(to_fp64, regs->regs.fp, host_fp_size))
184		return 1;
185
186	/*
187	 * Put magic/size values for userspace. We do not bother to verify them
188	 * later on, however, userspace needs them should it try to read the
189	 * XSTATE data. And ptrace does not fill in these parts.
190	 *
191	 * Skip this if we do not have an XSTATE frame.
192	 */
193	if (host_fp_size <= sizeof(to_fp64->fpstate))
194		return 0;
195
196	BUILD_BUG_ON(sizeof(int) != FP_XSTATE_MAGIC2_SIZE);
197#ifdef CONFIG_X86_32
198	__put_user(offsetof(struct _fpstate_32, _fxsr_env) +
199		   host_fp_size + FP_XSTATE_MAGIC2_SIZE,
200		   &to_fp64->fpstate.sw_reserved.extended_size);
201#else
202	__put_user(host_fp_size + FP_XSTATE_MAGIC2_SIZE,
203		   &to_fp64->fpstate.sw_reserved.extended_size);
204#endif
205	__put_user(host_fp_size, &to_fp64->fpstate.sw_reserved.xstate_size);
206
207	__put_user(FP_XSTATE_MAGIC1, &to_fp64->fpstate.sw_reserved.magic1);
208	__put_user(FP_XSTATE_MAGIC2,
209		   (int __user *)((void __user *)to_fp64 + host_fp_size));
 
 
 
 
 
 
 
 
 
210
211	return 0;
212}
213
214#ifdef CONFIG_X86_32
215static int copy_ucontext_to_user(struct ucontext __user *uc,
216				 struct _xstate __user *fp, sigset_t *set,
217				 unsigned long sp)
218{
219	int err = 0;
220
221	err |= __save_altstack(&uc->uc_stack, sp);
 
 
222	err |= copy_sc_to_user(&uc->uc_mcontext, fp, &current->thread.regs, 0);
223	err |= copy_to_user(&uc->uc_sigmask, set, sizeof(*set));
224	return err;
225}
226
227int setup_signal_stack_sc(unsigned long stack_top, struct ksignal *ksig,
228			  struct pt_regs *regs, sigset_t *mask)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
229{
230	size_t math_size = offsetof(struct _fpstate_32, _fxsr_env) +
231			   host_fp_size + FP_XSTATE_MAGIC2_SIZE;
232	struct sigframe __user *frame;
233	void __user *restorer;
234	int err = 0, sig = ksig->sig;
235	unsigned long fp_to;
236
237	/* This is the same calculation as i386 - ((sp + 4) & 15) == 0 */
238	stack_top = ((stack_top + 4) & -16UL) - 4;
239	frame = (struct sigframe __user *) stack_top - 1;
240	if (!access_ok(frame, sizeof(*frame)))
241		return 1;
242
243	/* Add required space for math frame */
244	frame = (struct sigframe __user *)((unsigned long)frame - math_size);
245
246	restorer = frame->retcode;
247	if (ksig->ka.sa.sa_flags & SA_RESTORER)
248		restorer = ksig->ka.sa.sa_restorer;
249
250	err |= __put_user(restorer, (void __user * __user *)&frame->pretcode);
251	err |= __put_user(sig, &frame->sig);
252
253	fp_to = (unsigned long)frame + sizeof(*frame);
254
255	err |= copy_sc_to_user(&frame->sc,
256			       (struct _xstate __user *)fp_to,
257			       regs, mask->sig[0]);
258	if (_NSIG_WORDS > 1)
259		err |= __copy_to_user(&frame->extramask, &mask->sig[1],
260				      sizeof(frame->extramask));
261
262	/*
263	 * This is popl %eax ; movl $,%eax ; int $0x80
264	 *
265	 * WE DO NOT USE IT ANY MORE! It's only left here for historical
266	 * reasons and because gdb uses it as a signature to notice
267	 * signal handler stack frames.
268	 */
269	err |= __put_user(0xb858, (short __user *)(frame->retcode+0));
270	err |= __put_user(__NR_sigreturn, (int __user *)(frame->retcode+2));
271	err |= __put_user(0x80cd, (short __user *)(frame->retcode+6));
272
273	if (err)
274		return err;
275
276	PT_REGS_SP(regs) = (unsigned long) frame;
277	PT_REGS_IP(regs) = (unsigned long) ksig->ka.sa.sa_handler;
278	PT_REGS_AX(regs) = (unsigned long) sig;
279	PT_REGS_DX(regs) = (unsigned long) 0;
280	PT_REGS_CX(regs) = (unsigned long) 0;
 
 
 
281	return 0;
282}
283
284int setup_signal_stack_si(unsigned long stack_top, struct ksignal *ksig,
285			  struct pt_regs *regs, sigset_t *mask)
 
286{
287	size_t math_size = offsetof(struct _fpstate_32, _fxsr_env) +
288			   host_fp_size + FP_XSTATE_MAGIC2_SIZE;
289	struct rt_sigframe __user *frame;
290	void __user *restorer;
291	int err = 0, sig = ksig->sig;
292	unsigned long fp_to;
293
294	stack_top &= -8UL;
295	frame = (struct rt_sigframe __user *) stack_top - 1;
296	if (!access_ok(frame, sizeof(*frame)))
297		return 1;
298
299	/* Add required space for math frame */
300	frame = (struct rt_sigframe __user *)((unsigned long)frame - math_size);
301
302	restorer = frame->retcode;
303	if (ksig->ka.sa.sa_flags & SA_RESTORER)
304		restorer = ksig->ka.sa.sa_restorer;
305
306	err |= __put_user(restorer, (void __user * __user *)&frame->pretcode);
307	err |= __put_user(sig, &frame->sig);
308	err |= __put_user(&frame->info, (void __user * __user *)&frame->pinfo);
309	err |= __put_user(&frame->uc, (void __user * __user *)&frame->puc);
310	err |= copy_siginfo_to_user(&frame->info, &ksig->info);
311
312	fp_to = (unsigned long)frame + sizeof(*frame);
313
314	err |= copy_ucontext_to_user(&frame->uc, (struct _xstate __user *)fp_to,
315				     mask, PT_REGS_SP(regs));
316
317	/*
318	 * This is movl $,%eax ; int $0x80
319	 *
320	 * WE DO NOT USE IT ANY MORE! It's only left here for historical
321	 * reasons and because gdb uses it as a signature to notice
322	 * signal handler stack frames.
323	 */
324	err |= __put_user(0xb8, (char __user *)(frame->retcode+0));
325	err |= __put_user(__NR_rt_sigreturn, (int __user *)(frame->retcode+1));
326	err |= __put_user(0x80cd, (short __user *)(frame->retcode+5));
327
328	if (err)
329		return err;
330
331	PT_REGS_SP(regs) = (unsigned long) frame;
332	PT_REGS_IP(regs) = (unsigned long) ksig->ka.sa.sa_handler;
333	PT_REGS_AX(regs) = (unsigned long) sig;
334	PT_REGS_DX(regs) = (unsigned long) &frame->info;
335	PT_REGS_CX(regs) = (unsigned long) &frame->uc;
 
 
 
336	return 0;
337}
338
339SYSCALL_DEFINE0(sigreturn)
340{
341	unsigned long sp = PT_REGS_SP(&current->thread.regs);
342	struct sigframe __user *frame = (struct sigframe __user *)(sp - 8);
343	sigset_t set;
344	struct sigcontext __user *sc = &frame->sc;
 
 
345	int sig_size = (_NSIG_WORDS - 1) * sizeof(unsigned long);
346
347	if (copy_from_user(&set.sig[0], &sc->oldmask, sizeof(set.sig[0])) ||
348	    copy_from_user(&set.sig[1], frame->extramask, sig_size))
349		goto segfault;
350
351	set_current_blocked(&set);
352
353	if (copy_sc_from_user(&current->thread.regs, sc))
354		goto segfault;
355
356	/* Avoid ERESTART handling */
357	PT_REGS_SYSCALL_NR(&current->thread.regs) = -1;
358	return PT_REGS_SYSCALL_RET(&current->thread.regs);
359
360 segfault:
361	force_sig(SIGSEGV);
362	return 0;
363}
364
365#else
366
367int setup_signal_stack_si(unsigned long stack_top, struct ksignal *ksig,
368			  struct pt_regs *regs, sigset_t *set)
369{
370	unsigned long math_size = host_fp_size + FP_XSTATE_MAGIC2_SIZE;
371	struct rt_sigframe __user *frame;
372	int err = 0, sig = ksig->sig;
373	unsigned long fp_to;
374
375	frame = (void __user *)stack_top - sizeof(struct rt_sigframe);
376
377	/* Add required space for math frame */
378	frame = (void __user *)((unsigned long)frame - math_size);
379
380	/* ABI requires 16 byte boundary alignment */
381	frame = (void __user *)round_down((unsigned long)frame, 16);
 
 
 
 
 
382
 
 
383	/* Subtract 128 for a red zone and 8 for proper alignment */
384	frame = (struct rt_sigframe __user *) ((unsigned long) frame - 128 - 8);
385
386	if (!access_ok(frame, sizeof(*frame) + math_size))
387		goto out;
388
389	if (ksig->ka.sa.sa_flags & SA_SIGINFO) {
390		err |= copy_siginfo_to_user(&frame->info, &ksig->info);
391		if (err)
392			goto out;
393	}
394
395	/* Create the ucontext.  */
396	err |= __put_user(0, &frame->uc.uc_flags);
397	err |= __put_user(NULL, &frame->uc.uc_link);
398	err |= __save_altstack(&frame->uc.uc_stack, PT_REGS_SP(regs));
399
400	fp_to = (unsigned long)frame + sizeof(*frame);
401
402	err |= copy_sc_to_user(&frame->uc.uc_mcontext,
403			       (struct _xstate __user *)fp_to,
404			       regs, set->sig[0]);
405
406	err |= __put_user(fp_to, &frame->uc.uc_mcontext.fpstate);
407	if (sizeof(*set) == 16) {
408		err |= __put_user(set->sig[0], &frame->uc.uc_sigmask.sig[0]);
409		err |= __put_user(set->sig[1], &frame->uc.uc_sigmask.sig[1]);
410	}
411	else
412		err |= __copy_to_user(&frame->uc.uc_sigmask, set,
413				      sizeof(*set));
414
415	/*
416	 * Set up to return from userspace.  If provided, use a stub
417	 * already in userspace.
418	 */
419	/* x86-64 should always use SA_RESTORER. */
420	if (ksig->ka.sa.sa_flags & SA_RESTORER)
421		err |= __put_user((void __user *)ksig->ka.sa.sa_restorer,
422				  &frame->pretcode);
423	else
424		/* could use a vstub here */
425		return err;
426
427	if (err)
428		return err;
429
 
 
 
 
 
 
 
430	PT_REGS_SP(regs) = (unsigned long) frame;
431	PT_REGS_DI(regs) = sig;
432	/* In case the signal handler was declared without prototypes */
433	PT_REGS_AX(regs) = 0;
434
435	/*
436	 * This also works for non SA_SIGINFO handlers because they expect the
437	 * next argument after the signal number on the stack.
438	 */
439	PT_REGS_SI(regs) = (unsigned long) &frame->info;
440	PT_REGS_DX(regs) = (unsigned long) &frame->uc;
441	PT_REGS_IP(regs) = (unsigned long) ksig->ka.sa.sa_handler;
442 out:
443	return err;
444}
445#endif
446
447SYSCALL_DEFINE0(rt_sigreturn)
448{
449	unsigned long sp = PT_REGS_SP(&current->thread.regs);
450	struct rt_sigframe __user *frame =
451		(struct rt_sigframe __user *)(sp - sizeof(long));
452	struct ucontext __user *uc = &frame->uc;
453	sigset_t set;
454
455	if (copy_from_user(&set, &uc->uc_sigmask, sizeof(set)))
456		goto segfault;
457
458	set_current_blocked(&set);
459
460	if (copy_sc_from_user(&current->thread.regs, &uc->uc_mcontext))
461		goto segfault;
462
463	/* Avoid ERESTART handling */
464	PT_REGS_SYSCALL_NR(&current->thread.regs) = -1;
465	return PT_REGS_SYSCALL_RET(&current->thread.regs);
466
467 segfault:
468	force_sig(SIGSEGV);
469	return 0;
470}
v3.5.6
  1/*
  2 * Copyright (C) 2003 PathScale, Inc.
  3 * Copyright (C) 2003 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
  4 * Licensed under the GPL
  5 */
  6
  7
  8#include <linux/personality.h>
  9#include <linux/ptrace.h>
 10#include <linux/kernel.h>
 
 11#include <asm/unistd.h>
 12#include <asm/uaccess.h>
 13#include <asm/ucontext.h>
 14#include "frame_kern.h"
 15#include "skas.h"
 
 
 
 
 16
 17#ifdef CONFIG_X86_32
 18
 19/*
 20 * FPU tag word conversions.
 21 */
 22
 23static inline unsigned short twd_i387_to_fxsr(unsigned short twd)
 24{
 25	unsigned int tmp; /* to avoid 16 bit prefixes in the code */
 26
 27	/* Transform each pair of bits into 01 (valid) or 00 (empty) */
 28	tmp = ~twd;
 29	tmp = (tmp | (tmp>>1)) & 0x5555; /* 0V0V0V0V0V0V0V0V */
 30	/* and move the valid bits to the lower byte. */
 31	tmp = (tmp | (tmp >> 1)) & 0x3333; /* 00VV00VV00VV00VV */
 32	tmp = (tmp | (tmp >> 2)) & 0x0f0f; /* 0000VVVV0000VVVV */
 33	tmp = (tmp | (tmp >> 4)) & 0x00ff; /* 00000000VVVVVVVV */
 34	return tmp;
 35}
 36
 37static inline unsigned long twd_fxsr_to_i387(struct user_fxsr_struct *fxsave)
 38{
 39	struct _fpxreg *st = NULL;
 40	unsigned long twd = (unsigned long) fxsave->twd;
 41	unsigned long tag;
 42	unsigned long ret = 0xffff0000;
 43	int i;
 44
 45#define FPREG_ADDR(f, n)	((char *)&(f)->st_space + (n) * 16)
 46
 47	for (i = 0; i < 8; i++) {
 48		if (twd & 0x1) {
 49			st = (struct _fpxreg *) FPREG_ADDR(fxsave, i);
 50
 51			switch (st->exponent & 0x7fff) {
 52			case 0x7fff:
 53				tag = 2;		/* Special */
 54				break;
 55			case 0x0000:
 56				if ( !st->significand[0] &&
 57				     !st->significand[1] &&
 58				     !st->significand[2] &&
 59				     !st->significand[3] ) {
 60					tag = 1;	/* Zero */
 61				} else {
 62					tag = 2;	/* Special */
 63				}
 64				break;
 65			default:
 66				if (st->significand[3] & 0x8000) {
 67					tag = 0;	/* Valid */
 68				} else {
 69					tag = 2;	/* Special */
 70				}
 71				break;
 72			}
 73		} else {
 74			tag = 3;			/* Empty */
 75		}
 76		ret |= (tag << (2 * i));
 77		twd = twd >> 1;
 78	}
 79	return ret;
 80}
 81
 82static int convert_fxsr_to_user(struct _fpstate __user *buf,
 83				struct user_fxsr_struct *fxsave)
 84{
 85	unsigned long env[7];
 86	struct _fpreg __user *to;
 87	struct _fpxreg *from;
 88	int i;
 89
 90	env[0] = (unsigned long)fxsave->cwd | 0xffff0000ul;
 91	env[1] = (unsigned long)fxsave->swd | 0xffff0000ul;
 92	env[2] = twd_fxsr_to_i387(fxsave);
 93	env[3] = fxsave->fip;
 94	env[4] = fxsave->fcs | ((unsigned long)fxsave->fop << 16);
 95	env[5] = fxsave->foo;
 96	env[6] = fxsave->fos;
 97
 98	if (__copy_to_user(buf, env, 7 * sizeof(unsigned long)))
 99		return 1;
100
101	to = &buf->_st[0];
102	from = (struct _fpxreg *) &fxsave->st_space[0];
103	for (i = 0; i < 8; i++, to++, from++) {
104		unsigned long __user *t = (unsigned long __user *)to;
105		unsigned long *f = (unsigned long *)from;
106
107		if (__put_user(*f, t) ||
108				__put_user(*(f + 1), t + 1) ||
109				__put_user(from->exponent, &to->exponent))
110			return 1;
111	}
112	return 0;
113}
114
115static int convert_fxsr_from_user(struct user_fxsr_struct *fxsave,
116				  struct _fpstate __user *buf)
117{
118	unsigned long env[7];
119	struct _fpxreg *to;
120	struct _fpreg __user *from;
121	int i;
122
123	if (copy_from_user( env, buf, 7 * sizeof(long)))
124		return 1;
125
126	fxsave->cwd = (unsigned short)(env[0] & 0xffff);
127	fxsave->swd = (unsigned short)(env[1] & 0xffff);
128	fxsave->twd = twd_i387_to_fxsr((unsigned short)(env[2] & 0xffff));
129	fxsave->fip = env[3];
130	fxsave->fop = (unsigned short)((env[4] & 0xffff0000ul) >> 16);
131	fxsave->fcs = (env[4] & 0xffff);
132	fxsave->foo = env[5];
133	fxsave->fos = env[6];
134
135	to = (struct _fpxreg *) &fxsave->st_space[0];
136	from = &buf->_st[0];
137	for (i = 0; i < 8; i++, to++, from++) {
138		unsigned long *t = (unsigned long *)to;
139		unsigned long __user *f = (unsigned long __user *)from;
140
141		if (__get_user(*t, f) ||
142		    __get_user(*(t + 1), f + 1) ||
143		    __get_user(to->exponent, &from->exponent))
144			return 1;
145	}
146	return 0;
147}
148
149extern int have_fpx_regs;
150
151#endif
152
153static int copy_sc_from_user(struct pt_regs *regs,
154			     struct sigcontext __user *from)
155{
 
156	struct sigcontext sc;
157	int err, pid;
158
159	/* Always make any pending restarted system calls return -EINTR */
160	current_thread_info()->restart_block.fn = do_no_restart_syscall;
161
162	err = copy_from_user(&sc, from, sizeof(sc));
163	if (err)
164		return err;
165
166#define GETREG(regno, regname) regs->regs.gp[HOST_##regno] = sc.regname
167
168#ifdef CONFIG_X86_32
169	GETREG(GS, gs);
170	GETREG(FS, fs);
171	GETREG(ES, es);
172	GETREG(DS, ds);
173#endif
174	GETREG(DI, di);
175	GETREG(SI, si);
176	GETREG(BP, bp);
177	GETREG(SP, sp);
178	GETREG(BX, bx);
179	GETREG(DX, dx);
180	GETREG(CX, cx);
181	GETREG(AX, ax);
182	GETREG(IP, ip);
183
184#ifdef CONFIG_X86_64
185	GETREG(R8, r8);
186	GETREG(R9, r9);
187	GETREG(R10, r10);
188	GETREG(R11, r11);
189	GETREG(R12, r12);
190	GETREG(R13, r13);
191	GETREG(R14, r14);
192	GETREG(R15, r15);
193#endif
194
195	GETREG(CS, cs);
196	GETREG(EFLAGS, flags);
197#ifdef CONFIG_X86_32
198	GETREG(SS, ss);
199#endif
200
201#undef GETREG
202
203	pid = userspace_pid[current_thread_info()->cpu];
204#ifdef CONFIG_X86_32
205	if (have_fpx_regs) {
206		struct user_fxsr_struct fpx;
 
 
 
207
208		err = copy_from_user(&fpx,
209			&((struct _fpstate __user *)sc.fpstate)->_fxsr_env[0],
210				     sizeof(struct user_fxsr_struct));
211		if (err)
212			return 1;
213
214		err = convert_fxsr_from_user(&fpx, sc.fpstate);
215		if (err)
216			return 1;
217
218		err = restore_fpx_registers(pid, (unsigned long *) &fpx);
219		if (err < 0) {
220			printk(KERN_ERR "copy_sc_from_user - "
221			       "restore_fpx_registers failed, errno = %d\n",
222			       -err);
223			return 1;
224		}
225	} else
226#endif
227	{
228		struct user_i387_struct fp;
229
230		err = copy_from_user(&fp, sc.fpstate,
231				     sizeof(struct user_i387_struct));
232		if (err)
233			return 1;
234
235		err = restore_fp_registers(pid, (unsigned long *) &fp);
236		if (err < 0) {
237			printk(KERN_ERR "copy_sc_from_user - "
238			       "restore_fp_registers failed, errno = %d\n",
239			       -err);
240			return 1;
241		}
242	}
243	return 0;
244}
245
246static int copy_sc_to_user(struct sigcontext __user *to,
247			   struct _fpstate __user *to_fp, struct pt_regs *regs,
248			   unsigned long mask)
249{
 
250	struct sigcontext sc;
251	struct faultinfo * fi = &current->thread.arch.faultinfo;
252	int err, pid;
253	memset(&sc, 0, sizeof(struct sigcontext));
254
255#define PUTREG(regno, regname) sc.regname = regs->regs.gp[HOST_##regno]
256
257#ifdef CONFIG_X86_32
258	PUTREG(GS, gs);
259	PUTREG(FS, fs);
260	PUTREG(ES, es);
261	PUTREG(DS, ds);
262#endif
263	PUTREG(DI, di);
264	PUTREG(SI, si);
265	PUTREG(BP, bp);
266	PUTREG(SP, sp);
267	PUTREG(BX, bx);
268	PUTREG(DX, dx);
269	PUTREG(CX, cx);
270	PUTREG(AX, ax);
271#ifdef CONFIG_X86_64
272	PUTREG(R8, r8);
273	PUTREG(R9, r9);
274	PUTREG(R10, r10);
275	PUTREG(R11, r11);
276	PUTREG(R12, r12);
277	PUTREG(R13, r13);
278	PUTREG(R14, r14);
279	PUTREG(R15, r15);
280#endif
281
282	sc.cr2 = fi->cr2;
283	sc.err = fi->error_code;
284	sc.trapno = fi->trap_no;
285	PUTREG(IP, ip);
286	PUTREG(CS, cs);
287	PUTREG(EFLAGS, flags);
288#ifdef CONFIG_X86_32
289	PUTREG(SP, sp_at_signal);
290	PUTREG(SS, ss);
291#endif
292#undef PUTREG
293	sc.oldmask = mask;
294	sc.fpstate = to_fp;
295
296	err = copy_to_user(to, &sc, sizeof(struct sigcontext));
297	if (err)
298		return 1;
299
300	pid = userspace_pid[current_thread_info()->cpu];
301
302#ifdef CONFIG_X86_32
303	if (have_fpx_regs) {
304		struct user_fxsr_struct fpx;
 
 
 
 
305
306		err = save_fpx_registers(pid, (unsigned long *) &fpx);
307		if (err < 0){
308			printk(KERN_ERR "copy_sc_to_user - save_fpx_registers "
309			       "failed, errno = %d\n", err);
310			return 1;
311		}
312
313		err = convert_fxsr_to_user(to_fp, &fpx);
314		if (err)
315			return 1;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
316
317		err |= __put_user(fpx.swd, &to_fp->status);
318		err |= __put_user(X86_FXSR_MAGIC, &to_fp->magic);
319		if (err)
320			return 1;
 
 
 
 
 
 
321
322		if (copy_to_user(&to_fp->_fxsr_env[0], &fpx,
323				 sizeof(struct user_fxsr_struct)))
324			return 1;
325	} else
326#endif
327	{
328		struct user_i387_struct fp;
329
330		err = save_fp_registers(pid, (unsigned long *) &fp);
331		if (copy_to_user(to_fp, &fp, sizeof(struct user_i387_struct)))
332			return 1;
333	}
334
335	return 0;
336}
337
338#ifdef CONFIG_X86_32
339static int copy_ucontext_to_user(struct ucontext __user *uc,
340				 struct _fpstate __user *fp, sigset_t *set,
341				 unsigned long sp)
342{
343	int err = 0;
344
345	err |= put_user(current->sas_ss_sp, &uc->uc_stack.ss_sp);
346	err |= put_user(sas_ss_flags(sp), &uc->uc_stack.ss_flags);
347	err |= put_user(current->sas_ss_size, &uc->uc_stack.ss_size);
348	err |= copy_sc_to_user(&uc->uc_mcontext, fp, &current->thread.regs, 0);
349	err |= copy_to_user(&uc->uc_sigmask, set, sizeof(*set));
350	return err;
351}
352
353struct sigframe
354{
355	char __user *pretcode;
356	int sig;
357	struct sigcontext sc;
358	struct _fpstate fpstate;
359	unsigned long extramask[_NSIG_WORDS-1];
360	char retcode[8];
361};
362
363struct rt_sigframe
364{
365	char __user *pretcode;
366	int sig;
367	struct siginfo __user *pinfo;
368	void __user *puc;
369	struct siginfo info;
370	struct ucontext uc;
371	struct _fpstate fpstate;
372	char retcode[8];
373};
374
375int setup_signal_stack_sc(unsigned long stack_top, int sig,
376			  struct k_sigaction *ka, struct pt_regs *regs,
377			  sigset_t *mask)
378{
 
 
379	struct sigframe __user *frame;
380	void __user *restorer;
381	int err = 0;
 
382
383	/* This is the same calculation as i386 - ((sp + 4) & 15) == 0 */
384	stack_top = ((stack_top + 4) & -16UL) - 4;
385	frame = (struct sigframe __user *) stack_top - 1;
386	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
387		return 1;
388
 
 
 
389	restorer = frame->retcode;
390	if (ka->sa.sa_flags & SA_RESTORER)
391		restorer = ka->sa.sa_restorer;
392
393	err |= __put_user(restorer, &frame->pretcode);
394	err |= __put_user(sig, &frame->sig);
395	err |= copy_sc_to_user(&frame->sc, &frame->fpstate, regs, mask->sig[0]);
 
 
 
 
 
396	if (_NSIG_WORDS > 1)
397		err |= __copy_to_user(&frame->extramask, &mask->sig[1],
398				      sizeof(frame->extramask));
399
400	/*
401	 * This is popl %eax ; movl $,%eax ; int $0x80
402	 *
403	 * WE DO NOT USE IT ANY MORE! It's only left here for historical
404	 * reasons and because gdb uses it as a signature to notice
405	 * signal handler stack frames.
406	 */
407	err |= __put_user(0xb858, (short __user *)(frame->retcode+0));
408	err |= __put_user(__NR_sigreturn, (int __user *)(frame->retcode+2));
409	err |= __put_user(0x80cd, (short __user *)(frame->retcode+6));
410
411	if (err)
412		return err;
413
414	PT_REGS_SP(regs) = (unsigned long) frame;
415	PT_REGS_IP(regs) = (unsigned long) ka->sa.sa_handler;
416	PT_REGS_AX(regs) = (unsigned long) sig;
417	PT_REGS_DX(regs) = (unsigned long) 0;
418	PT_REGS_CX(regs) = (unsigned long) 0;
419
420	if ((current->ptrace & PT_DTRACE) && (current->ptrace & PT_PTRACED))
421		ptrace_notify(SIGTRAP);
422	return 0;
423}
424
425int setup_signal_stack_si(unsigned long stack_top, int sig,
426			  struct k_sigaction *ka, struct pt_regs *regs,
427			  siginfo_t *info, sigset_t *mask)
428{
 
 
429	struct rt_sigframe __user *frame;
430	void __user *restorer;
431	int err = 0;
 
432
433	stack_top &= -8UL;
434	frame = (struct rt_sigframe __user *) stack_top - 1;
435	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
436		return 1;
437
 
 
 
438	restorer = frame->retcode;
439	if (ka->sa.sa_flags & SA_RESTORER)
440		restorer = ka->sa.sa_restorer;
441
442	err |= __put_user(restorer, &frame->pretcode);
443	err |= __put_user(sig, &frame->sig);
444	err |= __put_user(&frame->info, &frame->pinfo);
445	err |= __put_user(&frame->uc, &frame->puc);
446	err |= copy_siginfo_to_user(&frame->info, info);
447	err |= copy_ucontext_to_user(&frame->uc, &frame->fpstate, mask,
448					PT_REGS_SP(regs));
 
 
 
449
450	/*
451	 * This is movl $,%eax ; int $0x80
452	 *
453	 * WE DO NOT USE IT ANY MORE! It's only left here for historical
454	 * reasons and because gdb uses it as a signature to notice
455	 * signal handler stack frames.
456	 */
457	err |= __put_user(0xb8, (char __user *)(frame->retcode+0));
458	err |= __put_user(__NR_rt_sigreturn, (int __user *)(frame->retcode+1));
459	err |= __put_user(0x80cd, (short __user *)(frame->retcode+5));
460
461	if (err)
462		return err;
463
464	PT_REGS_SP(regs) = (unsigned long) frame;
465	PT_REGS_IP(regs) = (unsigned long) ka->sa.sa_handler;
466	PT_REGS_AX(regs) = (unsigned long) sig;
467	PT_REGS_DX(regs) = (unsigned long) &frame->info;
468	PT_REGS_CX(regs) = (unsigned long) &frame->uc;
469
470	if ((current->ptrace & PT_DTRACE) && (current->ptrace & PT_PTRACED))
471		ptrace_notify(SIGTRAP);
472	return 0;
473}
474
475long sys_sigreturn(struct pt_regs *regs)
476{
477	unsigned long sp = PT_REGS_SP(&current->thread.regs);
478	struct sigframe __user *frame = (struct sigframe __user *)(sp - 8);
479	sigset_t set;
480	struct sigcontext __user *sc = &frame->sc;
481	unsigned long __user *oldmask = &sc->oldmask;
482	unsigned long __user *extramask = frame->extramask;
483	int sig_size = (_NSIG_WORDS - 1) * sizeof(unsigned long);
484
485	if (copy_from_user(&set.sig[0], oldmask, sizeof(set.sig[0])) ||
486	    copy_from_user(&set.sig[1], extramask, sig_size))
487		goto segfault;
488
489	set_current_blocked(&set);
490
491	if (copy_sc_from_user(&current->thread.regs, sc))
492		goto segfault;
493
494	/* Avoid ERESTART handling */
495	PT_REGS_SYSCALL_NR(&current->thread.regs) = -1;
496	return PT_REGS_SYSCALL_RET(&current->thread.regs);
497
498 segfault:
499	force_sig(SIGSEGV, current);
500	return 0;
501}
502
503#else
504
505struct rt_sigframe
 
506{
507	char __user *pretcode;
508	struct ucontext uc;
509	struct siginfo info;
510	struct _fpstate fpstate;
511};
 
 
 
 
512
513int setup_signal_stack_si(unsigned long stack_top, int sig,
514			  struct k_sigaction *ka, struct pt_regs * regs,
515			  siginfo_t *info, sigset_t *set)
516{
517	struct rt_sigframe __user *frame;
518	int err = 0;
519	struct task_struct *me = current;
520
521	frame = (struct rt_sigframe __user *)
522		round_down(stack_top - sizeof(struct rt_sigframe), 16);
523	/* Subtract 128 for a red zone and 8 for proper alignment */
524	frame = (struct rt_sigframe __user *) ((unsigned long) frame - 128 - 8);
525
526	if (!access_ok(VERIFY_WRITE, frame, sizeof(*frame)))
527		goto out;
528
529	if (ka->sa.sa_flags & SA_SIGINFO) {
530		err |= copy_siginfo_to_user(&frame->info, info);
531		if (err)
532			goto out;
533	}
534
535	/* Create the ucontext.  */
536	err |= __put_user(0, &frame->uc.uc_flags);
537	err |= __put_user(0, &frame->uc.uc_link);
538	err |= __put_user(me->sas_ss_sp, &frame->uc.uc_stack.ss_sp);
539	err |= __put_user(sas_ss_flags(PT_REGS_SP(regs)),
540			  &frame->uc.uc_stack.ss_flags);
541	err |= __put_user(me->sas_ss_size, &frame->uc.uc_stack.ss_size);
542	err |= copy_sc_to_user(&frame->uc.uc_mcontext, &frame->fpstate, regs,
543			       set->sig[0]);
544	err |= __put_user(&frame->fpstate, &frame->uc.uc_mcontext.fpstate);
 
 
545	if (sizeof(*set) == 16) {
546		err |= __put_user(set->sig[0], &frame->uc.uc_sigmask.sig[0]);
547		err |= __put_user(set->sig[1], &frame->uc.uc_sigmask.sig[1]);
548	}
549	else
550		err |= __copy_to_user(&frame->uc.uc_sigmask, set,
551				      sizeof(*set));
552
553	/*
554	 * Set up to return from userspace.  If provided, use a stub
555	 * already in userspace.
556	 */
557	/* x86-64 should always use SA_RESTORER. */
558	if (ka->sa.sa_flags & SA_RESTORER)
559		err |= __put_user(ka->sa.sa_restorer, &frame->pretcode);
 
560	else
561		/* could use a vstub here */
562		return err;
563
564	if (err)
565		return err;
566
567	/* Set up registers for signal handler */
568	{
569		struct exec_domain *ed = current_thread_info()->exec_domain;
570		if (unlikely(ed && ed->signal_invmap && sig < 32))
571			sig = ed->signal_invmap[sig];
572	}
573
574	PT_REGS_SP(regs) = (unsigned long) frame;
575	PT_REGS_DI(regs) = sig;
576	/* In case the signal handler was declared without prototypes */
577	PT_REGS_AX(regs) = 0;
578
579	/*
580	 * This also works for non SA_SIGINFO handlers because they expect the
581	 * next argument after the signal number on the stack.
582	 */
583	PT_REGS_SI(regs) = (unsigned long) &frame->info;
584	PT_REGS_DX(regs) = (unsigned long) &frame->uc;
585	PT_REGS_IP(regs) = (unsigned long) ka->sa.sa_handler;
586 out:
587	return err;
588}
589#endif
590
591long sys_rt_sigreturn(struct pt_regs *regs)
592{
593	unsigned long sp = PT_REGS_SP(&current->thread.regs);
594	struct rt_sigframe __user *frame =
595		(struct rt_sigframe __user *)(sp - sizeof(long));
596	struct ucontext __user *uc = &frame->uc;
597	sigset_t set;
598
599	if (copy_from_user(&set, &uc->uc_sigmask, sizeof(set)))
600		goto segfault;
601
602	set_current_blocked(&set);
603
604	if (copy_sc_from_user(&current->thread.regs, &uc->uc_mcontext))
605		goto segfault;
606
607	/* Avoid ERESTART handling */
608	PT_REGS_SYSCALL_NR(&current->thread.regs) = -1;
609	return PT_REGS_SYSCALL_RET(&current->thread.regs);
610
611 segfault:
612	force_sig(SIGSEGV, current);
613	return 0;
614}
615
616#ifdef CONFIG_X86_32
617long ptregs_sigreturn(void)
618{
619	return sys_sigreturn(NULL);
620}
621long ptregs_rt_sigreturn(void)
622{
623	return sys_rt_sigreturn(NULL);
624}
625#endif