[deliverable/linux.git] / arch / x86 / um / ptrace_32.c

/*
 * Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
 * Licensed under the GPL
 */

#include <linux/mm.h>
#include <linux/sched.h>
#include <asm/uaccess.h>
#include <asm/ptrace-abi.h>
#include <skas.h>

extern int arch_switch_tls(struct task_struct *to);

void arch_switch_to(struct task_struct *to)
{
	int err = arch_switch_tls(to);
	if (!err)
		return;

	if (err != -EINVAL)
		printk(KERN_WARNING "arch_switch_tls failed, errno %d, "
		       "not EINVAL\n", -err);
	else
		printk(KERN_WARNING "arch_switch_tls failed, errno = EINVAL\n");
}

int is_syscall(unsigned long addr)
{
	unsigned short instr;
	int n;

	n = copy_from_user(&instr, (void __user *) addr, sizeof(instr));
	if (n) {
		/* access_process_vm() grants access to vsyscall and stub,
		 * while copy_from_user doesn't. Maybe access_process_vm is
		 * slow, but that doesn't matter, since it will be called only
		 * in case of singlestepping, if copy_from_user failed.
		 */
		n = access_process_vm(current, addr, &instr, sizeof(instr), 0);
		if (n != sizeof(instr)) {
			printk(KERN_ERR "is_syscall : failed to read "
			       "instruction from 0x%lx\n", addr);
			return 1;
		}
	}
	/* int 0x80 or sysenter */
	return (instr == 0x80cd) || (instr == 0x340f);
}

/* determines which flags the user has access to. */
/* 1 = access 0 = no access */
#define FLAG_MASK 0x00044dd5

static const int reg_offsets[] = {
	[EBX] = HOST_BX,
	[ECX] = HOST_CX,
	[EDX] = HOST_DX,
	[ESI] = HOST_SI,
	[EDI] = HOST_DI,
	[EBP] = HOST_BP,
	[EAX] = HOST_AX,
	[DS] = HOST_DS,
	[ES] = HOST_ES,
	[FS] = HOST_FS,
	[GS] = HOST_GS,
	[EIP] = HOST_IP,
	[CS] = HOST_CS,
	[EFL] = HOST_EFLAGS,
	[UESP] = HOST_SP,
	[SS] = HOST_SS,
	[ORIG_EAX] = HOST_ORIG_AX,
};

int putreg(struct task_struct *child, int regno, unsigned long value)
{
	regno >>= 2;
	switch (regno) {
	case EBX:
	case ECX:
	case EDX:
	case ESI:
	case EDI:
	case EBP:
	case EAX:
	case EIP:
	case UESP:
		break;
	case ORIG_EAX:
		/* Update the syscall number. */
		UPT_SYSCALL_NR(&child->thread.regs.regs) = value;
		break;
	case FS:
		if (value && (value & 3) != 3)
			return -EIO;
		break;
	case GS:
		if (value && (value & 3) != 3)
			return -EIO;
		break;
	case DS:
	case ES:
		if (value && (value & 3) != 3)
			return -EIO;
		value &= 0xffff;
		break;
	case SS:
	case CS:
		if ((value & 3) != 3)
			return -EIO;
		value &= 0xffff;
		break;
	case EFL:
		value &= FLAG_MASK;
		child->thread.regs.regs.gp[HOST_EFLAGS] |= value;
		return 0;
	default :
		panic("Bad register in putreg() : %d\n", regno);
	}
	child->thread.regs.regs.gp[reg_offsets[regno]] = value;
	return 0;
}

int poke_user(struct task_struct *child, long addr, long data)
{
	if ((addr & 3) || addr < 0)
		return -EIO;

	if (addr < MAX_REG_OFFSET)
		return putreg(child, addr, data);
	else if ((addr >= offsetof(struct user, u_debugreg[0])) &&
		 (addr <= offsetof(struct user, u_debugreg[7]))) {
		addr -= offsetof(struct user, u_debugreg[0]);
		addr = addr >> 2;
		if ((addr == 4) || (addr == 5))
			return -EIO;
		child->thread.arch.debugregs[addr] = data;
		return 0;
	}
	return -EIO;
}

