1/*
2 *  linux/arch/h8300/kernel/ptrace.c
3 *
4 *  Copyright 2015 Yoshinori Sato <ysato@users.sourceforge.jp>
5 *
6 * This file is subject to the terms and conditions of the GNU General
7 * Public License.  See the file COPYING in the main directory of
8 * this archive for more details.
9 */
10
11#include <linux/kernel.h>
12#include <linux/errno.h>
13#include <linux/ptrace.h>
14#include <linux/audit.h>
15#include <linux/tracehook.h>
16#include <linux/regset.h>
17#include <linux/elf.h>
18
19#define CCR_MASK 0x6f    /* mode/imask not set */
20#define EXR_MASK 0x80    /* modify only T */
21
22#define PT_REG(r) offsetof(struct pt_regs, r)
23
24extern void user_disable_single_step(struct task_struct *child);
25
26/* Mapping from PT_xxx to the stack offset at which the register is
27   saved.  Notice that usp has no stack-slot and needs to be treated
28   specially (see get_reg/put_reg below). */
29static const int register_offset[] = {
30	PT_REG(er1), PT_REG(er2), PT_REG(er3), PT_REG(er4),
31	PT_REG(er5), PT_REG(er6), PT_REG(er0), -1,
32	PT_REG(orig_er0), PT_REG(ccr), PT_REG(pc),
33#if defined(CONFIG_CPU_H8S)
34	PT_REG(exr),
35#endif
36};
37
38/* read register */
39long h8300_get_reg(struct task_struct *task, int regno)
40{
41	switch (regno) {
42	case PT_USP:
43		return task->thread.usp + sizeof(long)*2;
44	case PT_CCR:
45	case PT_EXR:
46	    return *(unsigned short *)(task->thread.esp0 +
47				       register_offset[regno]);
48	default:
49	    return *(unsigned long *)(task->thread.esp0 +
50				      register_offset[regno]);
51	}
52}
53
54int h8300_put_reg(struct task_struct *task, int regno, unsigned long data)
55{
56	unsigned short oldccr;
57	unsigned short oldexr;
58
59	switch (regno) {
60	case PT_USP:
61		task->thread.usp = data - sizeof(long)*2;
62	case PT_CCR:
63		oldccr = *(unsigned short *)(task->thread.esp0 +
64					     register_offset[regno]);
65		oldccr &= ~CCR_MASK;
66		data &= CCR_MASK;
67		data |= oldccr;
68		*(unsigned short *)(task->thread.esp0 +
69				    register_offset[regno]) = data;
70		break;
71	case PT_EXR:
72		oldexr = *(unsigned short *)(task->thread.esp0 +
73					     register_offset[regno]);
74		oldccr &= ~EXR_MASK;
75		data &= EXR_MASK;
76		data |= oldexr;
77		*(unsigned short *)(task->thread.esp0 +
78				    register_offset[regno]) = data;
79		break;
80	default:
81		*(unsigned long *)(task->thread.esp0 +
82				   register_offset[regno]) = data;
83		break;
84	}
85	return 0;
86}
87
88static int regs_get(struct task_struct *target,
89		    const struct user_regset *regset,
90		    unsigned int pos, unsigned int count,
91		    void *kbuf, void __user *ubuf)
92{
93	int r;
94	struct user_regs_struct regs;
95	long *reg = (long *)&regs;
96
97	/* build user regs in buffer */
98	for (r = 0; r < ARRAY_SIZE(register_offset); r++)
99		*reg++ = h8300_get_reg(target, r);
100
101	return user_regset_copyout(&pos, &count, &kbuf, &ubuf,
102				   &regs, 0, sizeof(regs));
103}
104
105static int regs_set(struct task_struct *target,
106		    const struct user_regset *regset,
107		    unsigned int pos, unsigned int count,
108		    const void *kbuf, const void __user *ubuf)
109{
110	int r;
111	int ret;
112	struct user_regs_struct regs;
113	long *reg;
114
115	/* build user regs in buffer */
116	for (reg = (long *)&regs, r = 0; r < ARRAY_SIZE(register_offset); r++)
117		*reg++ = h8300_get_reg(target, r);
118
119	ret = user_regset_copyin(&pos, &count, &kbuf, &ubuf,
120				 &regs, 0, sizeof(regs));
121	if (ret)
122		return ret;
123
124	/* write back to pt_regs */
125	for (reg = (long *)&regs, r = 0; r < ARRAY_SIZE(register_offset); r++)
126		h8300_put_reg(target, r, *reg++);
127	return 0;
128}
129
130enum h8300_regset {
131	REGSET_GENERAL,
132};
133
134static const struct user_regset h8300_regsets[] = {
135	[REGSET_GENERAL] = {
136		.core_note_type	= NT_PRSTATUS,
137		.n		= ELF_NGREG,
138		.size		= sizeof(long),
139		.align		= sizeof(long),
140		.get		= regs_get,
141		.set		= regs_set,
142	},
143};
144
145static const struct user_regset_view user_h8300_native_view = {
146	.name = "h8300",
147	.e_machine = EM_H8_300,
148	.regsets = h8300_regsets,
149	.n = ARRAY_SIZE(h8300_regsets),
150};
151
152const struct user_regset_view *task_user_regset_view(struct task_struct *task)
153{
154	return &user_h8300_native_view;
155}
156
157void ptrace_disable(struct task_struct *child)
158{
159	user_disable_single_step(child);
160}
161
162long arch_ptrace(struct task_struct *child, long request,
163		 unsigned long addr, unsigned long data)
164{
165	int ret;
166
167	switch (request) {
168	default:
169		ret = ptrace_request(child, request, addr, data);
170		break;
171	}
172	return ret;
173}
174
175asmlinkage long do_syscall_trace_enter(struct pt_regs *regs)
176{
177	long ret = 0;
178
179	if (test_thread_flag(TIF_SYSCALL_TRACE) &&
180	    tracehook_report_syscall_entry(regs))
181		/*
182		 * Tracing decided this syscall should not happen.
183		 * We'll return a bogus call number to get an ENOSYS
184		 * error, but leave the original number in regs->regs[0].
185		 */
186		ret = -1L;
187
188	audit_syscall_entry(regs->er1, regs->er2, regs->er3,
189			    regs->er4, regs->er5);
190
191	return ret ?: regs->er0;
192}
193
194asmlinkage void do_syscall_trace_leave(struct pt_regs *regs)
195{
196	int step;
197
198	audit_syscall_exit(regs);
199
200	step = test_thread_flag(TIF_SINGLESTEP);
201	if (step || test_thread_flag(TIF_SYSCALL_TRACE))
202		tracehook_report_syscall_exit(regs, step);
203}
204