Rev 3022 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3022 | Rev 4055 | ||
---|---|---|---|
Line 52... | Line 52... | ||
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 | #ifdef CONFIG_KCONSOLE |
|
- | 58 | ||
57 | static int cmd_print_breakpoints(cmd_arg_t *argv); |
59 | static int cmd_print_breakpoints(cmd_arg_t *argv); |
58 | static cmd_info_t bkpts_info = { |
60 | static cmd_info_t bkpts_info = { |
59 | .name = "bkpts", |
61 | .name = "bkpts", |
60 | .description = "Print breakpoint table.", |
62 | .description = "Print breakpoint table.", |
61 | .func = cmd_print_breakpoints, |
63 | .func = cmd_print_breakpoints, |
62 | .argc = 0, |
64 | .argc = 0, |
63 | }; |
65 | }; |
64 | 66 | ||
65 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
- | |
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 = { |
Line 97... | Line 97... | ||
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 |
- | |
103 | - | ||
104 | /** Print table of active breakpoints */ |
- | |
105 | int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused))) |
- | |
106 | { |
- | |
107 | unsigned int i; |
- | |
108 | char *symbol; |
- | |
109 | - | ||
110 | if (sizeof(void *) == 4) { |
- | |
111 | printf("# Count Address In symbol\n"); |
- | |
112 | printf("-- ----- ---------- ---------\n"); |
- | |
113 | } else { |
- | |
114 | printf("# Count Address In symbol\n"); |
- | |
115 | printf("-- ----- ------------------ ---------\n"); |
- | |
116 | } |
- | |
117 | - | ||
118 | for (i = 0; i < BKPOINTS_MAX; i++) |
- | |
119 | if (breakpoints[i].address) { |
- | |
120 | symbol = get_symtab_entry(breakpoints[i].address); |
- | |
121 | - | ||
122 | if (sizeof(void *) == 4) |
102 | #endif /* CONFIG_KCONSOLE */ |
123 | printf("%-2u %-5d %#10zx %s\n", i, breakpoints[i].counter, |
- | |
124 | breakpoints[i].address, symbol); |
- | |
125 | else |
- | |
126 | printf("%-2u %-5d %#18zx %s\n", i, breakpoints[i].counter, |
- | |
127 | breakpoints[i].address, symbol); |
- | |
128 | } |
- | |
129 | return 1; |
- | |
130 | } |
- | |
131 | 103 | ||
132 | /* Setup DR register according to table */ |
104 | /* Setup DR register according to table */ |
133 | static void setup_dr(int curidx) |
105 | static void setup_dr(int curidx) |
134 | { |
106 | { |
135 | unative_t dr7; |
107 | unative_t dr7; |
Line 160... | Line 132... | ||
160 | dr7 &= ~ (0x3 << (16 + 4*curidx)); |
132 | dr7 &= ~ (0x3 << (16 + 4*curidx)); |
161 | dr7 &= ~ (0x3 << (18 + 4*curidx)); |
133 | dr7 &= ~ (0x3 << (18 + 4*curidx)); |
162 | if ((flags & BKPOINT_INSTR)) { |
134 | if ((flags & BKPOINT_INSTR)) { |
163 | ; |
135 | ; |
164 | } else { |
136 | } else { |
- | 137 | ||
165 | if (sizeof(int) == 4) |
138 | #ifdef __32_BITS__ |
166 | dr7 |= ((unative_t) 0x3) << (18 + 4*curidx); |
139 | dr7 |= ((unative_t) 0x3) << (18 + 4 * curidx); |
- | 140 | #endif |
|
- | 141 | ||
167 | else /* 8 */ |
142 | #ifdef __64_BITS__ |
168 | dr7 |= ((unative_t) 0x2) << (18 + 4*curidx); |
143 | dr7 |= ((unative_t) 0x2) << (18 + 4 * curidx); |
- | 144 | #endif |
|
169 | 145 | ||
170 | if ((flags & BKPOINT_WRITE)) |
146 | if ((flags & BKPOINT_WRITE)) |
171 | dr7 |= ((unative_t) 0x1) << (16 + 4*curidx); |
147 | dr7 |= ((unative_t) 0x1) << (16 + 4 * curidx); |
172 | else if ((flags & BKPOINT_READ_WRITE)) |
148 | else if ((flags & BKPOINT_READ_WRITE)) |
173 | dr7 |= ((unative_t) 0x3) << (16 + 4*curidx); |
149 | dr7 |= ((unative_t) 0x3) << (16 + 4 * curidx); |
174 | } |
150 | } |
175 | 151 | ||
176 | /* Enable global breakpoint */ |
152 | /* Enable global breakpoint */ |
177 | dr7 |= 0x2 << (curidx*2); |
153 | dr7 |= 0x2 << (curidx * 2); |
178 | 154 | ||
179 | write_dr7(dr7); |
155 | write_dr7(dr7); |
180 | 156 | ||
181 | } |
157 | } |
182 | } |
158 | } |
Line 223... | Line 199... | ||
223 | spinlock_unlock(&bkpoint_lock); |
199 | spinlock_unlock(&bkpoint_lock); |
224 | interrupts_restore(ipl); |
200 | interrupts_restore(ipl); |
225 | 201 | ||
226 | /* Send IPI */ |
202 | /* Send IPI */ |
227 | #ifdef CONFIG_SMP |
203 | #ifdef CONFIG_SMP |
228 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
204 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
229 | #endif |
205 | #endif |
230 | 206 | ||
231 | return curidx; |
207 | return curidx; |
232 | } |
208 | } |
233 | 209 | ||
234 | #ifdef amd64 |
210 | #ifdef __64_BITS__ |
235 | # define getip(x) ((x)->rip) |
211 | #define getip(x) ((x)->rip) |
236 | #else |
212 | #else |
237 | # define getip(x) ((x)->eip) |
213 | #define getip(x) ((x)->eip) |
238 | #endif |
214 | #endif |
239 | 215 | ||
240 | static void handle_exception(int slot, istate_t *istate) |
216 | static void handle_exception(int slot, istate_t *istate) |
241 | { |
217 | { |
242 | ASSERT(breakpoints[slot].address); |
218 | ASSERT(breakpoints[slot].address); |
Line 244... | Line 220... | ||
244 | /* Handle zero checker */ |
220 | /* Handle zero checker */ |
245 | if (! (breakpoints[slot].flags & BKPOINT_INSTR)) { |
221 | if (! (breakpoints[slot].flags & BKPOINT_INSTR)) { |
246 | if ((breakpoints[slot].flags & BKPOINT_CHECK_ZERO)) { |
222 | if ((breakpoints[slot].flags & BKPOINT_CHECK_ZERO)) { |
247 | if (*((unative_t *) breakpoints[slot].address) != 0) |
223 | if (*((unative_t *) breakpoints[slot].address) != 0) |
248 | return; |
224 | return; |
249 | printf("**** Found ZERO on address %lx (slot %d) ****\n", |
225 | printf("*** Found ZERO on address %lx (slot %d) ***\n", |
250 | breakpoints[slot].address, slot); |
226 | breakpoints[slot].address, slot); |
251 | } else { |
227 | } else { |
252 | printf("Data watchpoint - new data: %lx\n", |
228 | printf("Data watchpoint - new data: %lx\n", |
253 | *((unative_t *) breakpoints[slot].address)); |
229 | *((unative_t *) breakpoints[slot].address)); |
254 | } |
230 | } |
255 | } |
231 | } |
256 | printf("Reached breakpoint %d:%lx(%s)\n", slot, getip(istate), |
232 | printf("Reached breakpoint %d:%lx(%s)\n", slot, getip(istate), |
257 | get_symtab_entry(getip(istate))); |
233 | get_symtab_entry(getip(istate))); |
- | 234 | ||
258 | printf("***Type 'exit' to exit kconsole.\n"); |
235 | #ifdef CONFIG_KCONSOLE |
259 | atomic_set(&haltstate,1); |
236 | atomic_set(&haltstate, 1); |
260 | kconsole((void *) "debug"); |
237 | kconsole("debug", "Debug console ready (type 'exit' to continue)\n", false); |
261 | atomic_set(&haltstate,0); |
238 | atomic_set(&haltstate, 0); |
- | 239 | #endif |
|
262 | } |
240 | } |
263 | 241 | ||
264 | void breakpoint_del(int slot) |
242 | void breakpoint_del(int slot) |
265 | { |
243 | { |
266 | bpinfo_t *cur; |
244 | bpinfo_t *cur; |
Line 285... | Line 263... | ||
285 | #ifdef CONFIG_SMP |
263 | #ifdef CONFIG_SMP |
286 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
264 | // ipi_broadcast(VECTOR_DEBUG_IPI); |
287 | #endif |
265 | #endif |
288 | } |
266 | } |
289 | 267 | ||
290 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
- | |
291 | 268 | ||
292 | /** Remove breakpoint from table */ |
- | |
293 | int cmd_del_breakpoint(cmd_arg_t *argv) |
- | |
294 | { |
- | |
295 | unative_t bpno = argv->intval; |
- | |
296 | if (bpno > BKPOINTS_MAX) { |
- | |
297 | printf("Invalid breakpoint number.\n"); |
- | |
298 | return 0; |
- | |
299 | } |
- | |
300 | breakpoint_del(argv->intval); |
- | |
301 | return 1; |
- | |
302 | } |
- | |
303 | - | ||
304 | /** Add new breakpoint to table */ |
- | |
305 | static int cmd_add_breakpoint(cmd_arg_t *argv) |
- | |
306 | { |
- | |
307 | int flags; |
- | |
308 | int id; |
- | |
309 | - | ||
310 | if (argv == &add_argv) { |
- | |
311 | flags = BKPOINT_INSTR; |
- | |
312 | } else { /* addwatchp */ |
- | |
313 | flags = BKPOINT_WRITE; |
- | |
314 | } |
- | |
315 | printf("Adding breakpoint on address: %p\n", argv->intval); |
- | |
316 | id = breakpoint_add((void *)argv->intval, flags, -1); |
- | |
317 | if (id < 0) |
- | |
318 | printf("Add breakpoint failed.\n"); |
- | |
319 | else |
- | |
320 | printf("Added breakpoint %d.\n", id); |
- | |
321 | - | ||
322 | return 1; |
- | |
323 | } |
- | |
324 | #endif |
- | |
325 | 269 | ||
326 | static void debug_exception(int n __attribute__((unused)), istate_t *istate) |
270 | static void debug_exception(int n __attribute__((unused)), istate_t *istate) |
327 | { |
271 | { |
328 | unative_t dr6; |
272 | unative_t dr6; |
329 | int i; |
273 | int i; |
330 | 274 | ||
331 | /* Set RF to restart the instruction */ |
275 | /* Set RF to restart the instruction */ |
332 | #ifdef amd64 |
276 | #ifdef __64_BITS__ |
333 | istate->rflags |= RFLAGS_RF; |
277 | istate->rflags |= RFLAGS_RF; |
334 | #else |
278 | #else |
335 | istate->eflags |= EFLAGS_RF; |
279 | istate->eflags |= EFLAGS_RF; |
336 | #endif |
280 | #endif |
337 | 281 | ||
Line 345... | Line 289... | ||
345 | } |
289 | } |
346 | } |
290 | } |
347 | } |
291 | } |
348 | 292 | ||
349 | #ifdef CONFIG_SMP |
293 | #ifdef CONFIG_SMP |
- | 294 | static void |
|
- | 295 | debug_ipi(int n __attribute__((unused)), |
|
350 | static void debug_ipi(int n __attribute__((unused)), istate_t *istate __attribute__((unused))) |
296 | istate_t *istate __attribute__((unused))) |
351 | { |
297 | { |
352 | int i; |
298 | int i; |
353 | 299 | ||
354 | spinlock_lock(&bkpoint_lock); |
300 | spinlock_lock(&bkpoint_lock); |
355 | for (i = 0; i < BKPOINTS_MAX; i++) |
301 | for (i = 0; i < BKPOINTS_MAX; i++) |
Line 361... | Line 307... | ||
361 | /** Initialize debugger */ |
307 | /** Initialize debugger */ |
362 | void debugger_init() |
308 | void debugger_init() |
363 | { |
309 | { |
364 | int i; |
310 | int i; |
365 | 311 | ||
366 | for (i=0; i<BKPOINTS_MAX; i++) |
312 | for (i = 0; i < BKPOINTS_MAX; i++) |
367 | breakpoints[i].address = NULL; |
313 | breakpoints[i].address = NULL; |
368 | 314 | ||
- | 315 | #ifdef CONFIG_KCONSOLE |
|
369 | cmd_initialize(&bkpts_info); |
316 | cmd_initialize(&bkpts_info); |
370 | if (!cmd_register(&bkpts_info)) |
317 | if (!cmd_register(&bkpts_info)) |
371 | panic("could not register command %s\n", bkpts_info.name); |
318 | printf("Cannot register command %s\n", bkpts_info.name); |
372 | 319 | ||
373 | #ifndef CONFIG_DEBUG_AS_WATCHPOINT |
- | |
374 | cmd_initialize(&delbkpt_info); |
320 | cmd_initialize(&delbkpt_info); |
375 | if (!cmd_register(&delbkpt_info)) |
321 | if (!cmd_register(&delbkpt_info)) |
376 | panic("could not register command %s\n", delbkpt_info.name); |
322 | printf("Cannot register command %s\n", delbkpt_info.name); |
377 | 323 | ||
378 | cmd_initialize(&addbkpt_info); |
324 | cmd_initialize(&addbkpt_info); |
379 | if (!cmd_register(&addbkpt_info)) |
325 | if (!cmd_register(&addbkpt_info)) |
380 | panic("could not register command %s\n", addbkpt_info.name); |
326 | printf("Cannot register command %s\n", addbkpt_info.name); |
381 | 327 | ||
382 | cmd_initialize(&addwatchp_info); |
328 | cmd_initialize(&addwatchp_info); |
383 | if (!cmd_register(&addwatchp_info)) |
329 | if (!cmd_register(&addwatchp_info)) |
384 | panic("could not register command %s\n", addwatchp_info.name); |
330 | printf("Cannot register command %s\n", addwatchp_info.name); |
385 | #endif |
331 | #endif /* CONFIG_KCONSOLE */ |
386 | 332 | ||
387 | exc_register(VECTOR_DEBUG, "debugger", |
333 | exc_register(VECTOR_DEBUG, "debugger", debug_exception); |
388 | debug_exception); |
- | |
389 | #ifdef CONFIG_SMP |
334 | #ifdef CONFIG_SMP |
390 | exc_register(VECTOR_DEBUG_IPI, "debugger_smp", |
335 | exc_register(VECTOR_DEBUG_IPI, "debugger_smp", debug_ipi); |
- | 336 | #endif |
|
- | 337 | } |
|
- | 338 | ||
- | 339 | #ifdef CONFIG_KCONSOLE |
|
- | 340 | /** Print table of active breakpoints */ |
|
- | 341 | int cmd_print_breakpoints(cmd_arg_t *argv __attribute__((unused))) |
|
- | 342 | { |
|
391 | debug_ipi); |
343 | unsigned int i; |
- | 344 | char *symbol; |
|
- | 345 | ||
- | 346 | #ifdef __32_BITS__ |
|
- | 347 | printf("# Count Address In symbol\n"); |
|
- | 348 | printf("-- ----- ---------- ---------\n"); |
|
- | 349 | #endif |
|
- | 350 | ||
- | 351 | #ifdef __64_BITS__ |
|
- | 352 | printf("# Count Address In symbol\n"); |
|
- | 353 | printf("-- ----- ------------------ ---------\n"); |
|
392 | #endif |
354 | #endif |
- | 355 | ||
- | 356 | for (i = 0; i < BKPOINTS_MAX; i++) |
|
- | 357 | if (breakpoints[i].address) { |
|
- | 358 | symbol = get_symtab_entry(breakpoints[i].address); |
|
- | 359 | ||
- | 360 | #ifdef __32_BITS__ |
|
- | 361 | printf("%-2u %-5d %#10zx %s\n", i, |
|
- | 362 | breakpoints[i].counter, breakpoints[i].address, |
|
- | 363 | symbol); |
|
- | 364 | #endif |
|
- | 365 | ||
- | 366 | #ifdef __64_BITS__ |
|
- | 367 | printf("%-2u %-5d %#18zx %s\n", i, |
|
- | 368 | breakpoints[i].counter, breakpoints[i].address, |
|
- | 369 | symbol); |
|
- | 370 | #endif |
|
- | 371 | ||
- | 372 | } |
|
- | 373 | return 1; |
|
- | 374 | } |
|
- | 375 | ||
- | 376 | /** Remove breakpoint from table */ |
|
- | 377 | int cmd_del_breakpoint(cmd_arg_t *argv) |
|
- | 378 | { |
|
- | 379 | unative_t bpno = argv->intval; |
|
- | 380 | if (bpno > BKPOINTS_MAX) { |
|
- | 381 | printf("Invalid breakpoint number.\n"); |
|
- | 382 | return 0; |
|
- | 383 | } |
|
- | 384 | breakpoint_del(argv->intval); |
|
- | 385 | return 1; |
|
- | 386 | } |
|
- | 387 | ||
- | 388 | /** Add new breakpoint to table */ |
|
- | 389 | static int cmd_add_breakpoint(cmd_arg_t *argv) |
|
- | 390 | { |
|
- | 391 | int flags; |
|
- | 392 | int id; |
|
- | 393 | ||
- | 394 | if (argv == &add_argv) { |
|
- | 395 | flags = BKPOINT_INSTR; |
|
- | 396 | } else { /* addwatchp */ |
|
- | 397 | flags = BKPOINT_WRITE; |
|
- | 398 | } |
|
- | 399 | printf("Adding breakpoint on address: %p\n", argv->intval); |
|
- | 400 | id = breakpoint_add((void *)argv->intval, flags, -1); |
|
- | 401 | if (id < 0) |
|
- | 402 | printf("Add breakpoint failed.\n"); |
|
- | 403 | else |
|
- | 404 | printf("Added breakpoint %d.\n", id); |
|
- | 405 | ||
- | 406 | return 1; |
|
393 | } |
407 | } |
- | 408 | #endif /* CONFIG_KCONSOLE */ |
|
394 | 409 | ||
395 | /** @} |
410 | /** @} |
396 | */ |
411 | */ |