unsigned long getreg(struct task_struct *child, int regno)
{
	unsigned long mask = ~0UL;

	regno >>= 2;
	switch (regno) {
	case FS:
	case GS:
	case DS:
	case ES:
	case SS:
	case CS:
		mask = 0xffff;
		break;
	case EIP:
	case UESP:
	case EAX:
	case EBX:
	case ECX:
	case EDX:
	case ESI:
	case EDI:
	case EBP:
	case EFL:
	case ORIG_EAX:
		break;
	default:
		panic("Bad register in getreg() : %d\n", regno);
	}
	return mask & child->thread.regs.regs.gp[reg_offsets[regno]];
}

/* read the word at location addr in the USER area. */
int peek_user(struct task_struct *child, long addr, long data)
{
	unsigned long tmp;

	if ((addr & 3) || addr < 0)
		return -EIO;

	tmp = 0;  /* Default return condition */
	if (addr < MAX_REG_OFFSET) {
		tmp = getreg(child, addr);
	}
	else if ((addr >= offsetof(struct user, u_debugreg[0])) &&
		 (addr <= offsetof(struct user, u_debugreg[7]))) {
		addr -= offsetof(struct user, u_debugreg[0]);
		addr = addr >> 2;
		tmp = child->thread.arch.debugregs[addr];
	}
	return put_user(tmp, (unsigned long __user *) data);
}

static int get_fpregs(struct user_i387_struct __user *buf, struct task_struct *child)
{
	int err, n, cpu = ((struct thread_info *) child->stack)->cpu;
	struct user_i387_struct fpregs;

	err = save_i387_registers(userspace_pid[cpu],
				  (unsigned long *) &fpregs);
	if (err)
		return err;

	n = copy_to_user(buf, &fpregs, sizeof(fpregs));
	if(n > 0)
		return -EFAULT;

	return n;
}

static int set_fpregs(struct user_i387_struct __user *buf, struct task_struct *child)
{
	int n, cpu = ((struct thread_info *) child->stack)->cpu;
	struct user_i387_struct fpregs;

	n = copy_from_user(&fpregs, buf, sizeof(fpregs));
	if (n > 0)
		return -EFAULT;

	return restore_i387_registers(userspace_pid[cpu],
				    (unsigned long *) &fpregs);
}

static int get_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child)
{
	int err, n, cpu = ((struct thread_info *) child->stack)->cpu;
	struct user_fxsr_struct fpregs;

	err = save_fpx_registers(userspace_pid[cpu], (unsigned long *) &fpregs);
	if (err)
		return err;

	n = copy_to_user(buf, &fpregs, sizeof(fpregs));
	if(n > 0)
		return -EFAULT;

	return n;
}

static int set_fpxregs(struct user_fxsr_struct __user *buf, struct task_struct *child)
{
	int n, cpu = ((struct thread_info *) child->stack)->cpu;
	struct user_fxsr_struct fpregs;

	n = copy_from_user(&fpregs, buf, sizeof(fpregs));
	if (n > 0)
		return -EFAULT;

	return restore_fpx_registers(userspace_pid[cpu],
				     (unsigned long *) &fpregs);
}

long subarch_ptrace(struct task_struct *child, long request,
		    unsigned long addr, unsigned long data)
{
	int ret = -EIO;
	void __user *datap = (void __user *) data;
	switch (request) {
	case PTRACE_GETFPREGS: /* Get the child FPU state. */
		ret = get_fpregs(datap, child);
		break;
	case PTRACE_SETFPREGS: /* Set the child FPU state. */
		ret = set_fpregs(datap, child);
		break;
	case PTRACE_GETFPXREGS: /* Get the child FPU state. */
		ret = get_fpxregs(datap, child);
		break;
	case PTRACE_SETFPXREGS: /* Set the child FPU state. */
		ret = set_fpxregs(datap, child);
		break;
	default:
		ret = -EIO;
	}
	return ret;
}
Commit	Line	Data
ba180fd4 JD	1	/*
ba180fd4 JD	2	* Copyright (C) 2000 - 2007 Jeff Dike (jdike@{addtoit,linux.intel}.com)
1da177e4 LT	3	* Licensed under the GPL
	4	*/
	5
