forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
146 lines
3.8 KiB
146 lines
3.8 KiB
/* |
|
* Copyright (C) 2014 Altera Corporation |
|
* Copyright (C) 2010 Tobias Klauser <[email protected]> |
|
* |
|
* This file is subject to the terms and conditions of the GNU General |
|
* Public License. See the file COPYING in the main directory of this |
|
* archive for more details. |
|
*/ |
|
|
|
#include <linux/elf.h> |
|
#include <linux/errno.h> |
|
#include <linux/kernel.h> |
|
#include <linux/mm.h> |
|
#include <linux/ptrace.h> |
|
#include <linux/regset.h> |
|
#include <linux/sched.h> |
|
#include <linux/sched/task_stack.h> |
|
#include <linux/tracehook.h> |
|
#include <linux/uaccess.h> |
|
#include <linux/user.h> |
|
|
|
static int genregs_get(struct task_struct *target, |
|
const struct user_regset *regset, |
|
struct membuf to) |
|
{ |
|
const struct pt_regs *regs = task_pt_regs(target); |
|
const struct switch_stack *sw = (struct switch_stack *)regs - 1; |
|
|
|
membuf_zero(&to, 4); // R0 |
|
membuf_write(&to, ®s->r1, 7 * 4); // R1..R7 |
|
membuf_write(&to, ®s->r8, 8 * 4); // R8..R15 |
|
membuf_write(&to, sw, 8 * 4); // R16..R23 |
|
membuf_zero(&to, 2 * 4); /* et and bt */ |
|
membuf_store(&to, regs->gp); |
|
membuf_store(&to, regs->sp); |
|
membuf_store(&to, regs->fp); |
|
membuf_store(&to, regs->ea); |
|
membuf_zero(&to, 4); // PTR_BA |
|
membuf_store(&to, regs->ra); |
|
membuf_store(&to, regs->ea); /* use ea for PC */ |
|
return membuf_zero(&to, (NUM_PTRACE_REG - PTR_PC) * 4); |
|
} |
|
|
|
/* |
|
* Set the thread state from a regset passed in via ptrace |
|
*/ |
|
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 pt_regs *regs = task_pt_regs(target); |
|
const struct switch_stack *sw = (struct switch_stack *)regs - 1; |
|
int ret = 0; |
|
|
|
#define REG_IGNORE_RANGE(START, END) \ |
|
if (!ret) \ |
|
ret = user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf, \ |
|
START * 4, (END * 4) + 4); |
|
|
|
#define REG_IN_ONE(PTR, LOC) \ |
|
if (!ret) \ |
|
ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, \ |
|
(void *)(PTR), LOC * 4, (LOC * 4) + 4); |
|
|
|
#define REG_IN_RANGE(PTR, START, END) \ |
|
if (!ret) \ |
|
ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, \ |
|
(void *)(PTR), START * 4, (END * 4) + 4); |
|
|
|
REG_IGNORE_RANGE(PTR_R0, PTR_R0); |
|
REG_IN_RANGE(®s->r1, PTR_R1, PTR_R7); |
|
REG_IN_RANGE(®s->r8, PTR_R8, PTR_R15); |
|
REG_IN_RANGE(sw, PTR_R16, PTR_R23); |
|
REG_IGNORE_RANGE(PTR_R24, PTR_R25); /* et and bt */ |
|
REG_IN_ONE(®s->gp, PTR_GP); |
|
REG_IN_ONE(®s->sp, PTR_SP); |
|
REG_IN_ONE(®s->fp, PTR_FP); |
|
REG_IN_ONE(®s->ea, PTR_EA); |
|
REG_IGNORE_RANGE(PTR_BA, PTR_BA); |
|
REG_IN_ONE(®s->ra, PTR_RA); |
|
REG_IN_ONE(®s->ea, PTR_PC); /* use ea for PC */ |
|
if (!ret) |
|
ret = user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf, |
|
PTR_STATUS * 4, -1); |
|
|
|
return ret; |
|
} |
|
|
|
/* |
|
* Define the register sets available on Nios2 under Linux |
|
*/ |
|
enum nios2_regset { |
|
REGSET_GENERAL, |
|
}; |
|
|
|
static const struct user_regset nios2_regsets[] = { |
|
[REGSET_GENERAL] = { |
|
.core_note_type = NT_PRSTATUS, |
|
.n = NUM_PTRACE_REG, |
|
.size = sizeof(unsigned long), |
|
.align = sizeof(unsigned long), |
|
.regset_get = genregs_get, |
|
.set = genregs_set, |
|
} |
|
}; |
|
|
|
static const struct user_regset_view nios2_user_view = { |
|
.name = "nios2", |
|
.e_machine = ELF_ARCH, |
|
.ei_osabi = ELF_OSABI, |
|
.regsets = nios2_regsets, |
|
.n = ARRAY_SIZE(nios2_regsets) |
|
}; |
|
|
|
const struct user_regset_view *task_user_regset_view(struct task_struct *task) |
|
{ |
|
return &nios2_user_view; |
|
} |
|
|
|
void ptrace_disable(struct task_struct *child) |
|
{ |
|
|
|
} |
|
|
|
long arch_ptrace(struct task_struct *child, long request, unsigned long addr, |
|
unsigned long data) |
|
{ |
|
return ptrace_request(child, request, addr, data); |
|
} |
|
|
|
asmlinkage int do_syscall_trace_enter(void) |
|
{ |
|
int ret = 0; |
|
|
|
if (test_thread_flag(TIF_SYSCALL_TRACE)) |
|
ret = tracehook_report_syscall_entry(task_pt_regs(current)); |
|
|
|
return ret; |
|
} |
|
|
|
asmlinkage void do_syscall_trace_exit(void) |
|
{ |
|
if (test_thread_flag(TIF_SYSCALL_TRACE)) |
|
tracehook_report_syscall_exit(task_pt_regs(current), 0); |
|
}
|
|
|