[net-next-2.6.git] / arch / frv / kernel / ptrace.c

/* ptrace.c: FRV specific parts of process tracing
 *
 * Copyright (C) 2003-5 Red Hat, Inc. All Rights Reserved.
 * Written by David Howells (dhowells@redhat.com)
 * - Derived from arch/m68k/kernel/ptrace.c
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version
 * 2 of the License, or (at your option) any later version.
 */

#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/mm.h>
#include <linux/smp.h>
#include <linux/errno.h>
#include <linux/ptrace.h>
#include <linux/user.h>
#include <linux/security.h>
#include <linux/signal.h>
#include <linux/regset.h>
#include <linux/elf.h>
#include <linux/tracehook.h>

#include <asm/uaccess.h>
#include <asm/page.h>
#include <asm/pgtable.h>
#include <asm/system.h>
#include <asm/processor.h>
#include <asm/unistd.h>

/*
 * does not yet catch signals sent when the child dies.
 * in exit.c or in signal.c.
 */

/*
 * retrieve the contents of FRV userspace general registers
 */
static int genregs_get(struct task_struct *target,
		       const struct user_regset *regset,
		       unsigned int pos, unsigned int count,
		       void *kbuf, void __user *ubuf)
{
	const struct user_int_regs *iregs = &target->thread.user->i;
	int ret;

	ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
				  iregs, 0, sizeof(*iregs));
	if (ret < 0)
		return ret;

	return user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
					sizeof(*iregs), -1);
}

/*
 * update the contents of the FRV userspace general registers
 */
static int genregs_set(struct task_struct *target,
		       const struct user_regset *regset,
		       unsigned int pos, unsigned int count,
		       const void *kbuf, const void __user *ubuf)
{
	struct user_int_regs *iregs = &target->thread.user->i;
	unsigned int offs_gr0, offs_gr1;
	int ret;

	/* not allowed to set PSR or __status */
	if (pos < offsetof(struct user_int_regs, psr) + sizeof(long) &&
	    pos + count > offsetof(struct user_int_regs, psr))
		return -EIO;

	if (pos < offsetof(struct user_int_regs, __status) + sizeof(long) &&
	    pos + count > offsetof(struct user_int_regs, __status))
		return -EIO;

	/* set the control regs */
	offs_gr0 = offsetof(struct user_int_regs, gr[0]);
	offs_gr1 = offsetof(struct user_int_regs, gr[1]);
	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
				 iregs, 0, offs_gr0);
	if (ret < 0)
		return ret;

	/* skip GR0/TBR */
	ret = user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
					offs_gr0, offs_gr1);
	if (ret < 0)
		return ret;

	/* set the general regs */
	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
				 &iregs->gr[1], offs_gr1, sizeof(*iregs));
	if (ret < 0)
		return ret;

	return user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
					sizeof(*iregs), -1);
}

/*
 * retrieve the contents of FRV userspace FP/Media registers
 */
static int fpmregs_get(struct task_struct *target,
		       const struct user_regset *regset,
		       unsigned int pos, unsigned int count,
		       void *kbuf, void __user *ubuf)
{
	const struct user_fpmedia_regs *fpregs = &target->thread.user->f;
	int ret;

	ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
				  fpregs, 0, sizeof(*fpregs));
	if (ret < 0)
		return ret;

	return user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
					sizeof(*fpregs), -1);
}

/*
 * update the contents of the FRV userspace FP/Media registers
 */
static int fpmregs_set(struct task_struct *target,
		       const struct user_regset *regset,
		       unsigned int pos, unsigned int count,
		       const void *kbuf, const void __user *ubuf)
{
	struct user_fpmedia_regs *fpregs = &target->thread.user->f;
	int ret;

	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
				 fpregs, 0, sizeof(*fpregs));
	if (ret < 0)
		return ret;

	return user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
					sizeof(*fpregs), -1);
}

/*
 * determine if the FP/Media registers have actually been used
 */