37185b33 AV	6	#include <linux/mm.h>
	7	#include <linux/sched.h>
	8	#include <asm/uaccess.h>
da028d5e	9	#include <asm/ptrace-abi.h>
37185b33	10	#include <skas.h>
1da177e4	11
291248fd	12	extern int arch_switch_tls(struct task_struct *to);
77bf4400	13
291248fd	14	void arch_switch_to(struct task_struct *to)
1da177e4	15	{
291248fd	16	int err = arch_switch_tls(to);
54d8d3b5 PBG	17	if (!err)
	18	return;
	19
	20	if (err != -EINVAL)
ba180fd4 JD	21	printk(KERN_WARNING "arch_switch_tls failed, errno %d, "
ba180fd4 JD	22	"not EINVAL\n", -err);
54d8d3b5	23	else
77bf4400	24	printk(KERN_WARNING "arch_switch_tls failed, errno = EINVAL\n");
1da177e4 LT	25	}
	26
	27	int is_syscall(unsigned long addr)
	28	{
	29	unsigned short instr;
	30	int n;
	31
	32	n = copy_from_user(&instr, (void __user *) addr, sizeof(instr));
ba180fd4	33	if (n) {
81efcd33 BS	34	/* access_process_vm() grants access to vsyscall and stub,
	35	* while copy_from_user doesn't. Maybe access_process_vm is
	36	* slow, but that doesn't matter, since it will be called only
	37	* in case of singlestepping, if copy_from_user failed.
	38	*/
	39	n = access_process_vm(current, addr, &instr, sizeof(instr), 0);
ba180fd4 JD	40	if (n != sizeof(instr)) {
	41	printk(KERN_ERR "is_syscall : failed to read "
	42	"instruction from 0x%lx\n", addr);
	43	return 1;
81efcd33	44	}
1da177e4 LT	45	}
1da177e4 LT	46	/* int 0x80 or sysenter */
ba180fd4	47	return (instr == 0x80cd) \|\| (instr == 0x340f);
1da177e4 LT	48	}
	49
	50	/* determines which flags the user has access to. */
	51	/* 1 = access 0 = no access */
	52	#define FLAG_MASK 0x00044dd5
	53
412f90ed	54	static const int reg_offsets[] = {
3579a389 AV	55	[EBX] = HOST_BX,
	56	[ECX] = HOST_CX,
	57	[EDX] = HOST_DX,
	58	[ESI] = HOST_SI,
	59	[EDI] = HOST_DI,
	60	[EBP] = HOST_BP,
	61	[EAX] = HOST_AX,
412f90ed AV	62	[DS] = HOST_DS,
	63	[ES] = HOST_ES,
	64	[FS] = HOST_FS,
	65	[GS] = HOST_GS,
	66	[EIP] = HOST_IP,
	67	[CS] = HOST_CS,
	68	[EFL] = HOST_EFLAGS,
	69	[UESP] = HOST_SP,
	70	[SS] = HOST_SS,
e04c989e	71	[ORIG_EAX] = HOST_ORIG_AX,
412f90ed AV	72	};
412f90ed AV	73
1da177e4 LT	74	int putreg(struct task_struct *child, int regno, unsigned long value)
	75	{
	76	regno >>= 2;
	77	switch (regno) {
412f90ed AV	78	case EBX:
	79	case ECX:
	80	case EDX:
	81	case ESI:
	82	case EDI:
	83	case EBP:
	84	case EAX:
	85	case EIP:
	86	case UESP:
ce29856a	87	break;
e04c989e	88	case ORIG_EAX:
ce29856a MS	89	/* Update the syscall number. */
ce29856a MS	90	UPT_SYSCALL_NR(&child->thread.regs.regs) = value;
412f90ed	91	break;
1da177e4 LT	92	case FS:
	93	if (value && (value & 3) != 3)
	94	return -EIO;
412f90ed	95	break;
1da177e4 LT	96	case GS:
	97	if (value && (value & 3) != 3)
	98	return -EIO;
412f90ed	99	break;
1da177e4 LT	100	case DS:
	101	case ES:
	102	if (value && (value & 3) != 3)
	103	return -EIO;
	104	value &= 0xffff;
	105	break;
	106	case SS:
	107	case CS:
	108	if ((value & 3) != 3)
	109	return -EIO;
	110	value &= 0xffff;
	111	break;
	112	case EFL:
	113	value &= FLAG_MASK;
412f90ed AV	114	child->thread.regs.regs.gp[HOST_EFLAGS] \|= value;
412f90ed AV	115	return 0;
412f90ed AV	116	default :
412f90ed AV	117	panic("Bad register in putreg() : %d\n", regno);
1da177e4	118	}
412f90ed	119	child->thread.regs.regs.gp[reg_offsets[regno]] = value;
1da177e4 LT	120	return 0;
	121	}
	122
