Rev 3424 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3424 | Rev 3431 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2006 Ondrej Palkovsky |
2 | * Copyright (c) 2006 Ondrej Palkovsky |
3 | * All rights reserved. |
3 | * All rights reserved. |
4 | * |
4 | * |
5 | * Redistribution and use in source and binary forms, with or without |
5 | * Redistribution and use in source and binary forms, with or without |
6 | * modification, are permitted provided that the following conditions |
6 | * modification, are permitted provided that the following conditions |
7 | * are met: |
7 | * are met: |
8 | * |
8 | * |
9 | * - Redistributions of source code must retain the above copyright |
9 | * - Redistributions of source code must retain the above copyright |
10 | * notice, this list of conditions and the following disclaimer. |
10 | * notice, this list of conditions and the following disclaimer. |
11 | * - Redistributions in binary form must reproduce the above copyright |
11 | * - Redistributions in binary form must reproduce the above copyright |
12 | * notice, this list of conditions and the following disclaimer in the |
12 | * notice, this list of conditions and the following disclaimer in the |
13 | * documentation and/or other materials provided with the distribution. |
13 | * documentation and/or other materials provided with the distribution. |
14 | * - The name of the author may not be used to endorse or promote products |
14 | * - The name of the author may not be used to endorse or promote products |
15 | * derived from this software without specific prior written permission. |
15 | * derived from this software without specific prior written permission. |
16 | * |
16 | * |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
17 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
18 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
19 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
20 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
21 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
22 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
23 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
24 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
25 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
26 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | */ |
27 | */ |
28 | 28 | ||
29 | /** @addtogroup amd64debug |
29 | /** @addtogroup amd64debug |
30 | * @{ |
30 | * @{ |
31 | */ |
31 | */ |
32 | /** @file |
32 | /** @file |
33 | */ |
33 | */ |
34 | 34 | ||
35 | #include <arch/debugger.h> |
35 | #include <arch/debugger.h> |
36 | #include <console/kconsole.h> |
36 | #include <console/kconsole.h> |
37 | #include <console/cmd.h> |
37 | #include <console/cmd.h> |
38 | #include <symtab.h> |
38 | #include <symtab.h> |
39 | #include <print.h> |
39 | #include <print.h> |
40 | #include <panic.h> |
40 | #include <panic.h> |
41 | #include <interrupt.h> |
41 | #include <interrupt.h> |
42 | #include <arch/asm.h> |
42 | #include <arch/asm.h> |
43 | #include <arch/cpu.h> |
43 | #include <arch/cpu.h> |
44 | #include <debug.h> |
44 | #include <debug.h> |
45 | #include <func.h> |
45 | #include <func.h> |
46 | #include <smp/ipi.h> |
46 | #include <smp/ipi.h> |
47 | 47 | ||
48 | typedef struct { |
48 | typedef struct { |
49 | uintptr_t address; /**< Breakpoint address */ |
49 | uintptr_t address; /**< Breakpoint address */ |
50 | int flags; /**< Flags regarding breakpoint */ |
50 | int flags; /**< Flags regarding breakpoint */ |
51 | int counter; /**< How many times the exception occured */ |
51 | int counter; /**< How many times the exception occured */ |
52 | } bpinfo_t; |
52 | } bpinfo_t; |
53 | 53 | ||
54 | static bpinfo_t breakpoints[BKPOINTS_MAX]; |
54 | static bpinfo_t breakpoints[BKPOINTS_MAX]; |
55 | SPINLOCK_INITIALIZE(bkpoint_lock); |
55 | SPINLOCK_INITIALIZE(bkpoint_lock); |
56 | 56 | ||
57 | static int cmd_print_breakpoints(cmd_arg_t *argv); |
57 | static int cmd_print_breakpoints(cmd_arg_t *argv); |
58 | static cmd_info_t bkpts_info = { |
58 | static cmd_info_t bkpts_info = { |
59 | .name = "bkpts", |
59 | .name = "bkpts", |
60 | .description = "Print breakpoint table.", |
60 | .description = "Print breakpoint table.", |
61 | .func = cmd_print_breakpoints, |
61 | .func = cmd_print_breakpoints, |
62 | .argc = 0, |
62 | .argc = 0, |
63 | }; |
63 | }; |
64 | 64 | ||
65 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
65 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
66 | 66 | ||
67 | static int cmd_del_breakpoint(cmd_arg_t *argv); |
67 | static int cmd_del_breakpoint(cmd_arg_t *argv); |
68 | static cmd_arg_t del_argv = { |
68 | static cmd_arg_t del_argv = { |
69 | .type = ARG_TYPE_INT |
69 | .type = ARG_TYPE_INT |
70 | }; |
70 | }; |
71 | static cmd_info_t delbkpt_info = { |
71 | static cmd_info_t delbkpt_info = { |
72 | .name = "delbkpt", |
72 | .name = "delbkpt", |
73 | .description = "delbkpt <number> - Delete breakpoint.", |
73 | .description = "delbkpt <number> - Delete breakpoint.", |
74 | .func = cmd_del_breakpoint, |
74 | .func = cmd_del_breakpoint, |
75 | .argc = 1, |
75 | .argc = 1, |
76 | .argv = &del_argv |
76 | .argv = &del_argv |
77 | }; |
77 | }; |
78 | 78 | ||
79 | static int cmd_add_breakpoint(cmd_arg_t *argv); |
79 | static int cmd_add_breakpoint(cmd_arg_t *argv); |
80 | static cmd_arg_t add_argv = { |
80 | static cmd_arg_t add_argv = { |
81 | .type = ARG_TYPE_INT |
81 | .type = ARG_TYPE_INT |
82 | }; |
82 | }; |
83 | static cmd_info_t addbkpt_info = { |
83 | static cmd_info_t addbkpt_info = { |
84 | .name = "addbkpt", |
84 | .name = "addbkpt", |
85 | .description = "addbkpt <&symbol> - new breakpoint.", |
85 | .description = "addbkpt <&symbol> - new breakpoint.", |
86 | .func = cmd_add_breakpoint, |
86 | .func = cmd_add_breakpoint, |
87 | .argc = 1, |
87 | .argc = 1, |
88 | .argv = &add_argv |
88 | .argv = &add_argv |
89 | }; |
89 | }; |
90 | 90 | ||
91 | static cmd_arg_t addw_argv = { |
91 | static cmd_arg_t addw_argv = { |
92 | .type = ARG_TYPE_INT |
92 | .type = ARG_TYPE_INT |
93 | }; |
93 | }; |
94 | static cmd_info_t addwatchp_info = { |
94 | static cmd_info_t addwatchp_info = { |
95 | .name = "addwatchp", |
95 | .name = "addwatchp", |
96 | .description = "addbwatchp <&symbol> - new write watchpoint.", |
96 | .description = "addbwatchp <&symbol> - new write watchpoint.", |
97 | .func = cmd_add_breakpoint, |
97 | .func = cmd_add_breakpoint, |
98 | .argc = 1, |
98 | .argc = 1, |
99 | .argv = &addw_argv |
99 | .argv = &addw_argv |
100 | }; |
100 | }; |
101 | 101 | ||
102 | #endif |
102 | #endif |
103 | 103 | ||
104 | /** Print table of active breakpoints */ |
104 | /** Print table of active breakpoints */ |
105 | int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused))) |
105 | int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused))) |
106 | { |
106 | { |
107 | unsigned int i; |
107 | unsigned int i; |
108 | char *symbol; |
108 | char *symbol; |
109 | 109 | ||
110 | #ifdef __32_BITS__ |
110 | #ifdef __32_BITS__ |
111 | printf("# Count Address In symbol\n"); |
111 | printf("# Count Address In symbol\n"); |
112 | printf("-- ----- ---------- ---------\n"); |
112 | printf("-- ----- ---------- ---------\n"); |
113 | #endif |
113 | #endif |
114 | 114 | ||
115 | #ifdef __64_BITS__ |
115 | #ifdef __64_BITS__ |
116 | printf("# Count Address In symbol\n"); |
116 | printf("# Count Address In symbol\n"); |
117 | printf("-- ----- ------------------ ---------\n"); |
117 | printf("-- ----- ------------------ ---------\n"); |
118 | #endif |
118 | #endif |
119 | 119 | ||
120 | for (i = 0; i < BKPOINTS_MAX; i++) |
120 | for (i = 0; i < BKPOINTS_MAX; i++) |
121 | if (breakpoints[i].address) { |
121 | if (breakpoints[i].address) { |
122 | symbol = get_symtab_entry(breakpoints[i].address); |
122 | symbol = get_symtab_entry(breakpoints[i].address); |
123 | 123 | ||
124 | #ifdef __32_BITS__ |
124 | #ifdef __32_BITS__ |
125 | printf("%-2u %-5d %#10zx %s\n", i, |
125 | printf("%-2u %-5d %#10zx %s\n", i, |
126 | breakpoints[i].counter, breakpoints[i].address, |
126 | breakpoints[i].counter, breakpoints[i].address, |
127 | symbol); |
127 | symbol); |
128 | #endif |
128 | #endif |
129 | 129 | ||
130 | #ifdef __64_BITS__ |
130 | #ifdef __64_BITS__ |
131 | printf("%-2u %-5d %#18zx %s\n", i, |
131 | printf("%-2u %-5d %#18zx %s\n", i, |
132 | breakpoints[i].counter, breakpoints[i].address, |
132 | breakpoints[i].counter, breakpoints[i].address, |
133 | symbol); |
133 | symbol); |
134 | #endif |
134 | #endif |
135 | 135 | ||
136 | } |
136 | } |
137 | return 1; |
137 | return 1; |
138 | } |
138 | } |
139 | 139 | ||
140 | /* Setup DR register according to table */ |
140 | /* Setup DR register according to table */ |
141 | static void setup_dr(int curidx) |
141 | static void setup_dr(int curidx) |
142 | { |
142 | { |
143 | unative_t dr7; |
143 | unative_t dr7; |
144 | bpinfo_t *cur = &breakpoints[curidx]; |
144 | bpinfo_t *cur = &breakpoints[curidx]; |
145 | int flags = breakpoints[curidx].flags; |
145 | int flags = breakpoints[curidx].flags; |
146 | 146 | ||
147 | /* Disable breakpoint in DR7 */ |
147 | /* Disable breakpoint in DR7 */ |
148 | dr7 = read_dr7(); |
148 | dr7 = read_dr7(); |
149 | dr7 &= ~(0x2 << (curidx*2)); |
149 | dr7 &= ~(0x2 << (curidx*2)); |
150 | 150 | ||
151 | if (cur->address) { /* Setup DR register */ |
151 | if (cur->address) { /* Setup DR register */ |
152 | /* Set breakpoint to debug registers */ |
152 | /* Set breakpoint to debug registers */ |
153 | switch (curidx) { |
153 | switch (curidx) { |
154 | case 0: |
154 | case 0: |
155 | write_dr0(cur->address); |
155 | write_dr0(cur->address); |
156 | break; |
156 | break; |
157 | case 1: |
157 | case 1: |
158 | write_dr1(cur->address); |
158 | write_dr1(cur->address); |
159 | break; |
159 | break; |
160 | case 2: |
160 | case 2: |
161 | write_dr2(cur->address); |
161 | write_dr2(cur->address); |
162 | break; |
162 | break; |
163 | case 3: |
163 | case 3: |
164 | write_dr3(cur->address); |
164 | write_dr3(cur->address); |
165 | break; |
165 | break; |
166 | } |
166 | } |
167 | /* Set type to requested breakpoint & length*/ |
167 | /* Set type to requested breakpoint & length*/ |
168 | dr7 &= ~ (0x3 << (16 + 4*curidx)); |
168 | dr7 &= ~ (0x3 << (16 + 4*curidx)); |
169 | dr7 &= ~ (0x3 << (18 + 4*curidx)); |
169 | dr7 &= ~ (0x3 << (18 + 4*curidx)); |
170 | if ((flags & BKPOINT_INSTR)) { |
170 | if ((flags & BKPOINT_INSTR)) { |
171 | ; |
171 | ; |
172 | } else { |
172 | } else { |
173 | 173 | ||
174 | #ifdef __32_BITS__ |
174 | #ifdef __32_BITS__ |
175 | dr7 |= ((unative_t) 0x3) << (18 + 4 * curidx); |
175 | dr7 |= ((unative_t) 0x3) << (18 + 4 * curidx); |
176 | #endif |
176 | #endif |
177 | 177 | ||
178 | #ifdef __64_BITS__ |
178 | #ifdef __64_BITS__ |
179 | dr7 |= ((unative_t) 0x2) << (18 + 4 * curidx); |
179 | dr7 |= ((unative_t) 0x2) << (18 + 4 * curidx); |
180 | #endif |
180 | #endif |
181 | 181 | ||
182 | if ((flags & BKPOINT_WRITE)) |
182 | if ((flags & BKPOINT_WRITE)) |
183 | dr7 |= ((unative_t) 0x1) << (16 + 4 * curidx); |
183 | dr7 |= ((unative_t) 0x1) << (16 + 4 * curidx); |
184 | else if ((flags & BKPOINT_READ_WRITE)) |
184 | else if ((flags & BKPOINT_READ_WRITE)) |
185 | dr7 |= ((unative_t) 0x3) << (16 + 4 * curidx); |
185 | dr7 |= ((unative_t) 0x3) << (16 + 4 * curidx); |
186 | } |
186 | } |
187 | 187 | ||
188 | /* Enable global breakpoint */ |
188 | /* Enable global breakpoint */ |
189 | dr7 |= 0x2 << (curidx * 2); |
189 | dr7 |= 0x2 << (curidx * 2); |
190 | 190 | ||
191 | write_dr7(dr7); |
191 | write_dr7(dr7); |
192 | 192 | ||
193 | } |
193 | } |
194 | } |
194 | } |
195 | 195 | ||
196 | /** Enable hardware breakpoint |
196 | /** Enable hardware breakpoint |
197 | * |
197 | * |
198 | * @param where Address of HW breakpoint |
198 | * @param where Address of HW breakpoint |
199 | * @param flags Type of breakpoint (EXECUTE, WRITE) |
199 | * @param flags Type of breakpoint (EXECUTE, WRITE) |
200 | * @return Debug slot on success, -1 - no available HW breakpoint |
200 | * @return Debug slot on success, -1 - no available HW breakpoint |
201 | */ |
201 | */ |
202 | int breakpoint_add(const void *where, const int flags, int curidx) |
202 | int breakpoint_add(const void *where, const int flags, int curidx) |
203 | { |
203 | { |
204 | ipl_t ipl; |
204 | ipl_t ipl; |
205 | int i; |
205 | int i; |
206 | bpinfo_t *cur; |
206 | bpinfo_t *cur; |
207 | 207 | ||
208 | ASSERT(flags & (BKPOINT_INSTR | BKPOINT_WRITE | BKPOINT_READ_WRITE)); |
208 | ASSERT(flags & (BKPOINT_INSTR | BKPOINT_WRITE | BKPOINT_READ_WRITE)); |
209 | 209 | ||
210 | ipl = interrupts_disable(); |
210 | ipl = interrupts_disable(); |
211 | spinlock_lock(&bkpoint_lock); |
211 | spinlock_lock(&bkpoint_lock); |
212 | 212 | ||
213 | if (curidx == -1) { |
213 | if (curidx == -1) { |
214 | /* Find free space in slots */ |
214 | /* Find free space in slots */ |
215 | for (i = 0; i < BKPOINTS_MAX; i++) |
215 | for (i = 0; i < BKPOINTS_MAX; i++) |
216 | if (!breakpoints[i].address) { |
216 | if (!breakpoints[i].address) { |
217 | curidx = i; |
217 | curidx = i; |
218 | break; |
218 | break; |
219 | } |
219 | } |
220 | if (curidx == -1) { |
220 | if (curidx == -1) { |
221 | /* Too many breakpoints */ |
221 | /* Too many breakpoints */ |
222 | spinlock_unlock(&bkpoint_lock); |
222 | spinlock_unlock(&bkpoint_lock); |
223 | interrupts_restore(ipl); |
223 | interrupts_restore(ipl); |
224 | return -1; |
224 | return -1; |
225 | } |
225 | } |
226 | } |
226 | } |
227 | cur = &breakpoints[curidx]; |
227 | cur = &breakpoints[curidx]; |
228 | 228 | ||
229 | cur->address = (uintptr_t) where; |
229 | cur->address = (uintptr_t) where; |
230 | cur->flags = flags; |
230 | cur->flags = flags; |
231 | cur->counter = 0; |
231 | cur->counter = 0; |
232 | 232 | ||
233 | setup_dr(curidx); |
233 | setup_dr(curidx); |
234 | 234 | ||
235 | spinlock_unlock(&bkpoint_lock); |
235 | spinlock_unlock(&bkpoint_lock); |
236 | interrupts_restore(ipl); |
236 | interrupts_restore(ipl); |
237 | 237 | ||
238 | /* Send IPI */ |
238 | /* Send IPI */ |
239 | #ifdef CONFIG_SMP |
239 | #ifdef CONFIG_SMP |
240 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
240 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
241 | #endif |
241 | #endif |
242 | 242 | ||
243 | return curidx; |
243 | return curidx; |
244 | } |
244 | } |
245 | 245 | ||
246 | #ifdef amd64 |
246 | #ifdef amd64 |
247 | # define getip(x) ((x)->rip) |
247 | # define getip(x) ((x)->rip) |
248 | #else |
248 | #else |
249 | # define getip(x) ((x)->eip) |
249 | # define getip(x) ((x)->eip) |
250 | #endif |
250 | #endif |
251 | 251 | ||
252 | static void handle_exception(int slot, istate_t *istate) |
252 | static void handle_exception(int slot, istate_t *istate) |
253 | { |
253 | { |
254 | ASSERT(breakpoints[slot].address); |
254 | ASSERT(breakpoints[slot].address); |
255 | 255 | ||
256 | /* Handle zero checker */ |
256 | /* Handle zero checker */ |
257 | if (! (breakpoints[slot].flags & BKPOINT_INSTR)) { |
257 | if (! (breakpoints[slot].flags & BKPOINT_INSTR)) { |
258 | if ((breakpoints[slot].flags & BKPOINT_CHECK_ZERO)) { |
258 | if ((breakpoints[slot].flags & BKPOINT_CHECK_ZERO)) { |
259 | if (*((unative_t *) breakpoints[slot].address) != 0) |
259 | if (*((unative_t *) breakpoints[slot].address) != 0) |
260 | return; |
260 | return; |
261 | printf("*** Found ZERO on address %lx (slot %d) ***\n", |
261 | printf("*** Found ZERO on address %lx (slot %d) ***\n", |
262 | breakpoints[slot].address, slot); |
262 | breakpoints[slot].address, slot); |
263 | } else { |
263 | } else { |
264 | printf("Data watchpoint - new data: %lx\n", |
264 | printf("Data watchpoint - new data: %lx\n", |
265 | *((unative_t *) breakpoints[slot].address)); |
265 | *((unative_t *) breakpoints[slot].address)); |
266 | } |
266 | } |
267 | } |
267 | } |
268 | printf("Reached breakpoint %d:%lx(%s)\n", slot, getip(istate), |
268 | printf("Reached breakpoint %d:%lx(%s)\n", slot, getip(istate), |
269 | get_symtab_entry(getip(istate))); |
269 | get_symtab_entry(getip(istate))); |
270 | printf("***Type 'exit' to exit kconsole.\n"); |
270 | printf("***Type 'exit' to exit kconsole.\n"); |
271 | atomic_set(&haltstate,1); |
271 | atomic_set(&haltstate,1); |
272 | kconsole((void *) "debug"); |
272 | kconsole((void *) "debug"); |
273 | atomic_set(&haltstate,0); |
273 | atomic_set(&haltstate,0); |
274 | } |
274 | } |
275 | 275 | ||
276 | void breakpoint_del(int slot) |
276 | void breakpoint_del(int slot) |
277 | { |
277 | { |
278 | bpinfo_t *cur; |
278 | bpinfo_t *cur; |
279 | ipl_t ipl; |
279 | ipl_t ipl; |
280 | 280 | ||
281 | ipl = interrupts_disable(); |
281 | ipl = interrupts_disable(); |
282 | spinlock_lock(&bkpoint_lock); |
282 | spinlock_lock(&bkpoint_lock); |
283 | 283 | ||
284 | cur = &breakpoints[slot]; |
284 | cur = &breakpoints[slot]; |
285 | if (!cur->address) { |
285 | if (!cur->address) { |
286 | spinlock_unlock(&bkpoint_lock); |
286 | spinlock_unlock(&bkpoint_lock); |
287 | interrupts_restore(ipl); |
287 | interrupts_restore(ipl); |
288 | return; |
288 | return; |
289 | } |
289 | } |
290 | 290 | ||
291 | cur->address = NULL; |
291 | cur->address = NULL; |
292 | 292 | ||
293 | setup_dr(slot); |
293 | setup_dr(slot); |
294 | 294 | ||
295 | spinlock_unlock(&bkpoint_lock); |
295 | spinlock_unlock(&bkpoint_lock); |
296 | interrupts_restore(ipl); |
296 | interrupts_restore(ipl); |
297 | #ifdef CONFIG_SMP |
297 | #ifdef CONFIG_SMP |
298 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
298 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
299 | #endif |
299 | #endif |
300 | } |
300 | } |
301 | 301 | ||
302 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
302 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
303 | 303 | ||
304 | /** Remove breakpoint from table */ |
304 | /** Remove breakpoint from table */ |
305 | int cmd_del_breakpoint(cmd_arg_t *argv) |
305 | int cmd_del_breakpoint(cmd_arg_t *argv) |
306 | { |
306 | { |
307 | unative_t bpno = argv->intval; |
307 | unative_t bpno = argv->intval; |
308 | if (bpno > BKPOINTS_MAX) { |
308 | if (bpno > BKPOINTS_MAX) { |
309 | printf("Invalid breakpoint number.\n"); |
309 | printf("Invalid breakpoint number.\n"); |
310 | return 0; |
310 | return 0; |
311 | } |
311 | } |
312 | breakpoint_del(argv->intval); |
312 | breakpoint_del(argv->intval); |
313 | return 1; |
313 | return 1; |
314 | } |
314 | } |
315 | 315 | ||
316 | /** Add new breakpoint to table */ |
316 | /** Add new breakpoint to table */ |
317 | static int cmd_add_breakpoint(cmd_arg_t *argv) |
317 | static int cmd_add_breakpoint(cmd_arg_t *argv) |
318 | { |
318 | { |
319 | int flags; |
319 | int flags; |
320 | int id; |
320 | int id; |
321 | 321 | ||
322 | if (argv == &add_argv) { |
322 | if (argv == &add_argv) { |
323 | flags = BKPOINT_INSTR; |
323 | flags = BKPOINT_INSTR; |
324 | } else { /* addwatchp */ |
324 | } else { /* addwatchp */ |
325 | flags = BKPOINT_WRITE; |
325 | flags = BKPOINT_WRITE; |
326 | } |
326 | } |
327 | printf("Adding breakpoint on address: %p\n", argv->intval); |
327 | printf("Adding breakpoint on address: %p\n", argv->intval); |
328 | id = breakpoint_add((void *)argv->intval, flags, -1); |
328 | id = breakpoint_add((void *)argv->intval, flags, -1); |
329 | if (id < 0) |
329 | if (id < 0) |
330 | printf("Add breakpoint failed.\n"); |
330 | printf("Add breakpoint failed.\n"); |
331 | else |
331 | else |
332 | printf("Added breakpoint %d.\n", id); |
332 | printf("Added breakpoint %d.\n", id); |
333 | 333 | ||
334 | return 1; |
334 | return 1; |
335 | } |
335 | } |
336 | #endif |
336 | #endif |
337 | 337 | ||
338 | static void debug_exception(int n __attribute__((unused)), istate_t *istate) |
338 | static void debug_exception(int n __attribute__((unused)), istate_t *istate) |
339 | { |
339 | { |
340 | unative_t dr6; |
340 | unative_t dr6; |
341 | int i; |
341 | int i; |
342 | 342 | ||
343 | dr6 = read_dr6(); |
343 | dr6 = read_dr6(); |
344 | 344 | ||
- | 345 | #ifdef CONFIG_UDEBUG |
|
345 | if (dr6 & DR6_BS) { |
346 | if (dr6 & DR6_BS) { |
346 | if (THREAD && istate_from_uspace(istate)) { |
347 | if (THREAD && istate_from_uspace(istate)) { |
347 | /* |
348 | /* |
348 | * The userspace thread has TF set and executed |
349 | * The userspace thread has TF set and executed |
349 | * an instruction |
350 | * an instruction |
350 | */ |
351 | */ |
351 | udebug_trap_event(istate->eip); |
352 | udebug_trap_event(istate->eip); |
352 | return; |
353 | return; |
353 | } |
354 | } |
354 | } |
355 | } |
- | 356 | #endif |
|
355 | 357 | ||
356 | /* Set RF to restart the instruction */ |
358 | /* Set RF to restart the instruction */ |
357 | #ifdef amd64 |
359 | #ifdef amd64 |
358 | istate->rflags |= RFLAGS_RF; |
360 | istate->rflags |= RFLAGS_RF; |
359 | #else |
361 | #else |
360 | istate->eflags |= EFLAGS_RF; |
362 | istate->eflags |= EFLAGS_RF; |
361 | #endif |
363 | #endif |
362 | 364 | ||
363 | for (i=0; i < BKPOINTS_MAX; i++) { |
365 | for (i=0; i < BKPOINTS_MAX; i++) { |
364 | if (dr6 & (1 << i)) { |
366 | if (dr6 & (1 << i)) { |
365 | dr6 &= ~ (1 << i); |
367 | dr6 &= ~ (1 << i); |
366 | write_dr6(dr6); |
368 | write_dr6(dr6); |
367 | 369 | ||
368 | handle_exception(i, istate); |
370 | handle_exception(i, istate); |
369 | } |
371 | } |
370 | } |
372 | } |
371 | } |
373 | } |
372 | 374 | ||
373 | #ifdef CONFIG_SMP |
375 | #ifdef CONFIG_SMP |
374 | static void |
376 | static void |
375 | debug_ipi(int n __attribute__((unused)), |
377 | debug_ipi(int n __attribute__((unused)), |
376 | istate_t *istate __attribute__((unused))) |
378 | istate_t *istate __attribute__((unused))) |
377 | { |
379 | { |
378 | int i; |
380 | int i; |
379 | 381 | ||
380 | spinlock_lock(&bkpoint_lock); |
382 | spinlock_lock(&bkpoint_lock); |
381 | for (i = 0; i < BKPOINTS_MAX; i++) |
383 | for (i = 0; i < BKPOINTS_MAX; i++) |
382 | setup_dr(i); |
384 | setup_dr(i); |
383 | spinlock_unlock(&bkpoint_lock); |
385 | spinlock_unlock(&bkpoint_lock); |
384 | } |
386 | } |
385 | #endif |
387 | #endif |
386 | 388 | ||
387 | /** Initialize debugger */ |
389 | /** Initialize debugger */ |
388 | void debugger_init() |
390 | void debugger_init() |
389 | { |
391 | { |
390 | int i; |
392 | int i; |
391 | 393 | ||
392 | for (i = 0; i < BKPOINTS_MAX; i++) |
394 | for (i = 0; i < BKPOINTS_MAX; i++) |
393 | breakpoints[i].address = NULL; |
395 | breakpoints[i].address = NULL; |
394 | 396 | ||
395 | cmd_initialize(&bkpts_info); |
397 | cmd_initialize(&bkpts_info); |
396 | if (!cmd_register(&bkpts_info)) |
398 | if (!cmd_register(&bkpts_info)) |
397 | panic("could not register command %s\n", bkpts_info.name); |
399 | panic("could not register command %s\n", bkpts_info.name); |
398 | 400 | ||
399 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
401 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
400 | cmd_initialize(&delbkpt_info); |
402 | cmd_initialize(&delbkpt_info); |
401 | if (!cmd_register(&delbkpt_info)) |
403 | if (!cmd_register(&delbkpt_info)) |
402 | panic("could not register command %s\n", delbkpt_info.name); |
404 | panic("could not register command %s\n", delbkpt_info.name); |
403 | 405 | ||
404 | cmd_initialize(&addbkpt_info); |
406 | cmd_initialize(&addbkpt_info); |
405 | if (!cmd_register(&addbkpt_info)) |
407 | if (!cmd_register(&addbkpt_info)) |
406 | panic("could not register command %s\n", addbkpt_info.name); |
408 | panic("could not register command %s\n", addbkpt_info.name); |
407 | 409 | ||
408 | cmd_initialize(&addwatchp_info); |
410 | cmd_initialize(&addwatchp_info); |
409 | if (!cmd_register(&addwatchp_info)) |
411 | if (!cmd_register(&addwatchp_info)) |
410 | panic("could not register command %s\n", addwatchp_info.name); |
412 | panic("could not register command %s\n", addwatchp_info.name); |
411 | #endif |
413 | #endif |
412 | 414 | ||
413 | exc_register(VECTOR_DEBUG, "debugger", debug_exception); |
415 | exc_register(VECTOR_DEBUG, "debugger", debug_exception); |
414 | #ifdef CONFIG_SMP |
416 | #ifdef CONFIG_SMP |
415 | exc_register(VECTOR_DEBUG_IPI, "debugger_smp", debug_ipi); |
417 | exc_register(VECTOR_DEBUG_IPI, "debugger_smp", debug_ipi); |
416 | #endif |
418 | #endif |
417 | } |
419 | } |
418 | 420 | ||
419 | /** @} |
421 | /** @} |
420 | */ |
422 | */ |
421 | 423 |