static int fpmregs_active(struct task_struct *target,
			  const struct user_regset *regset)
{
	return tsk_used_math(target) ? regset->n : 0;
}

/*
 * Define the register sets available on the FRV under Linux
 */
enum frv_regset {
	REGSET_GENERAL,
	REGSET_FPMEDIA,
};

static const struct user_regset frv_regsets[] = {
	/*
	 * General register format is:
	 *	PSR, ISR, CCR, CCCR, LR, LCR, PC, (STATUS), SYSCALLNO, ORIG_G8
	 *	GNER0-1, IACC0, TBR, GR1-63
	 */
	[REGSET_GENERAL] = {
		.core_note_type	= NT_PRSTATUS,
		.n		= ELF_NGREG,
		.size		= sizeof(long),
		.align		= sizeof(long),
		.get		= genregs_get,
		.set		= genregs_set,
	},
	/*
	 * FPU/Media register format is:
	 *	FR0-63, FNER0-1, MSR0-1, ACC0-7, ACCG0-8, FSR
	 */
	[REGSET_FPMEDIA] = {
		.core_note_type	= NT_PRFPREG,
		.n		= sizeof(struct user_fpmedia_regs) / sizeof(long),
		.size		= sizeof(long),
		.align		= sizeof(long),
		.get		= fpmregs_get,
		.set		= fpmregs_set,
		.active		= fpmregs_active,
	},
};

static const struct user_regset_view user_frv_native_view = {
	.name		= "frv",
	.e_machine	= EM_FRV,
	.regsets	= frv_regsets,
	.n		= ARRAY_SIZE(frv_regsets),
};

const struct user_regset_view *task_user_regset_view(struct task_struct *task)
{
	return &user_frv_native_view;
}

/*
 * Get contents of register REGNO in task TASK.
 */
static inline long get_reg(struct task_struct *task, int regno)
{
	struct user_context *user = task->thread.user;

	if (regno < 0 || regno >= PT__END)
		return 0;

	return ((unsigned long *) user)[regno];
}

/*
 * Write contents of register REGNO in task TASK.
 */
static inline int put_reg(struct task_struct *task, int regno,
			  unsigned long data)
{
	struct user_context *user = task->thread.user;

	if (regno < 0 || regno >= PT__END)
		return -EIO;

	switch (regno) {
	case PT_GR(0):
		return 0;
	case PT_PSR:
	case PT__STATUS:
		return -EIO;
	default:
		((unsigned long *) user)[regno] = data;
		return 0;
	}
}

/*
 * Called by kernel/ptrace.c when detaching..
 *
 * Control h/w single stepping
 */
void user_enable_single_step(struct task_struct *child)
{
	child->thread.frame0->__status |= REG__STATUS_STEP;
}

void user_disable_single_step(struct task_struct *child)
{
	child->thread.frame0->__status &= ~REG__STATUS_STEP;
}

void ptrace_disable(struct task_struct *child)
{
	user_disable_single_step(child);
}

