xref: /openbmc/linux/arch/xtensa/kernel/ptrace.c (revision a2cce7a9)
1 // TODO some minor issues
2 /*
3  * This file is subject to the terms and conditions of the GNU General Public
4  * License.  See the file "COPYING" in the main directory of this archive
5  * for more details.
6  *
7  * Copyright (C) 2001 - 2007  Tensilica Inc.
8  *
9  * Joe Taylor	<joe@tensilica.com, joetylr@yahoo.com>
10  * Chris Zankel <chris@zankel.net>
11  * Scott Foehner<sfoehner@yahoo.com>,
12  * Kevin Chea
13  * Marc Gauthier<marc@tensilica.com> <marc@alumni.uwaterloo.ca>
14  */
15 
16 #include <linux/kernel.h>
17 #include <linux/sched.h>
18 #include <linux/mm.h>
19 #include <linux/errno.h>
20 #include <linux/ptrace.h>
21 #include <linux/smp.h>
22 #include <linux/security.h>
23 #include <linux/signal.h>
24 
25 #include <asm/pgtable.h>
26 #include <asm/page.h>
27 #include <asm/uaccess.h>
28 #include <asm/ptrace.h>
29 #include <asm/elf.h>
30 #include <asm/coprocessor.h>
31 
32 
33 void user_enable_single_step(struct task_struct *child)
34 {
35 	child->ptrace |= PT_SINGLESTEP;
36 }
37 
38 void user_disable_single_step(struct task_struct *child)
39 {
40 	child->ptrace &= ~PT_SINGLESTEP;
41 }
42 
43 /*
44  * Called by kernel/ptrace.c when detaching to disable single stepping.
45  */
46 
47 void ptrace_disable(struct task_struct *child)
48 {
49 	/* Nothing to do.. */
50 }
51 
52 int ptrace_getregs(struct task_struct *child, void __user *uregs)
53 {
54 	struct pt_regs *regs = task_pt_regs(child);
55 	xtensa_gregset_t __user *gregset = uregs;
56 	unsigned long wb = regs->windowbase;
57 	int i;
58 
59 	if (!access_ok(VERIFY_WRITE, uregs, sizeof(xtensa_gregset_t)))
60 		return -EIO;
61 
62 	__put_user(regs->pc, &gregset->pc);
63 	__put_user(regs->ps & ~(1 << PS_EXCM_BIT), &gregset->ps);
64 	__put_user(regs->lbeg, &gregset->lbeg);
65 	__put_user(regs->lend, &gregset->lend);
66 	__put_user(regs->lcount, &gregset->lcount);
67 	__put_user(regs->windowstart, &gregset->windowstart);
68 	__put_user(regs->windowbase, &gregset->windowbase);
69 	__put_user(regs->threadptr, &gregset->threadptr);
70 
71 	for (i = 0; i < XCHAL_NUM_AREGS; i++)
72 		__put_user(regs->areg[i],
73 				gregset->a + ((wb * 4 + i) % XCHAL_NUM_AREGS));
74 
75 	return 0;
76 }
77 
78 int ptrace_setregs(struct task_struct *child, void __user *uregs)
79 {
80 	struct pt_regs *regs = task_pt_regs(child);
81 	xtensa_gregset_t *gregset = uregs;
82 	const unsigned long ps_mask = PS_CALLINC_MASK | PS_OWB_MASK;
83 	unsigned long ps;
84 	unsigned long wb, ws;
85 
86 	if (!access_ok(VERIFY_WRITE, uregs, sizeof(xtensa_gregset_t)))
87 		return -EIO;
88 
89 	__get_user(regs->pc, &gregset->pc);
90 	__get_user(ps, &gregset->ps);
91 	__get_user(regs->lbeg, &gregset->lbeg);
92 	__get_user(regs->lend, &gregset->lend);
93 	__get_user(regs->lcount, &gregset->lcount);
94 	__get_user(ws, &gregset->windowstart);
95 	__get_user(wb, &gregset->windowbase);
96 	__get_user(regs->threadptr, &gregset->threadptr);
97 
98 	regs->ps = (regs->ps & ~ps_mask) | (ps & ps_mask) | (1 << PS_EXCM_BIT);
99 
100 	if (wb >= XCHAL_NUM_AREGS / 4)
101 		return -EFAULT;
102 
103 	if (wb != regs->windowbase || ws != regs->windowstart) {
104 		unsigned long rotws, wmask;
105 
106 		rotws = (((ws | (ws << WSBITS)) >> wb) &
107 				((1 << WSBITS) - 1)) & ~1;
108 		wmask = ((rotws ? WSBITS + 1 - ffs(rotws) : 0) << 4) |
109 			(rotws & 0xF) | 1;
110 		regs->windowbase = wb;
111 		regs->windowstart = ws;
112 		regs->wmask = wmask;
113 	}
114 
115 	if (wb != 0 &&  __copy_from_user(regs->areg + XCHAL_NUM_AREGS - wb * 4,
116 				gregset->a, wb * 16))
117 		return -EFAULT;
118 
119 	if (__copy_from_user(regs->areg, gregset->a + wb * 4,
120 				(WSBITS - wb) * 16))
121 		return -EFAULT;
122 
123 	return 0;
124 }
125 
126 
127 int ptrace_getxregs(struct task_struct *child, void __user *uregs)
128 {
129 	struct pt_regs *regs = task_pt_regs(child);
130 	struct thread_info *ti = task_thread_info(child);
131 	elf_xtregs_t __user *xtregs = uregs;
132 	int ret = 0;
133 
134 	if (!access_ok(VERIFY_WRITE, uregs, sizeof(elf_xtregs_t)))
135 		return -EIO;
136 
137 #if XTENSA_HAVE_COPROCESSORS
138 	/* Flush all coprocessor registers to memory. */
139 	coprocessor_flush_all(ti);
140 	ret |= __copy_to_user(&xtregs->cp0, &ti->xtregs_cp,
141 			      sizeof(xtregs_coprocessor_t));
142 #endif
143 	ret |= __copy_to_user(&xtregs->opt, &regs->xtregs_opt,
144 			      sizeof(xtregs->opt));
145 	ret |= __copy_to_user(&xtregs->user,&ti->xtregs_user,
146 			      sizeof(xtregs->user));
147 
148 	return ret ? -EFAULT : 0;
149 }
150 
151 int ptrace_setxregs(struct task_struct *child, void __user *uregs)
152 {
153 	struct thread_info *ti = task_thread_info(child);
154 	struct pt_regs *regs = task_pt_regs(child);
155 	elf_xtregs_t *xtregs = uregs;
156 	int ret = 0;
157 
158 	if (!access_ok(VERIFY_READ, uregs, sizeof(elf_xtregs_t)))
159 		return -EFAULT;
160 
161 #if XTENSA_HAVE_COPROCESSORS
162 	/* Flush all coprocessors before we overwrite them. */
163 	coprocessor_flush_all(ti);
164 	coprocessor_release_all(ti);
165 
166 	ret |= __copy_from_user(&ti->xtregs_cp, &xtregs->cp0,
167 				sizeof(xtregs_coprocessor_t));
168 #endif
169 	ret |= __copy_from_user(&regs->xtregs_opt, &xtregs->opt,
170 				sizeof(xtregs->opt));
171 	ret |= __copy_from_user(&ti->xtregs_user, &xtregs->user,
172 				sizeof(xtregs->user));
173 
174 	return ret ? -EFAULT : 0;
175 }
176 
177 int ptrace_peekusr(struct task_struct *child, long regno, long __user *ret)
178 {
179 	struct pt_regs *regs;
180 	unsigned long tmp;
181 
182 	regs = task_pt_regs(child);
183 	tmp = 0;  /* Default return value. */
184 
185 	switch(regno) {
186 
187 		case REG_AR_BASE ... REG_AR_BASE + XCHAL_NUM_AREGS - 1:
188 			tmp = regs->areg[regno - REG_AR_BASE];
189 			break;
190 
191 		case REG_A_BASE ... REG_A_BASE + 15:
192 			tmp = regs->areg[regno - REG_A_BASE];
193 			break;
194 
195 		case REG_PC:
196 			tmp = regs->pc;
197 			break;
198 
199 		case REG_PS:
200 			/* Note:  PS.EXCM is not set while user task is running;
201 			 * its being set in regs is for exception handling
202 			 * convenience.  */
203 			tmp = (regs->ps & ~(1 << PS_EXCM_BIT));
204 			break;
205 
206 		case REG_WB:
207 			break;		/* tmp = 0 */
208 
209 		case REG_WS:
210 		{
211 			unsigned long wb = regs->windowbase;
212 			unsigned long ws = regs->windowstart;
213 			tmp = ((ws>>wb) | (ws<<(WSBITS-wb))) & ((1<<WSBITS)-1);
214 			break;
215 		}
216 		case REG_LBEG:
217 			tmp = regs->lbeg;
218 			break;
219 
220 		case REG_LEND:
221 			tmp = regs->lend;
222 			break;
223 
224 		case REG_LCOUNT:
225 			tmp = regs->lcount;
226 			break;
227 
228 		case REG_SAR:
229 			tmp = regs->sar;
230 			break;
231 
232 		case SYSCALL_NR:
233 			tmp = regs->syscall;
234 			break;
235 
236 		default:
237 			return -EIO;
238 	}
239 	return put_user(tmp, ret);
240 }
241 
242 int ptrace_pokeusr(struct task_struct *child, long regno, long val)
243 {
244 	struct pt_regs *regs;
245 	regs = task_pt_regs(child);
246 
247 	switch (regno) {
248 		case REG_AR_BASE ... REG_AR_BASE + XCHAL_NUM_AREGS - 1:
249 			regs->areg[regno - REG_AR_BASE] = val;
250 			break;
251 
252 		case REG_A_BASE ... REG_A_BASE + 15:
253 			regs->areg[regno - REG_A_BASE] = val;
254 			break;
255 
256 		case REG_PC:
257 			regs->pc = val;
258 			break;
259 
260 		case SYSCALL_NR:
261 			regs->syscall = val;
262 			break;
263 
264 		default:
265 			return -EIO;
266 	}
267 	return 0;
268 }
269 
270 long arch_ptrace(struct task_struct *child, long request,
271 		 unsigned long addr, unsigned long data)
272 {
273 	int ret = -EPERM;
274 	void __user *datap = (void __user *) data;
275 
276 	switch (request) {
277 	case PTRACE_PEEKTEXT:	/* read word at location addr. */
278 	case PTRACE_PEEKDATA:
279 		ret = generic_ptrace_peekdata(child, addr, data);
280 		break;
281 
282 	case PTRACE_PEEKUSR:	/* read register specified by addr. */
283 		ret = ptrace_peekusr(child, addr, datap);
284 		break;
285 
286 	case PTRACE_POKETEXT:	/* write the word at location addr. */
287 	case PTRACE_POKEDATA:
288 		ret = generic_ptrace_pokedata(child, addr, data);
289 		break;
290 
291 	case PTRACE_POKEUSR:	/* write register specified by addr. */
292 		ret = ptrace_pokeusr(child, addr, data);
293 		break;
294 
295 	case PTRACE_GETREGS:
296 		ret = ptrace_getregs(child, datap);
297 		break;
298 
299 	case PTRACE_SETREGS:
300 		ret = ptrace_setregs(child, datap);
301 		break;
302 
303 	case PTRACE_GETXTREGS:
304 		ret = ptrace_getxregs(child, datap);
305 		break;
306 
307 	case PTRACE_SETXTREGS:
308 		ret = ptrace_setxregs(child, datap);
309 		break;
310 
311 	default:
312 		ret = ptrace_request(child, request, addr, data);
313 		break;
314 	}
315 
316 	return ret;
317 }
318 
319 void do_syscall_trace(void)
320 {
321 	/*
322 	 * The 0x80 provides a way for the tracing parent to distinguish
323 	 * between a syscall stop and SIGTRAP delivery
324 	 */
325 	ptrace_notify(SIGTRAP|((current->ptrace & PT_TRACESYSGOOD) ? 0x80 : 0));
326 
327 	/*
328 	 * this isn't the same as continuing with a signal, but it will do
329 	 * for normal use.  strace only continues with a signal if the
330 	 * stopping signal is not SIGTRAP.  -brl
331 	 */
332 	if (current->exit_code) {
333 		send_sig(current->exit_code, current, 1);
334 		current->exit_code = 0;
335 	}
336 }
337 
338 void do_syscall_trace_enter(struct pt_regs *regs)
339 {
340 	if (test_thread_flag(TIF_SYSCALL_TRACE)
341 			&& (current->ptrace & PT_PTRACED))
342 		do_syscall_trace();
343 
344 #if 0
345 	audit_syscall_entry(...);
346 #endif
347 }
348 
349 void do_syscall_trace_leave(struct pt_regs *regs)
350 {
351 	if ((test_thread_flag(TIF_SYSCALL_TRACE))
352 			&& (current->ptrace & PT_PTRACED))
353 		do_syscall_trace();
354 }
355