1 /*
2 * Copyright (C) 2014 Altera Corporation
3 * Copyright (C) 2010 Tobias Klauser <tklauser@distanz.ch>
4 *
5 * This file is subject to the terms and conditions of the GNU General
6 * Public License. See the file COPYING in the main directory of this
7 * archive for more details.
8 */
9
10 #include <linux/elf.h>
11 #include <linux/errno.h>
12 #include <linux/kernel.h>
13 #include <linux/mm.h>
14 #include <linux/ptrace.h>
15 #include <linux/regset.h>
16 #include <linux/sched.h>
17 #include <linux/sched/task_stack.h>
18 #include <linux/uaccess.h>
19 #include <linux/user.h>
20
genregs_get(struct task_struct * target,const struct user_regset * regset,struct membuf to)21 static int genregs_get(struct task_struct *target,
22 const struct user_regset *regset,
23 struct membuf to)
24 {
25 const struct pt_regs *regs = task_pt_regs(target);
26 const struct switch_stack *sw = (struct switch_stack *)regs - 1;
27
28 membuf_zero(&to, 4); // R0
29 membuf_write(&to, ®s->r1, 7 * 4); // R1..R7
30 membuf_write(&to, ®s->r8, 8 * 4); // R8..R15
31 membuf_write(&to, sw, 8 * 4); // R16..R23
32 membuf_zero(&to, 2 * 4); /* et and bt */
33 membuf_store(&to, regs->gp);
34 membuf_store(&to, regs->sp);
35 membuf_store(&to, regs->fp);
36 membuf_store(&to, regs->ea);
37 membuf_zero(&to, 4); // PTR_BA
38 membuf_store(&to, regs->ra);
39 membuf_store(&to, regs->ea); /* use ea for PC */
40 return membuf_zero(&to, (NUM_PTRACE_REG - PTR_PC) * 4);
41 }
42
43 /*
44 * Set the thread state from a regset passed in via ptrace
45 */
genregs_set(struct task_struct * target,const struct user_regset * regset,unsigned int pos,unsigned int count,const void * kbuf,const void __user * ubuf)46 static int genregs_set(struct task_struct *target,
47 const struct user_regset *regset,
48 unsigned int pos, unsigned int count,
49 const void *kbuf, const void __user *ubuf)
50 {
51 struct pt_regs *regs = task_pt_regs(target);
52 const struct switch_stack *sw = (struct switch_stack *)regs - 1;
53 int ret = 0;
54
55 #define REG_IGNORE_RANGE(START, END) \
56 if (!ret) \
57 user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf, \
58 START * 4, (END * 4) + 4);
59
60 #define REG_IN_ONE(PTR, LOC) \
61 if (!ret) \
62 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, \
63 (void *)(PTR), LOC * 4, (LOC * 4) + 4);
64
65 #define REG_IN_RANGE(PTR, START, END) \
66 if (!ret) \
67 ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf, \
68 (void *)(PTR), START * 4, (END * 4) + 4);
69
70 REG_IGNORE_RANGE(PTR_R0, PTR_R0);
71 REG_IN_RANGE(®s->r1, PTR_R1, PTR_R7);
72 REG_IN_RANGE(®s->r8, PTR_R8, PTR_R15);
73 REG_IN_RANGE(sw, PTR_R16, PTR_R23);
74 REG_IGNORE_RANGE(PTR_R24, PTR_R25); /* et and bt */
75 REG_IN_ONE(®s->gp, PTR_GP);
76 REG_IN_ONE(®s->sp, PTR_SP);
77 REG_IN_ONE(®s->fp, PTR_FP);
78 REG_IN_ONE(®s->ea, PTR_EA);
79 REG_IGNORE_RANGE(PTR_BA, PTR_BA);
80 REG_IN_ONE(®s->ra, PTR_RA);
81 REG_IN_ONE(®s->ea, PTR_PC); /* use ea for PC */
82 if (!ret)
83 user_regset_copyin_ignore(&pos, &count, &kbuf, &ubuf,
84 PTR_STATUS * 4, -1);
85
86 return ret;
87 }
88
89 /*
90 * Define the register sets available on Nios2 under Linux
91 */
92 enum nios2_regset {
93 REGSET_GENERAL,
94 };
95
96 static const struct user_regset nios2_regsets[] = {
97 [REGSET_GENERAL] = {
98 .core_note_type = NT_PRSTATUS,
99 .n = NUM_PTRACE_REG,
100 .size = sizeof(unsigned long),
101 .align = sizeof(unsigned long),
102 .regset_get = genregs_get,
103 .set = genregs_set,
104 }
105 };
106
107 static const struct user_regset_view nios2_user_view = {
108 .name = "nios2",
109 .e_machine = ELF_ARCH,
110 .ei_osabi = ELF_OSABI,
111 .regsets = nios2_regsets,
112 .n = ARRAY_SIZE(nios2_regsets)
113 };
114
task_user_regset_view(struct task_struct * task)115 const struct user_regset_view *task_user_regset_view(struct task_struct *task)
116 {
117 return &nios2_user_view;
118 }
119
ptrace_disable(struct task_struct * child)120 void ptrace_disable(struct task_struct *child)
121 {
122
123 }
124
arch_ptrace(struct task_struct * child,long request,unsigned long addr,unsigned long data)125 long arch_ptrace(struct task_struct *child, long request, unsigned long addr,
126 unsigned long data)
127 {
128 return ptrace_request(child, request, addr, data);
129 }
130
do_syscall_trace_enter(void)131 asmlinkage int do_syscall_trace_enter(void)
132 {
133 int ret = 0;
134
135 if (test_thread_flag(TIF_SYSCALL_TRACE))
136 ret = ptrace_report_syscall_entry(task_pt_regs(current));
137
138 return ret;
139 }
140
do_syscall_trace_exit(void)141 asmlinkage void do_syscall_trace_exit(void)
142 {
143 if (test_thread_flag(TIF_SYSCALL_TRACE))
144 ptrace_report_syscall_exit(task_pt_regs(current), 0);
145 }
146