long arch_ptrace(struct task_struct *child, long request,
		 unsigned long addr, unsigned long data)
{
	unsigned long tmp;
	int ret;
	int regno = addr >> 2;
	unsigned long __user *datap = (unsigned long __user *) data;

	switch (request) {
		/* read the word at location addr in the USER area. */
	case PTRACE_PEEKUSR: {
		tmp = 0;
		ret = -EIO;
		if (addr & 3)
			break;

		ret = 0;
		switch (regno) {
		case 0 ... PT__END - 1:
			tmp = get_reg(child, regno);
			break;

		case PT__END + 0:
			tmp = child->mm->end_code - child->mm->start_code;
			break;

		case PT__END + 1:
			tmp = child->mm->end_data - child->mm->start_data;
			break;

		case PT__END + 2:
			tmp = child->mm->start_stack - child->mm->start_brk;
			break;

		case PT__END + 3:
			tmp = child->mm->start_code;
			break;

		case PT__END + 4:
			tmp = child->mm->start_stack;
			break;

		default:
			ret = -EIO;
			break;
		}

		if (ret == 0)
			ret = put_user(tmp, datap);
		break;
	}

	case PTRACE_POKEUSR: /* write the word at location addr in the USER area */
		ret = -EIO;
		if (addr & 3)
			break;

		switch (regno) {
		case 0 ... PT__END - 1:
			ret = put_reg(child, regno, data);
			break;
		}
		break;

	case PTRACE_GETREGS:	/* Get all integer regs from the child. */
		return copy_regset_to_user(child, &user_frv_native_view,
					   REGSET_GENERAL,
					   0, sizeof(child->thread.user->i),
					   datap);

	case PTRACE_SETREGS:	/* Set all integer regs in the child. */
		return copy_regset_from_user(child, &user_frv_native_view,
					     REGSET_GENERAL,
					     0, sizeof(child->thread.user->i),
					     datap);

	case PTRACE_GETFPREGS:	/* Get the child FP/Media state. */
		return copy_regset_to_user(child, &user_frv_native_view,
					   REGSET_FPMEDIA,
					   0, sizeof(child->thread.user->f),
					   datap);

	case PTRACE_SETFPREGS:	/* Set the child FP/Media state. */
		return copy_regset_from_user(child, &user_frv_native_view,
					     REGSET_FPMEDIA,
					     0, sizeof(child->thread.user->f),
					     datap);

	default:
		ret = ptrace_request(child, request, addr, data);
		break;
	}
	return ret;
}

/*
 * handle tracing of system call entry
 * - return the revised system call number or ULONG_MAX to cause ENOSYS
 */
asmlinkage unsigned long syscall_trace_entry(void)
{
	__frame->__status |= REG__STATUS_SYSC_ENTRY;
	if (tracehook_report_syscall_entry(__frame)) {
		/* tracing decided this syscall should not happen, so
		 * We'll return a bogus call number to get an ENOSYS
		 * error, but leave the original number in
		 * __frame->syscallno
		 */
		return ULONG_MAX;
	}

	return __frame->syscallno;
}

/*
 * handle tracing of system call exit
 */
asmlinkage void syscall_trace_exit(void)
{
	__frame->__status |= REG__STATUS_SYSC_EXIT;
	tracehook_report_syscall_exit(__frame, 0);
}
Commit	Line	Data
1da177e4 LT	1	/* ptrace.c: FRV specific parts of process tracing
	2	*
	3	* Copyright (C) 2003-5 Red Hat, Inc. All Rights Reserved.
	4	* Written by David Howells (dhowells@redhat.com)
	5	* - Derived from arch/m68k/kernel/ptrace.c
	6	*
	7	* This program is free software; you can redistribute it and/or
	8	* modify it under the terms of the GNU General Public License
	9	* as published by the Free Software Foundation; either version
	10	* 2 of the License, or (at your option) any later version.
	11	*/
	12
	13	#include <linux/kernel.h>
	14	#include <linux/sched.h>
	15	#include <linux/mm.h>
	16	#include <linux/smp.h>
1da177e4 LT	17	#include <linux/errno.h>
	18	#include <linux/ptrace.h>
	19	#include <linux/user.h>
1da177e4	20	#include <linux/security.h>
7ed20e1a	21	#include <linux/signal.h>
4a3b9893 DH	22	#include <linux/regset.h>
	23	#include <linux/elf.h>
	24	#include <linux/tracehook.h>
1da177e4 LT	25
	26	#include <asm/uaccess.h>
	27	#include <asm/page.h>
	28	#include <asm/pgtable.h>
	29	#include <asm/system.h>
	30	#include <asm/processor.h>
	31	#include <asm/unistd.h>
	32
	33	/*
	34	* does not yet catch signals sent when the child dies.
	35	* in exit.c or in signal.c.
	36	*/
	37
