blob: 40aa885314469f40bee2ee2a3ae171becbc0840c [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * Copyright (C) 2002 Jeff Dike (jdike@karaya.com)
3 * Licensed under the GPL
4 */
5
6#include <stdio.h>
7#include <errno.h>
8#include <unistd.h>
9#include <linux/stddef.h>
10#include "ptrace_user.h"
11/* Grr, asm/user.h includes asm/ptrace.h, so has to follow ptrace_user.h */
12#include <asm/user.h>
13#include "kern_util.h"
14#include "sysdep/thread.h"
15#include "user.h"
16#include "os.h"
Paolo 'Blaisorblade' Giarrusso972410b2006-03-31 02:30:21 -080017#include "uml-config.h"
Linus Torvalds1da177e2005-04-16 15:20:36 -070018
19int ptrace_getregs(long pid, unsigned long *regs_out)
20{
21 if (ptrace(PTRACE_GETREGS, pid, 0, regs_out) < 0)
22 return -errno;
23 return 0;
24}
25
26int ptrace_setregs(long pid, unsigned long *regs)
27{
28 if (ptrace(PTRACE_SETREGS, pid, 0, regs) < 0)
29 return -errno;
30 return 0;
31}
32
33int ptrace_getfpregs(long pid, unsigned long *regs)
34{
35 if (ptrace(PTRACE_GETFPREGS, pid, 0, regs) < 0)
36 return -errno;
37 return 0;
38}
39
40int ptrace_setfpregs(long pid, unsigned long *regs)
41{
42 if (ptrace(PTRACE_SETFPREGS, pid, 0, regs) < 0)
43 return -errno;
44 return 0;
45}
46
Paolo 'Blaisorblade' Giarrusso972410b2006-03-31 02:30:21 -080047/* All the below stuff is of interest for TT mode only */
Linus Torvalds1da177e2005-04-16 15:20:36 -070048static void write_debugregs(int pid, unsigned long *regs)
49{
50 struct user *dummy;
51 int nregs, i;
52
53 dummy = NULL;
54 nregs = sizeof(dummy->u_debugreg)/sizeof(dummy->u_debugreg[0]);
55 for(i = 0; i < nregs; i++){
56 if((i == 4) || (i == 5)) continue;
57 if(ptrace(PTRACE_POKEUSR, pid, &dummy->u_debugreg[i],
58 regs[i]) < 0)
59 printk("write_debugregs - ptrace failed on "
Paolo 'Blaisorblade' Giarrusso802e3072006-04-10 22:53:32 -070060 "register %d, value = 0x%lx, errno = %d\n", i,
Linus Torvalds1da177e2005-04-16 15:20:36 -070061 regs[i], errno);
62 }
63}
64
65static void read_debugregs(int pid, unsigned long *regs)
66{
67 struct user *dummy;
68 int nregs, i;
69
70 dummy = NULL;
71 nregs = sizeof(dummy->u_debugreg)/sizeof(dummy->u_debugreg[0]);
72 for(i = 0; i < nregs; i++){
73 regs[i] = ptrace(PTRACE_PEEKUSR, pid,
74 &dummy->u_debugreg[i], 0);
75 }
76}
77
78/* Accessed only by the tracing thread */
79static unsigned long kernel_debugregs[8] = { [ 0 ... 7 ] = 0 };
Linus Torvalds1da177e2005-04-16 15:20:36 -070080
81void arch_enter_kernel(void *task, int pid)
82{
83 read_debugregs(pid, TASK_DEBUGREGS(task));
84 write_debugregs(pid, kernel_debugregs);
85}
86
87void arch_leave_kernel(void *task, int pid)
88{
89 read_debugregs(pid, kernel_debugregs);
90 write_debugregs(pid, TASK_DEBUGREGS(task));
91}
92
Paolo 'Blaisorblade' Giarrusso972410b2006-03-31 02:30:21 -080093#ifdef UML_CONFIG_PT_PROXY
94/* Accessed only by the tracing thread */
95static int debugregs_seq;
96
97/* Only called by the ptrace proxy */
Linus Torvalds1da177e2005-04-16 15:20:36 -070098void ptrace_pokeuser(unsigned long addr, unsigned long data)
99{
100 if((addr < offsetof(struct user, u_debugreg[0])) ||
101 (addr > offsetof(struct user, u_debugreg[7])))
102 return;
103 addr -= offsetof(struct user, u_debugreg[0]);
104 addr = addr >> 2;
105 if(kernel_debugregs[addr] == data) return;
106
107 kernel_debugregs[addr] = data;
108 debugregs_seq++;
109}
110
111static void update_debugregs_cb(void *arg)
112{
113 int pid = *((int *) arg);
114
115 write_debugregs(pid, kernel_debugregs);
116}
117
Paolo 'Blaisorblade' Giarrusso972410b2006-03-31 02:30:21 -0800118/* Optimized out in its header when not defined */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119void update_debugregs(int seq)
120{
121 int me;
122
123 if(seq == debugregs_seq) return;
124
125 me = os_getpid();
126 initial_thread_cb(update_debugregs_cb, &me);
127}
Paolo 'Blaisorblade' Giarrusso972410b2006-03-31 02:30:21 -0800128#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129
130/*
131 * Overrides for Emacs so that we follow Linus's tabbing style.
132 * Emacs will notice this stuff at the end of the file and automatically
133 * adjust the settings for this buffer only. This must remain at the end
134 * of the file.
135 * ---------------------------------------------------------------------------
136 * Local variables:
137 * c-file-style: "linux"
138 * End:
139 */