82c1c11b BS	123	int poke_user(struct task_struct *child, long addr, long data)
82c1c11b BS	124	{
ba180fd4 JD	125	if ((addr & 3) \|\| addr < 0)
	126	return -EIO;
	127
	128	if (addr < MAX_REG_OFFSET)
	129	return putreg(child, addr, data);
	130	else if ((addr >= offsetof(struct user, u_debugreg[0])) &&
	131	(addr <= offsetof(struct user, u_debugreg[7]))) {
	132	addr -= offsetof(struct user, u_debugreg[0]);
	133	addr = addr >> 2;
	134	if ((addr == 4) \|\| (addr == 5))
	135	return -EIO;
	136	child->thread.arch.debugregs[addr] = data;
	137	return 0;
	138	}
	139	return -EIO;
82c1c11b BS	140	}
82c1c11b BS	141
1da177e4 LT	142	unsigned long getreg(struct task_struct *child, int regno)
1da177e4 LT	143	{
412f90ed	144	unsigned long mask = ~0UL;
1da177e4 LT	145
	146	regno >>= 2;
	147	switch (regno) {
	148	case FS:
	149	case GS:
	150	case DS:
	151	case ES:
	152	case SS:
	153	case CS:
412f90ed AV	154	mask = 0xffff;
	155	break;
	156	case EIP:
	157	case UESP:
	158	case EAX:
	159	case EBX:
	160	case ECX:
	161	case EDX:
	162	case ESI:
	163	case EDI:
	164	case EBP:
	165	case EFL:
e04c989e	166	case ORIG_EAX:
412f90ed	167	break;
1da177e4	168	default:
412f90ed	169	panic("Bad register in getreg() : %d\n", regno);
1da177e4	170	}
412f90ed	171	return mask & child->thread.regs.regs.gp[reg_offsets[regno]];
1da177e4 LT	172	}
1da177e4 LT	173
ba180fd4	174	/* read the word at location addr in the USER area. */
82c1c11b BS	175	int peek_user(struct task_struct *child, long addr, long data)
82c1c11b BS	176	{
4d338e1a	177	unsigned long tmp;
82c1c11b	178
4d338e1a AV	179	if ((addr & 3) \|\| addr < 0)
4d338e1a AV	180	return -EIO;
82c1c11b	181
4d338e1a	182	tmp = 0; /* Default return condition */
ba180fd4	183	if (addr < MAX_REG_OFFSET) {
4d338e1a AV	184	tmp = getreg(child, addr);
4d338e1a AV	185	}
ba180fd4 JD	186	else if ((addr >= offsetof(struct user, u_debugreg[0])) &&
ba180fd4 JD	187	(addr <= offsetof(struct user, u_debugreg[7]))) {
4d338e1a AV	188	addr -= offsetof(struct user, u_debugreg[0]);
	189	addr = addr >> 2;
	190	tmp = child->thread.arch.debugregs[addr];
	191	}
	192	return put_user(tmp, (unsigned long __user *) data);
82c1c11b BS	193	}
82c1c11b BS	194
f2833aef	195	static int get_fpregs(struct user_i387_struct __user buf, struct task_struct child)
1da177e4	196	{
e8012b58	197	int err, n, cpu = ((struct thread_info *) child->stack)->cpu;
47906dd9	198	struct user_i387_struct fpregs;
1da177e4	199
a78ff111 EC	200	err = save_i387_registers(userspace_pid[cpu],
a78ff111 EC	201	(unsigned long *) &fpregs);
e8012b58 JD	202	if (err)
	203	return err;
	204
47906dd9	205	n = copy_to_user(buf, &fpregs, sizeof(fpregs));
e8012b58 JD	206	if(n > 0)
	207	return -EFAULT;
	208
	209	return n;
1da177e4 LT	210	}
1da177e4 LT	211
f2833aef	212	static int set_fpregs(struct user_i387_struct __user buf, struct task_struct child)
1da177e4	213	{
e8012b58	214	int n, cpu = ((struct thread_info *) child->stack)->cpu;
47906dd9	215	struct user_i387_struct fpregs;
1da177e4	216
47906dd9	217	n = copy_from_user(&fpregs, buf, sizeof(fpregs));
e8012b58	218	if (n > 0)
ba180fd4	219	return -EFAULT;
e8012b58	220
a78ff111	221	return restore_i387_registers(userspace_pid[cpu],
47906dd9	222	(unsigned long *) &fpregs);
1da177e4 LT	223	}
1da177e4 LT	224
f2833aef	225	static int get_fpxregs(struct user_fxsr_struct __user buf, struct task_struct child)
1da177e4	226	{
e8012b58	227	int err, n, cpu = ((struct thread_info *) child->stack)->cpu;
47906dd9	228	struct user_fxsr_struct fpregs;
1da177e4	229
47906dd9	230	err = save_fpx_registers(userspace_pid[cpu], (unsigned long *) &fpregs);
ba180fd4	231	if (err)
e8012b58 JD	232	return err;
e8012b58 JD	233
47906dd9	234	n = copy_to_user(buf, &fpregs, sizeof(fpregs));
e8012b58	235	if(n > 0)
ba180fd4	236	return -EFAULT;
1da177e4	237
e8012b58	238	return n;
1da177e4 LT	239	}
1da177e4 LT	240
f2833aef	241	static int set_fpxregs(struct user_fxsr_struct __user buf, struct task_struct child)
1da177e4	242	{
e8012b58	243	int n, cpu = ((struct thread_info *) child->stack)->cpu;
47906dd9	244	struct user_fxsr_struct fpregs;
e8012b58	245
47906dd9	246	n = copy_from_user(&fpregs, buf, sizeof(fpregs));
e8012b58 JD	247	if (n > 0)
	248	return -EFAULT;
	249
47906dd9 JD	250	return restore_fpx_registers(userspace_pid[cpu],
47906dd9 JD	251	(unsigned long *) &fpregs);
1da177e4 LT	252	}
1da177e4 LT	253
9b05a69e NK	254	long subarch_ptrace(struct task_struct *child, long request,
9b05a69e NK	255	unsigned long addr, unsigned long data)
e8012b58	256	{
01599cdc AV	257	int ret = -EIO;
01599cdc AV	258	void __user datap = (void __user ) data;
01599cdc	259	switch (request) {
f2833aef AV	260	case PTRACE_GETFPREGS: /* Get the child FPU state. */
	261	ret = get_fpregs(datap, child);
	262	break;
	263	case PTRACE_SETFPREGS: /* Set the child FPU state. */
	264	ret = set_fpregs(datap, child);
	265	break;
01599cdc AV	266	case PTRACE_GETFPXREGS: /* Get the child FPU state. */
	267	ret = get_fpxregs(datap, child);
	268	break;
	269	case PTRACE_SETFPXREGS: /* Set the child FPU state. */
	270	ret = set_fpxregs(datap, child);
	271	break;
f2833aef AV	272	default:
f2833aef AV	273	ret = -EIO;
01599cdc	274	}
01599cdc	275	return ret;
e8012b58	276	}