4a3b9893 DH	38	/*
	39	* retrieve the contents of FRV userspace general registers
	40	*/
	41	static int genregs_get(struct task_struct *target,
	42	const struct user_regset *regset,
	43	unsigned int pos, unsigned int count,
	44	void kbuf, void __user ubuf)
	45	{
	46	const struct user_int_regs *iregs = &target->thread.user->i;
	47	int ret;
	48
	49	ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
	50	iregs, 0, sizeof(*iregs));
	51	if (ret < 0)
	52	return ret;
	53
	54	return user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
	55	sizeof(*iregs), -1);
	56	}
	57
	58	/*
	59	* update the contents of the FRV userspace general registers
	60	*/
	61	static int genregs_set(struct task_struct *target,
	62	const struct user_regset *regset,
	63	unsigned int pos, unsigned int count,
	64	const void kbuf, const void __user ubuf)
	65	{
	66	struct user_int_regs *iregs = &target->thread.user->i;
	67	unsigned int offs_gr0, offs_gr1;
	68	int ret;
	69
	70	/* not allowed to set PSR or __status */
	71	if (pos < offsetof(struct user_int_regs, psr) + sizeof(long) &&
	72	pos + count > offsetof(struct user_int_regs, psr))
	73	return -EIO;
	74
	75	if (pos < offsetof(struct user_int_regs, __status) + sizeof(long) &&
	76	pos + count > offsetof(struct user_int_regs, __status))
	77	return -EIO;
	78
	79	/* set the control regs */
	80	offs_gr0 = offsetof(struct user_int_regs, gr[0]);
	81	offs_gr1 = offsetof(struct user_int_regs, gr[1]);
	82	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
	83	iregs, 0, offs_gr0);
	84	if (ret < 0)
	85	return ret;
	86
	87	/* skip GR0/TBR */
	88	ret = user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
	89	offs_gr0, offs_gr1);
	90	if (ret < 0)
	91	return ret;
	92
	93	/* set the general regs */
	94	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
	95	&iregs->gr[1], offs_gr1, sizeof(*iregs));
	96	if (ret < 0)
	97	return ret;
	98
	99	return user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
	100	sizeof(*iregs), -1);
	101	}
