arch/frv/kernel/ptrace.c - maze/linux - Git at Google

 /* 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/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);
 }
	/* 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/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);
	}