patch-2.6.6-vs1.9.0
[linux-2.6.git] / arch / sparc / kernel / ptrace.c
1 /* ptrace.c: Sparc process tracing support.
2  *
3  * Copyright (C) 1996 David S. Miller (davem@caipfs.rutgers.edu)
4  *
5  * Based upon code written by Ross Biro, Linus Torvalds, Bob Manson,
6  * and David Mosberger.
7  *
8  * Added Linux support -miguel (weird, eh?, the orignal code was meant
9  * to emulate SunOS).
10  */
11
12 #include <linux/kernel.h>
13 #include <linux/sched.h>
14 #include <linux/mm.h>
15 #include <linux/errno.h>
16 #include <linux/ptrace.h>
17 #include <linux/user.h>
18 #include <linux/smp.h>
19 #include <linux/smp_lock.h>
20 #include <linux/security.h>
21
22 #include <asm/pgtable.h>
23 #include <asm/system.h>
24 #include <asm/uaccess.h>
25
26 #define MAGIC_CONSTANT 0x80000000
27
28
29 /* Returning from ptrace is a bit tricky because the syscall return
30  * low level code assumes any value returned which is negative and
31  * is a valid errno will mean setting the condition codes to indicate
32  * an error return.  This doesn't work, so we have this hook.
33  */
34 static inline void pt_error_return(struct pt_regs *regs, unsigned long error)
35 {
36         regs->u_regs[UREG_I0] = error;
37         regs->psr |= PSR_C;
38         regs->pc = regs->npc;
39         regs->npc += 4;
40 }
41
42 static inline void pt_succ_return(struct pt_regs *regs, unsigned long value)
43 {
44         regs->u_regs[UREG_I0] = value;
45         regs->psr &= ~PSR_C;
46         regs->pc = regs->npc;
47         regs->npc += 4;
48 }
49
50 static void
51 pt_succ_return_linux(struct pt_regs *regs, unsigned long value, long *addr)
52 {
53         if(put_user(value, addr))
54                 return pt_error_return(regs, EFAULT);
55         regs->u_regs[UREG_I0] = 0;
56         regs->psr &= ~PSR_C;
57         regs->pc = regs->npc;
58         regs->npc += 4;
59 }
60
61 static void
62 pt_os_succ_return (struct pt_regs *regs, unsigned long val, long *addr)
63 {
64         if (current->personality == PER_SUNOS)
65                 pt_succ_return (regs, val);
66         else
67                 pt_succ_return_linux (regs, val, addr);
68 }
69
70 /* Fuck me gently with a chainsaw... */
71 static inline void read_sunos_user(struct pt_regs *regs, unsigned long offset,
72                                    struct task_struct *tsk, long *addr)
73 {
74         struct pt_regs *cregs = tsk->thread.kregs;
75         struct thread_info *t = tsk->thread_info;
76         int v;
77         
78         if(offset >= 1024)
79                 offset -= 1024; /* whee... */
80         if(offset & ((sizeof(unsigned long) - 1))) {
81                 pt_error_return(regs, EIO);
82                 return;
83         }
84         if(offset >= 16 && offset < 784) {
85                 offset -= 16; offset >>= 2;
86                 pt_os_succ_return(regs, *(((unsigned long *)(&t->reg_window[0]))+offset), addr);
87                 return;
88         }
89         if(offset >= 784 && offset < 832) {
90                 offset -= 784; offset >>= 2;
91                 pt_os_succ_return(regs, *(((unsigned long *)(&t->rwbuf_stkptrs[0]))+offset), addr);
92                 return;
93         }
94         switch(offset) {
95         case 0:
96                 v = t->ksp;
97                 break;
98         case 4:
99                 v = t->kpc;
100                 break;
101         case 8:
102                 v = t->kpsr;
103                 break;
104         case 12:
105                 v = t->uwinmask;
106                 break;
107         case 832:
108                 v = t->w_saved;
109                 break;
110         case 896:
111                 v = cregs->u_regs[UREG_I0];
112                 break;
113         case 900:
114                 v = cregs->u_regs[UREG_I1];
115                 break;
116         case 904:
117                 v = cregs->u_regs[UREG_I2];
118                 break;
119         case 908:
120                 v = cregs->u_regs[UREG_I3];
121                 break;
122         case 912:
123                 v = cregs->u_regs[UREG_I4];
124                 break;
125         case 916:
126                 v = cregs->u_regs[UREG_I5];
127                 break;
128         case 920:
129                 v = cregs->u_regs[UREG_I6];
130                 break;
131         case 924:
132                 if(tsk->thread.flags & MAGIC_CONSTANT)
133                         v = cregs->u_regs[UREG_G1];
134                 else
135                         v = 0;
136                 break;
137         case 940:
138                 v = cregs->u_regs[UREG_I0];
139                 break;
140         case 944:
141                 v = cregs->u_regs[UREG_I1];
142                 break;
143
144         case 948:
145                 /* Isn't binary compatibility _fun_??? */
146                 if(cregs->psr & PSR_C)
147                         v = cregs->u_regs[UREG_I0] << 24;
148                 else
149                         v = 0;
150                 break;
151
152                 /* Rest of them are completely unsupported. */
153         default:
154                 printk("%s [%d]: Wants to read user offset %ld\n",
155                        current->comm, current->pid, offset);
156                 pt_error_return(regs, EIO);
157                 return;
158         }
159         if (current->personality == PER_SUNOS)
160                 pt_succ_return (regs, v);
161         else
162                 pt_succ_return_linux (regs, v, addr);
163         return;
164 }
165
166 static inline void write_sunos_user(struct pt_regs *regs, unsigned long offset,
167                                     struct task_struct *tsk)
168 {
169         struct pt_regs *cregs = tsk->thread.kregs;
170         struct thread_info *t = tsk->thread_info;
171         unsigned long value = regs->u_regs[UREG_I3];
172
173         if(offset >= 1024)
174                 offset -= 1024; /* whee... */
175         if(offset & ((sizeof(unsigned long) - 1)))
176                 goto failure;
177         if(offset >= 16 && offset < 784) {
178                 offset -= 16; offset >>= 2;
179                 *(((unsigned long *)(&t->reg_window[0]))+offset) = value;
180                 goto success;
181         }
182         if(offset >= 784 && offset < 832) {
183                 offset -= 784; offset >>= 2;
184                 *(((unsigned long *)(&t->rwbuf_stkptrs[0]))+offset) = value;
185                 goto success;
186         }
187         switch(offset) {
188         case 896:
189                 cregs->u_regs[UREG_I0] = value;
190                 break;
191         case 900:
192                 cregs->u_regs[UREG_I1] = value;
193                 break;
194         case 904:
195                 cregs->u_regs[UREG_I2] = value;
196                 break;
197         case 908:
198                 cregs->u_regs[UREG_I3] = value;
199                 break;
200         case 912:
201                 cregs->u_regs[UREG_I4] = value;
202                 break;
203         case 916:
204                 cregs->u_regs[UREG_I5] = value;
205                 break;
206         case 920:
207                 cregs->u_regs[UREG_I6] = value;
208                 break;
209         case 924:
210                 cregs->u_regs[UREG_I7] = value;
211                 break;
212         case 940:
213                 cregs->u_regs[UREG_I0] = value;
214                 break;
215         case 944:
216                 cregs->u_regs[UREG_I1] = value;
217                 break;
218
219                 /* Rest of them are completely unsupported or "no-touch". */
220         default:
221                 printk("%s [%d]: Wants to write user offset %ld\n",
222                        current->comm, current->pid, offset);
223                 goto failure;
224         }
225 success:
226         pt_succ_return(regs, 0);
227         return;
228 failure:
229         pt_error_return(regs, EIO);
230         return;
231 }
232
233 /* #define ALLOW_INIT_TRACING */
234 /* #define DEBUG_PTRACE */
235
236 #ifdef DEBUG_PTRACE
237 char *pt_rq [] = {
238         /* 0  */ "TRACEME", "PEEKTEXT", "PEEKDATA", "PEEKUSR",
239         /* 4  */ "POKETEXT", "POKEDATA", "POKEUSR", "CONT",
240         /* 8  */ "KILL", "SINGLESTEP", "SUNATTACH", "SUNDETACH",
241         /* 12 */ "GETREGS", "SETREGS", "GETFPREGS", "SETFPREGS",
242         /* 16 */ "READDATA", "WRITEDATA", "READTEXT", "WRITETEXT",
243         /* 20 */ "GETFPAREGS", "SETFPAREGS", "unknown", "unknown",
244         /* 24 */ "SYSCALL", ""
245 };
246 #endif
247
248 /*
249  * Called by kernel/ptrace.c when detaching..
250  *
251  * Make sure single step bits etc are not set.
252  */
253 void ptrace_disable(struct task_struct *child)
254 {
255         /* nothing to do */
256 }
257
258 asmlinkage void do_ptrace(struct pt_regs *regs)
259 {
260         unsigned long request = regs->u_regs[UREG_I0];
261         unsigned long pid = regs->u_regs[UREG_I1];
262         unsigned long addr = regs->u_regs[UREG_I2];
263         unsigned long data = regs->u_regs[UREG_I3];
264         unsigned long addr2 = regs->u_regs[UREG_I4];
265         struct task_struct *child;
266         int ret;
267
268         lock_kernel();
269 #ifdef DEBUG_PTRACE
270         {
271                 char *s;
272
273                 if ((request >= 0) && (request <= 24))
274                         s = pt_rq [request];
275                 else
276                         s = "unknown";
277
278                 if (request == PTRACE_POKEDATA && data == 0x91d02001){
279                         printk ("do_ptrace: breakpoint pid=%d, addr=%08lx addr2=%08lx\n",
280                                 pid, addr, addr2);
281                 } else 
282                         printk("do_ptrace: rq=%s(%d) pid=%d addr=%08lx data=%08lx addr2=%08lx\n",
283                                s, (int) request, (int) pid, addr, data, addr2);
284         }
285 #endif
286         if(request == PTRACE_TRACEME) {
287                 int ret;
288
289                 /* are we already being traced? */
290                 if (current->ptrace & PT_PTRACED) {
291                         pt_error_return(regs, EPERM);
292                         goto out;
293                 }
294                 ret = security_ptrace(current->parent, current);
295                 if (ret) {
296                         pt_error_return(regs, -ret);
297                         goto out;
298                 }
299
300                 /* set the ptrace bit in the process flags. */
301                 current->ptrace |= PT_PTRACED;
302                 pt_succ_return(regs, 0);
303                 goto out;
304         }
305 #ifndef ALLOW_INIT_TRACING
306         if(pid == 1) {
307                 /* Can't dork with init. */
308                 pt_error_return(regs, EPERM);
309                 goto out;
310         }
311 #endif
312         read_lock(&tasklist_lock);
313         child = find_task_by_pid(pid);
314         if (child)
315                 get_task_struct(child);
316         read_unlock(&tasklist_lock);
317
318         if (!child) {
319                 pt_error_return(regs, ESRCH);
320                 goto out;
321         }
322         if (!vx_check(vx_task_xid(child), VX_WATCH|VX_IDENT)) {
323                 pt_error_return(regs, ESRCH);
324                 goto out_tsk;
325         }
326
327         if ((current->personality == PER_SUNOS && request == PTRACE_SUNATTACH)
328             || (current->personality != PER_SUNOS && request == PTRACE_ATTACH)) {
329                 if (ptrace_attach(child)) {
330                         pt_error_return(regs, EPERM);
331                         goto out_tsk;
332                 }
333                 pt_succ_return(regs, 0);
334                 goto out_tsk;
335         }
336
337         ret = ptrace_check_attach(child, request == PTRACE_KILL);
338         if (ret < 0) {
339                 pt_error_return(regs, -ret);
340                 goto out_tsk;
341         }
342
343         switch(request) {
344         case PTRACE_PEEKTEXT: /* read word at location addr. */ 
345         case PTRACE_PEEKDATA: {
346                 unsigned long tmp;
347
348                 if (access_process_vm(child, addr,
349                                       &tmp, sizeof(tmp), 0) == sizeof(tmp))
350                         pt_os_succ_return(regs, tmp, (long *)data);
351                 else
352                         pt_error_return(regs, EIO);
353                 goto out_tsk;
354         }
355
356         case PTRACE_PEEKUSR:
357                 read_sunos_user(regs, addr, child, (long *) data);
358                 goto out_tsk;
359
360         case PTRACE_POKEUSR:
361                 write_sunos_user(regs, addr, child);
362                 goto out_tsk;
363
364         case PTRACE_POKETEXT: /* write the word at location addr. */
365         case PTRACE_POKEDATA: {
366                 if (access_process_vm(child, addr,
367                                       &data, sizeof(data), 1) == sizeof(data))
368                         pt_succ_return(regs, 0);
369                 else
370                         pt_error_return(regs, EIO);
371                 goto out_tsk;
372         }
373
374         case PTRACE_GETREGS: {
375                 struct pt_regs *pregs = (struct pt_regs *) addr;
376                 struct pt_regs *cregs = child->thread.kregs;
377                 int rval;
378
379                 rval = verify_area(VERIFY_WRITE, pregs, sizeof(struct pt_regs));
380                 if(rval) {
381                         pt_error_return(regs, -rval);
382                         goto out_tsk;
383                 }
384                 __put_user(cregs->psr, (&pregs->psr));
385                 __put_user(cregs->pc, (&pregs->pc));
386                 __put_user(cregs->npc, (&pregs->npc));
387                 __put_user(cregs->y, (&pregs->y));
388                 for(rval = 1; rval < 16; rval++)
389                         __put_user(cregs->u_regs[rval], (&pregs->u_regs[rval - 1]));
390                 pt_succ_return(regs, 0);
391 #ifdef DEBUG_PTRACE
392                 printk ("PC=%x nPC=%x o7=%x\n", cregs->pc, cregs->npc, cregs->u_regs [15]);
393 #endif
394                 goto out_tsk;
395         }
396
397         case PTRACE_SETREGS: {
398                 struct pt_regs *pregs = (struct pt_regs *) addr;
399                 struct pt_regs *cregs = child->thread.kregs;
400                 unsigned long psr, pc, npc, y;
401                 int i;
402
403                 /* Must be careful, tracing process can only set certain
404                  * bits in the psr.
405                  */
406                 i = verify_area(VERIFY_READ, pregs, sizeof(struct pt_regs));
407                 if(i) {
408                         pt_error_return(regs, -i);
409                         goto out_tsk;
410                 }
411                 __get_user(psr, (&pregs->psr));
412                 __get_user(pc, (&pregs->pc));
413                 __get_user(npc, (&pregs->npc));
414                 __get_user(y, (&pregs->y));
415                 psr &= PSR_ICC;
416                 cregs->psr &= ~PSR_ICC;
417                 cregs->psr |= psr;
418                 if(!((pc | npc) & 3)) {
419                         cregs->pc = pc;
420                         cregs->npc =npc;
421                 }
422                 cregs->y = y;
423                 for(i = 1; i < 16; i++)
424                         __get_user(cregs->u_regs[i], (&pregs->u_regs[i-1]));
425                 pt_succ_return(regs, 0);
426                 goto out_tsk;
427         }
428
429         case PTRACE_GETFPREGS: {
430                 struct fps {
431                         unsigned long regs[32];
432                         unsigned long fsr;
433                         unsigned long flags;
434                         unsigned long extra;
435                         unsigned long fpqd;
436                         struct fq {
437                                 unsigned long *insnaddr;
438                                 unsigned long insn;
439                         } fpq[16];
440                 } *fps = (struct fps *) addr;
441                 int i;
442
443                 i = verify_area(VERIFY_WRITE, fps, sizeof(struct fps));
444                 if(i) {
445                         pt_error_return(regs, -i);
446                         goto out_tsk;
447                 }
448                 for(i = 0; i < 32; i++)
449                         __put_user(child->thread.float_regs[i], (&fps->regs[i]));
450                 __put_user(child->thread.fsr, (&fps->fsr));
451                 __put_user(child->thread.fpqdepth, (&fps->fpqd));
452                 __put_user(0, (&fps->flags));
453                 __put_user(0, (&fps->extra));
454                 for(i = 0; i < 16; i++) {
455                         __put_user(child->thread.fpqueue[i].insn_addr,
456                                    (&fps->fpq[i].insnaddr));
457                         __put_user(child->thread.fpqueue[i].insn, (&fps->fpq[i].insn));
458                 }
459                 pt_succ_return(regs, 0);
460                 goto out_tsk;
461         }
462
463         case PTRACE_SETFPREGS: {
464                 struct fps {
465                         unsigned long regs[32];
466                         unsigned long fsr;
467                         unsigned long flags;
468                         unsigned long extra;
469                         unsigned long fpqd;
470                         struct fq {
471                                 unsigned long *insnaddr;
472                                 unsigned long insn;
473                         } fpq[16];
474                 } *fps = (struct fps *) addr;
475                 int i;
476
477                 i = verify_area(VERIFY_READ, fps, sizeof(struct fps));
478                 if(i) {
479                         pt_error_return(regs, -i);
480                         goto out_tsk;
481                 }
482                 copy_from_user(&child->thread.float_regs[0], &fps->regs[0], (32 * sizeof(unsigned long)));
483                 __get_user(child->thread.fsr, (&fps->fsr));
484                 __get_user(child->thread.fpqdepth, (&fps->fpqd));
485                 for(i = 0; i < 16; i++) {
486                         __get_user(child->thread.fpqueue[i].insn_addr,
487                                    (&fps->fpq[i].insnaddr));
488                         __get_user(child->thread.fpqueue[i].insn, (&fps->fpq[i].insn));
489                 }
490                 pt_succ_return(regs, 0);
491                 goto out_tsk;
492         }
493
494         case PTRACE_READTEXT:
495         case PTRACE_READDATA: {
496                 int res = ptrace_readdata(child, addr, (void *) addr2, data);
497
498                 if (res == data) {
499                         pt_succ_return(regs, 0);
500                         goto out_tsk;
501                 }
502                 /* Partial read is an IO failure */
503                 if (res >= 0)
504                         res = -EIO;
505                 pt_error_return(regs, -res);
506                 goto out_tsk;
507         }
508
509         case PTRACE_WRITETEXT:
510         case PTRACE_WRITEDATA: {
511                 int res = ptrace_writedata(child, (void *) addr2, addr, data);
512
513                 if (res == data) {
514                         pt_succ_return(regs, 0);
515                         goto out_tsk;
516                 }
517                 /* Partial write is an IO failure */
518                 if (res >= 0)
519                         res = -EIO;
520                 pt_error_return(regs, -res);
521                 goto out_tsk;
522         }
523
524         case PTRACE_SYSCALL: /* continue and stop at (return from) syscall */
525                 addr = 1;
526
527         case PTRACE_CONT: { /* restart after signal. */
528                 if (data > _NSIG) {
529                         pt_error_return(regs, EIO);
530                         goto out_tsk;
531                 }
532                 if (addr != 1) {
533                         if (addr & 3) {
534                                 pt_error_return(regs, EINVAL);
535                                 goto out_tsk;
536                         }
537 #ifdef DEBUG_PTRACE
538                         printk ("Original: %08lx %08lx\n", child->thread.kregs->pc, child->thread.kregs->npc);
539                         printk ("Continuing with %08lx %08lx\n", addr, addr+4);
540 #endif
541                         child->thread.kregs->pc = addr;
542                         child->thread.kregs->npc = addr + 4;
543                 }
544
545                 if (request == PTRACE_SYSCALL)
546                         set_tsk_thread_flag(child, TIF_SYSCALL_TRACE);
547                 else
548                         clear_tsk_thread_flag(child, TIF_SYSCALL_TRACE);
549
550                 child->exit_code = data;
551 #ifdef DEBUG_PTRACE
552                 printk("CONT: %s [%d]: set exit_code = %x %lx %lx\n",
553                         child->comm, child->pid, child->exit_code,
554                         child->thread.kregs->pc,
555                         child->thread.kregs->npc);
556 #endif
557                 wake_up_process(child);
558                 pt_succ_return(regs, 0);
559                 goto out_tsk;
560         }
561
562 /*
563  * make the child exit.  Best I can do is send it a sigkill. 
564  * perhaps it should be put in the status that it wants to 
565  * exit.
566  */
567         case PTRACE_KILL: {
568                 if (child->state == TASK_ZOMBIE) {      /* already dead */
569                         pt_succ_return(regs, 0);
570                         goto out_tsk;
571                 }
572                 wake_up_process(child);
573                 child->exit_code = SIGKILL;
574                 pt_succ_return(regs, 0);
575                 goto out_tsk;
576         }
577
578         case PTRACE_SUNDETACH: { /* detach a process that was attached. */
579                 int err = ptrace_detach(child, data);
580                 if (err) {
581                         pt_error_return(regs, EIO);
582                         goto out_tsk;
583                 }
584                 pt_succ_return(regs, 0);
585                 goto out_tsk;
586         }
587
588         /* PTRACE_DUMPCORE unsupported... */
589
590         default: {
591                 int err = ptrace_request(child, request, addr, data);
592                 if (err)
593                         pt_error_return(regs, -err);
594                 else
595                         pt_succ_return(regs, 0);
596                 goto out_tsk;
597         }
598         }
599 out_tsk:
600         if (child)
601                 put_task_struct(child);
602 out:
603         unlock_kernel();
604 }
605
606 asmlinkage void syscall_trace(void)
607 {
608 #ifdef DEBUG_PTRACE
609         printk("%s [%d]: syscall_trace\n", current->comm, current->pid);
610 #endif
611         if (!test_thread_flag(TIF_SYSCALL_TRACE))
612                 return;
613         if (!(current->ptrace & PT_PTRACED))
614                 return;
615         current->exit_code = SIGTRAP | ((current->ptrace & PT_TRACESYSGOOD)
616                                         ? 0x80 : 0);
617         current->state = TASK_STOPPED;
618         current->thread.flags ^= MAGIC_CONSTANT;
619         notify_parent(current, SIGCHLD);
620         schedule();
621         /*
622          * this isn't the same as continuing with a signal, but it will do
623          * for normal use.  strace only continues with a signal if the
624          * stopping signal is not SIGTRAP.  -brl
625          */
626 #ifdef DEBUG_PTRACE
627         printk("%s [%d]: syscall_trace exit= %x\n", current->comm,
628                 current->pid, current->exit_code);
629 #endif
630         if (current->exit_code) {
631                 send_sig (current->exit_code, current, 1);
632                 current->exit_code = 0;
633         }
634 }