102
103	/*
104	* retrieve the contents of FRV userspace FP/Media registers
105	*/
106	static int fpmregs_get(struct task_struct *target,
107	const struct user_regset *regset,
108	unsigned int pos, unsigned int count,
109	void kbuf, void __user ubuf)
110	{
111	const struct user_fpmedia_regs *fpregs = &target->thread.user->f;
112	int ret;
113
114	ret = user_regset_copyout(&pos, &count, &kbuf, &ubuf,
115	fpregs, 0, sizeof(*fpregs));
116	if (ret < 0)
117	return ret;
118
119	return user_regset_copyout_zero(&pos, &count, &kbuf, &ubuf,
120	sizeof(*fpregs), -1);
121	}
122
123	/*
124	* update the contents of the FRV userspace FP/Media registers
125	*/
126	static int fpmregs_set(struct task_struct *target,
127	const struct user_regset *regset,
128	unsigned int pos, unsigned int count,
129	const void kbuf, const void __user ubuf)
130	{
131	struct user_fpmedia_regs *fpregs = &target->thread.user->f;
132	int ret;
133
134	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
135	fpregs, 0, sizeof(*fpregs));
136	if (ret < 0)
137	return ret;
138
139	return user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
140	sizeof(*fpregs), -1);
141	}
142
143	/*
144	* determine if the FP/Media registers have actually been used
145	*/
146	static int fpmregs_active(struct task_struct *target,
147	const struct user_regset *regset)
148	{
149	return tsk_used_math(target) ? regset->n : 0;
150	}
151
152	/*
153	* Define the register sets available on the FRV under Linux
154	*/
155	enum frv_regset {
156	REGSET_GENERAL,
157	REGSET_FPMEDIA,
158	};
159
160	static const struct user_regset frv_regsets[] = {
161	/*
162	* General register format is:
163	* PSR, ISR, CCR, CCCR, LR, LCR, PC, (STATUS), SYSCALLNO, ORIG_G8
164	* GNER0-1, IACC0, TBR, GR1-63
165	*/
166	[REGSET_GENERAL] = {
167	.core_note_type = NT_PRSTATUS,
168	.n = ELF_NGREG,
169	.size = sizeof(long),
170	.align = sizeof(long),
171	.get = genregs_get,
172	.set = genregs_set,
173	},
174	/*
175	* FPU/Media register format is:
176	* FR0-63, FNER0-1, MSR0-1, ACC0-7, ACCG0-8, FSR
177	*/
178	[REGSET_FPMEDIA] = {
179	.core_note_type = NT_PRFPREG,
180	.n = sizeof(struct user_fpmedia_regs) / sizeof(long),
181	.size = sizeof(long),
182	.align = sizeof(long),
183	.get = fpmregs_get,
184	.set = fpmregs_set,
185	.active = fpmregs_active,
186	},
187	};
188
189	static const struct user_regset_view user_frv_native_view = {
190	.name = "frv",
191	.e_machine = EM_FRV,
192	.regsets = frv_regsets,
193	.n = ARRAY_SIZE(frv_regsets),
194	};
195
196	const struct user_regset_view task_user_regset_view(struct task_struct task)
197	{
198	return &user_frv_native_view;
199	}
200
1da177e4 LT	201	/*
	202	* Get contents of register REGNO in task TASK.
	203	*/
	204	static inline long get_reg(struct task_struct *task, int regno)
	205	{
	206	struct user_context *user = task->thread.user;
	207
	208	if (regno < 0 \|\| regno >= PT__END)
	209	return 0;
	210
	211	return ((unsigned long *) user)[regno];
	212	}
	213
	214	/*
	215	* Write contents of register REGNO in task TASK.
	216	*/
	217	static inline int put_reg(struct task_struct *task, int regno,
	218	unsigned long data)
	219	{
	220	struct user_context *user = task->thread.user;
	221
	222	if (regno < 0 \|\| regno >= PT__END)
	223	return -EIO;
	224
	225	switch (regno) {
	226	case PT_GR(0):
	227	return 0;
	228	case PT_PSR:
	229	case PT__STATUS:
	230	return -EIO;
	231	default:
	232	((unsigned long *) user)[regno] = data;
	233	return 0;
	234	}
	235	}
	236
1da177e4 LT	237	/*
	238	* Called by kernel/ptrace.c when detaching..
	239	*
	240	* Control h/w single stepping
	241	*/
4a3b9893 DH	242	void user_enable_single_step(struct task_struct *child)
	243	{
	244	child->thread.frame0->__status \|= REG__STATUS_STEP;
	245	}
	246
	247	void user_disable_single_step(struct task_struct *child)
1da177e4 LT	248	{
	249	child->thread.frame0->__status &= ~REG__STATUS_STEP;
	250	}
	251
4a3b9893	252	void ptrace_disable(struct task_struct *child)
1da177e4	253	{
4a3b9893	254	user_disable_single_step(child);
1da177e4 LT	255	}
1da177e4 LT	256
9b05a69e NK	257	long arch_ptrace(struct task_struct *child, long request,
9b05a69e NK	258	unsigned long addr, unsigned long data)
1da177e4	259	{
1da177e4 LT	260	unsigned long tmp;
1da177e4 LT	261	int ret;
81d3285c NK	262	int regno = addr >> 2;
81d3285c NK	263	unsigned long __user datap = (unsigned long __user ) data;
1da177e4	264
1da177e4	265	switch (request) {
1da177e4 LT	266	/* read the word at location addr in the USER area. */
	267	case PTRACE_PEEKUSR: {
	268	tmp = 0;
	269	ret = -EIO;
81d3285c	270	if (addr & 3)
1da177e4 LT	271	break;
	272
	273	ret = 0;
81d3285c	274	switch (regno) {
1da177e4	275	case 0 ... PT__END - 1:
81d3285c	276	tmp = get_reg(child, regno);
1da177e4 LT	277	break;
	278
	279	case PT__END + 0:
	280	tmp = child->mm->end_code - child->mm->start_code;
	281	break;
	282
	283	case PT__END + 1:
	284	tmp = child->mm->end_data - child->mm->start_data;
	285	break;
	286
	287	case PT__END + 2:
	288	tmp = child->mm->start_stack - child->mm->start_brk;
	289	break;
	290
	291	case PT__END + 3:
	292	tmp = child->mm->start_code;
	293	break;
	294
	295	case PT__END + 4:
	296	tmp = child->mm->start_stack;
	297	break;
	298
	299	default:
	300	ret = -EIO;
	301	break;
	302	}
	303
	304	if (ret == 0)
81d3285c	305	ret = put_user(tmp, datap);
1da177e4 LT	306	break;
	307	}
	308
1da177e4 LT	309	case PTRACE_POKEUSR: /* write the word at location addr in the USER area */
1da177e4 LT	310	ret = -EIO;
81d3285c	311	if (addr & 3)
1da177e4 LT	312	break;
1da177e4 LT	313
81d3285c	314	switch (regno) {
4a3b9893	315	case 0 ... PT__END - 1:
81d3285c	316	ret = put_reg(child, regno, data);
1da177e4 LT	317	break;
	318	}
	319	break;
	320
4a3b9893 DH	321	case PTRACE_GETREGS: /* Get all integer regs from the child. */
	322	return copy_regset_to_user(child, &user_frv_native_view,
	323	REGSET_GENERAL,
	324	0, sizeof(child->thread.user->i),
81d3285c	325	datap);
4a3b9893 DH	326
	327	case PTRACE_SETREGS: /* Set all integer regs in the child. */
	328	return copy_regset_from_user(child, &user_frv_native_view,
	329	REGSET_GENERAL,
	330	0, sizeof(child->thread.user->i),
81d3285c	331	datap);
4a3b9893 DH	332
	333	case PTRACE_GETFPREGS: /* Get the child FP/Media state. */
	334	return copy_regset_to_user(child, &user_frv_native_view,
	335	REGSET_FPMEDIA,
	336	0, sizeof(child->thread.user->f),
81d3285c	337	datap);
4a3b9893 DH	338
	339	case PTRACE_SETFPREGS: /* Set the child FP/Media state. */
	340	return copy_regset_from_user(child, &user_frv_native_view,
	341	REGSET_FPMEDIA,
	342	0, sizeof(child->thread.user->f),
81d3285c	343	datap);
1da177e4	344
1da177e4	345	default:
4a3b9893	346	ret = ptrace_request(child, request, addr, data);
1da177e4 LT	347	break;
1da177e4 LT	348	}
1da177e4 LT	349	return ret;
	350	}
	351
4a3b9893 DH	352	/*
	353	* handle tracing of system call entry
	354	* - return the revised system call number or ULONG_MAX to cause ENOSYS
	355	*/
	356	asmlinkage unsigned long syscall_trace_entry(void)
1da177e4	357	{
4a3b9893 DH	358	__frame->__status \|= REG__STATUS_SYSC_ENTRY;
	359	if (tracehook_report_syscall_entry(__frame)) {
	360	/* tracing decided this syscall should not happen, so
	361	* We'll return a bogus call number to get an ENOSYS
	362	* error, but leave the original number in
	363	* __frame->syscallno
	364	*/
	365	return ULONG_MAX;
	366	}
1da177e4	367
4a3b9893 DH	368	return __frame->syscallno;
4a3b9893 DH	369	}
1da177e4	370
4a3b9893 DH	371	/*
	372	* handle tracing of system call exit
	373	*/
	374	asmlinkage void syscall_trace_exit(void)
	375	{
	376	__frame->__status \|= REG__STATUS_SYSC_EXIT;
	377	tracehook_report_syscall_exit(__frame, 0);
1da177e4	378	}