diff options
Diffstat (limited to 'kernel/debug/kdb')
-rw-r--r-- | kernel/debug/kdb/.gitignore | 1 | ||||
-rw-r--r-- | kernel/debug/kdb/Makefile | 25 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_bp.c | 562 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_bt.c | 210 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_cmds | 35 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_debugger.c | 169 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_io.c | 826 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_keyboard.c | 212 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_main.c | 2956 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_private.h | 305 | ||||
-rw-r--r-- | kernel/debug/kdb/kdb_support.c | 927 |
11 files changed, 6228 insertions, 0 deletions
diff --git a/kernel/debug/kdb/.gitignore b/kernel/debug/kdb/.gitignore new file mode 100644 index 000000000000..396d12eda9e8 --- /dev/null +++ b/kernel/debug/kdb/.gitignore | |||
@@ -0,0 +1 @@ | |||
gen-kdb_cmds.c | |||
diff --git a/kernel/debug/kdb/Makefile b/kernel/debug/kdb/Makefile new file mode 100644 index 000000000000..d4fc58f4b88d --- /dev/null +++ b/kernel/debug/kdb/Makefile | |||
@@ -0,0 +1,25 @@ | |||
1 | # This file is subject to the terms and conditions of the GNU General Public | ||
2 | # License. See the file "COPYING" in the main directory of this archive | ||
3 | # for more details. | ||
4 | # | ||
5 | # Copyright (c) 1999-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
6 | # Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
7 | # | ||
8 | |||
9 | CCVERSION := $(shell $(CC) -v 2>&1 | sed -ne '$$p') | ||
10 | obj-y := kdb_io.o kdb_main.o kdb_support.o kdb_bt.o gen-kdb_cmds.o kdb_bp.o kdb_debugger.o | ||
11 | obj-$(CONFIG_KDB_KEYBOARD) += kdb_keyboard.o | ||
12 | |||
13 | clean-files := gen-kdb_cmds.c | ||
14 | |||
15 | quiet_cmd_gen-kdb = GENKDB $@ | ||
16 | cmd_gen-kdb = $(AWK) 'BEGIN {print "\#include <linux/stddef.h>"; print "\#include <linux/init.h>"} \ | ||
17 | /^\#/{next} \ | ||
18 | /^[ \t]*$$/{next} \ | ||
19 | {gsub(/"/, "\\\"", $$0); \ | ||
20 | print "static __initdata char kdb_cmd" cmds++ "[] = \"" $$0 "\\n\";"} \ | ||
21 | END {print "extern char *kdb_cmds[]; char __initdata *kdb_cmds[] = {"; for (i = 0; i < cmds; ++i) {print " kdb_cmd" i ","}; print(" NULL\n};");}' \ | ||
22 | $(filter-out %/Makefile,$^) > $@# | ||
23 | |||
24 | $(obj)/gen-kdb_cmds.c: $(src)/kdb_cmds $(src)/Makefile | ||
25 | $(call cmd,gen-kdb) | ||
diff --git a/kernel/debug/kdb/kdb_bp.c b/kernel/debug/kdb/kdb_bp.c new file mode 100644 index 000000000000..20059ef4459a --- /dev/null +++ b/kernel/debug/kdb/kdb_bp.c | |||
@@ -0,0 +1,562 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Independent Breakpoint Handler | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (c) 1999-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
9 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
10 | */ | ||
11 | |||
12 | #include <linux/string.h> | ||
13 | #include <linux/kernel.h> | ||
14 | #include <linux/init.h> | ||
15 | #include <linux/kdb.h> | ||
16 | #include <linux/kgdb.h> | ||
17 | #include <linux/smp.h> | ||
18 | #include <linux/sched.h> | ||
19 | #include <linux/interrupt.h> | ||
20 | #include "kdb_private.h" | ||
21 | |||
22 | /* | ||
23 | * Table of kdb_breakpoints | ||
24 | */ | ||
25 | kdb_bp_t kdb_breakpoints[KDB_MAXBPT]; | ||
26 | |||
27 | static void kdb_setsinglestep(struct pt_regs *regs) | ||
28 | { | ||
29 | KDB_STATE_SET(DOING_SS); | ||
30 | } | ||
31 | |||
32 | static char *kdb_rwtypes[] = { | ||
33 | "Instruction(i)", | ||
34 | "Instruction(Register)", | ||
35 | "Data Write", | ||
36 | "I/O", | ||
37 | "Data Access" | ||
38 | }; | ||
39 | |||
40 | static char *kdb_bptype(kdb_bp_t *bp) | ||
41 | { | ||
42 | if (bp->bp_type < 0 || bp->bp_type > 4) | ||
43 | return ""; | ||
44 | |||
45 | return kdb_rwtypes[bp->bp_type]; | ||
46 | } | ||
47 | |||
48 | static int kdb_parsebp(int argc, const char **argv, int *nextargp, kdb_bp_t *bp) | ||
49 | { | ||
50 | int nextarg = *nextargp; | ||
51 | int diag; | ||
52 | |||
53 | bp->bph_length = 1; | ||
54 | if ((argc + 1) != nextarg) { | ||
55 | if (strnicmp(argv[nextarg], "datar", sizeof("datar")) == 0) | ||
56 | bp->bp_type = BP_ACCESS_WATCHPOINT; | ||
57 | else if (strnicmp(argv[nextarg], "dataw", sizeof("dataw")) == 0) | ||
58 | bp->bp_type = BP_WRITE_WATCHPOINT; | ||
59 | else if (strnicmp(argv[nextarg], "inst", sizeof("inst")) == 0) | ||
60 | bp->bp_type = BP_HARDWARE_BREAKPOINT; | ||
61 | else | ||
62 | return KDB_ARGCOUNT; | ||
63 | |||
64 | bp->bph_length = 1; | ||
65 | |||
66 | nextarg++; | ||
67 | |||
68 | if ((argc + 1) != nextarg) { | ||
69 | unsigned long len; | ||
70 | |||
71 | diag = kdbgetularg((char *)argv[nextarg], | ||
72 | &len); | ||
73 | if (diag) | ||
74 | return diag; | ||
75 | |||
76 | |||
77 | if (len > 8) | ||
78 | return KDB_BADLENGTH; | ||
79 | |||
80 | bp->bph_length = len; | ||
81 | nextarg++; | ||
82 | } | ||
83 | |||
84 | if ((argc + 1) != nextarg) | ||
85 | return KDB_ARGCOUNT; | ||
86 | } | ||
87 | |||
88 | *nextargp = nextarg; | ||
89 | return 0; | ||
90 | } | ||
91 | |||
92 | static int _kdb_bp_remove(kdb_bp_t *bp) | ||
93 | { | ||
94 | int ret = 1; | ||
95 | if (!bp->bp_installed) | ||
96 | return ret; | ||
97 | if (!bp->bp_type) | ||
98 | ret = dbg_remove_sw_break(bp->bp_addr); | ||
99 | else | ||
100 | ret = arch_kgdb_ops.remove_hw_breakpoint(bp->bp_addr, | ||
101 | bp->bph_length, | ||
102 | bp->bp_type); | ||
103 | if (ret == 0) | ||
104 | bp->bp_installed = 0; | ||
105 | return ret; | ||
106 | } | ||
107 | |||
108 | static void kdb_handle_bp(struct pt_regs *regs, kdb_bp_t *bp) | ||
109 | { | ||
110 | if (KDB_DEBUG(BP)) | ||
111 | kdb_printf("regs->ip = 0x%lx\n", instruction_pointer(regs)); | ||
112 | |||
113 | /* | ||
114 | * Setup single step | ||
115 | */ | ||
116 | kdb_setsinglestep(regs); | ||
117 | |||
118 | /* | ||
119 | * Reset delay attribute | ||
120 | */ | ||
121 | bp->bp_delay = 0; | ||
122 | bp->bp_delayed = 1; | ||
123 | } | ||
124 | |||
125 | static int _kdb_bp_install(struct pt_regs *regs, kdb_bp_t *bp) | ||
126 | { | ||
127 | int ret; | ||
128 | /* | ||
129 | * Install the breakpoint, if it is not already installed. | ||
130 | */ | ||
131 | |||
132 | if (KDB_DEBUG(BP)) | ||
133 | kdb_printf("%s: bp_installed %d\n", | ||
134 | __func__, bp->bp_installed); | ||
135 | if (!KDB_STATE(SSBPT)) | ||
136 | bp->bp_delay = 0; | ||
137 | if (bp->bp_installed) | ||
138 | return 1; | ||
139 | if (bp->bp_delay || (bp->bp_delayed && KDB_STATE(DOING_SS))) { | ||
140 | if (KDB_DEBUG(BP)) | ||
141 | kdb_printf("%s: delayed bp\n", __func__); | ||
142 | kdb_handle_bp(regs, bp); | ||
143 | return 0; | ||
144 | } | ||
145 | if (!bp->bp_type) | ||
146 | ret = dbg_set_sw_break(bp->bp_addr); | ||
147 | else | ||
148 | ret = arch_kgdb_ops.set_hw_breakpoint(bp->bp_addr, | ||
149 | bp->bph_length, | ||
150 | bp->bp_type); | ||
151 | if (ret == 0) { | ||
152 | bp->bp_installed = 1; | ||
153 | } else { | ||
154 | kdb_printf("%s: failed to set breakpoint at 0x%lx\n", | ||
155 | __func__, bp->bp_addr); | ||
156 | return 1; | ||
157 | } | ||
158 | return 0; | ||
159 | } | ||
160 | |||
161 | /* | ||
162 | * kdb_bp_install | ||
163 | * | ||
164 | * Install kdb_breakpoints prior to returning from the | ||
165 | * kernel debugger. This allows the kdb_breakpoints to be set | ||
166 | * upon functions that are used internally by kdb, such as | ||
167 | * printk(). This function is only called once per kdb session. | ||
168 | */ | ||
169 | void kdb_bp_install(struct pt_regs *regs) | ||
170 | { | ||
171 | int i; | ||
172 | |||
173 | for (i = 0; i < KDB_MAXBPT; i++) { | ||
174 | kdb_bp_t *bp = &kdb_breakpoints[i]; | ||
175 | |||
176 | if (KDB_DEBUG(BP)) { | ||
177 | kdb_printf("%s: bp %d bp_enabled %d\n", | ||
178 | __func__, i, bp->bp_enabled); | ||
179 | } | ||
180 | if (bp->bp_enabled) | ||
181 | _kdb_bp_install(regs, bp); | ||
182 | } | ||
183 | } | ||
184 | |||
185 | /* | ||
186 | * kdb_bp_remove | ||
187 | * | ||
188 | * Remove kdb_breakpoints upon entry to the kernel debugger. | ||
189 | * | ||
190 | * Parameters: | ||
191 | * None. | ||
192 | * Outputs: | ||
193 | * None. | ||
194 | * Returns: | ||
195 | * None. | ||
196 | * Locking: | ||
197 | * None. | ||
198 | * Remarks: | ||
199 | */ | ||
200 | void kdb_bp_remove(void) | ||
201 | { | ||
202 | int i; | ||
203 | |||
204 | for (i = KDB_MAXBPT - 1; i >= 0; i--) { | ||
205 | kdb_bp_t *bp = &kdb_breakpoints[i]; | ||
206 | |||
207 | if (KDB_DEBUG(BP)) { | ||
208 | kdb_printf("%s: bp %d bp_enabled %d\n", | ||
209 | __func__, i, bp->bp_enabled); | ||
210 | } | ||
211 | if (bp->bp_enabled) | ||
212 | _kdb_bp_remove(bp); | ||
213 | } | ||
214 | } | ||
215 | |||
216 | |||
217 | /* | ||
218 | * kdb_printbp | ||
219 | * | ||
220 | * Internal function to format and print a breakpoint entry. | ||
221 | * | ||
222 | * Parameters: | ||
223 | * None. | ||
224 | * Outputs: | ||
225 | * None. | ||
226 | * Returns: | ||
227 | * None. | ||
228 | * Locking: | ||
229 | * None. | ||
230 | * Remarks: | ||
231 | */ | ||
232 | |||
233 | static void kdb_printbp(kdb_bp_t *bp, int i) | ||
234 | { | ||
235 | kdb_printf("%s ", kdb_bptype(bp)); | ||
236 | kdb_printf("BP #%d at ", i); | ||
237 | kdb_symbol_print(bp->bp_addr, NULL, KDB_SP_DEFAULT); | ||
238 | |||
239 | if (bp->bp_enabled) | ||
240 | kdb_printf("\n is enabled"); | ||
241 | else | ||
242 | kdb_printf("\n is disabled"); | ||
243 | |||
244 | kdb_printf("\taddr at %016lx, hardtype=%d installed=%d\n", | ||
245 | bp->bp_addr, bp->bp_type, bp->bp_installed); | ||
246 | |||
247 | kdb_printf("\n"); | ||
248 | } | ||
249 | |||
250 | /* | ||
251 | * kdb_bp | ||
252 | * | ||
253 | * Handle the bp commands. | ||
254 | * | ||
255 | * [bp|bph] <addr-expression> [DATAR|DATAW] | ||
256 | * | ||
257 | * Parameters: | ||
258 | * argc Count of arguments in argv | ||
259 | * argv Space delimited command line arguments | ||
260 | * Outputs: | ||
261 | * None. | ||
262 | * Returns: | ||
263 | * Zero for success, a kdb diagnostic if failure. | ||
264 | * Locking: | ||
265 | * None. | ||
266 | * Remarks: | ||
267 | * | ||
268 | * bp Set breakpoint on all cpus. Only use hardware assist if need. | ||
269 | * bph Set breakpoint on all cpus. Force hardware register | ||
270 | */ | ||
271 | |||
272 | static int kdb_bp(int argc, const char **argv) | ||
273 | { | ||
274 | int i, bpno; | ||
275 | kdb_bp_t *bp, *bp_check; | ||
276 | int diag; | ||
277 | char *symname = NULL; | ||
278 | long offset = 0ul; | ||
279 | int nextarg; | ||
280 | kdb_bp_t template = {0}; | ||
281 | |||
282 | if (argc == 0) { | ||
283 | /* | ||
284 | * Display breakpoint table | ||
285 | */ | ||
286 | for (bpno = 0, bp = kdb_breakpoints; bpno < KDB_MAXBPT; | ||
287 | bpno++, bp++) { | ||
288 | if (bp->bp_free) | ||
289 | continue; | ||
290 | kdb_printbp(bp, bpno); | ||
291 | } | ||
292 | |||
293 | return 0; | ||
294 | } | ||
295 | |||
296 | nextarg = 1; | ||
297 | diag = kdbgetaddrarg(argc, argv, &nextarg, &template.bp_addr, | ||
298 | &offset, &symname); | ||
299 | if (diag) | ||
300 | return diag; | ||
301 | if (!template.bp_addr) | ||
302 | return KDB_BADINT; | ||
303 | |||
304 | /* | ||
305 | * Find an empty bp structure to allocate | ||
306 | */ | ||
307 | for (bpno = 0, bp = kdb_breakpoints; bpno < KDB_MAXBPT; bpno++, bp++) { | ||
308 | if (bp->bp_free) | ||
309 | break; | ||
310 | } | ||
311 | |||
312 | if (bpno == KDB_MAXBPT) | ||
313 | return KDB_TOOMANYBPT; | ||
314 | |||
315 | if (strcmp(argv[0], "bph") == 0) { | ||
316 | template.bp_type = BP_HARDWARE_BREAKPOINT; | ||
317 | diag = kdb_parsebp(argc, argv, &nextarg, &template); | ||
318 | if (diag) | ||
319 | return diag; | ||
320 | } else { | ||
321 | template.bp_type = BP_BREAKPOINT; | ||
322 | } | ||
323 | |||
324 | /* | ||
325 | * Check for clashing breakpoints. | ||
326 | * | ||
327 | * Note, in this design we can't have hardware breakpoints | ||
328 | * enabled for both read and write on the same address. | ||
329 | */ | ||
330 | for (i = 0, bp_check = kdb_breakpoints; i < KDB_MAXBPT; | ||
331 | i++, bp_check++) { | ||
332 | if (!bp_check->bp_free && | ||
333 | bp_check->bp_addr == template.bp_addr) { | ||
334 | kdb_printf("You already have a breakpoint at " | ||
335 | kdb_bfd_vma_fmt0 "\n", template.bp_addr); | ||
336 | return KDB_DUPBPT; | ||
337 | } | ||
338 | } | ||
339 | |||
340 | template.bp_enabled = 1; | ||
341 | |||
342 | /* | ||
343 | * Actually allocate the breakpoint found earlier | ||
344 | */ | ||
345 | *bp = template; | ||
346 | bp->bp_free = 0; | ||
347 | |||
348 | kdb_printbp(bp, bpno); | ||
349 | |||
350 | return 0; | ||
351 | } | ||
352 | |||
353 | /* | ||
354 | * kdb_bc | ||
355 | * | ||
356 | * Handles the 'bc', 'be', and 'bd' commands | ||
357 | * | ||
358 | * [bd|bc|be] <breakpoint-number> | ||
359 | * [bd|bc|be] * | ||
360 | * | ||
361 | * Parameters: | ||
362 | * argc Count of arguments in argv | ||
363 | * argv Space delimited command line arguments | ||
364 | * Outputs: | ||
365 | * None. | ||
366 | * Returns: | ||
367 | * Zero for success, a kdb diagnostic for failure | ||
368 | * Locking: | ||
369 | * None. | ||
370 | * Remarks: | ||
371 | */ | ||
372 | static int kdb_bc(int argc, const char **argv) | ||
373 | { | ||
374 | unsigned long addr; | ||
375 | kdb_bp_t *bp = NULL; | ||
376 | int lowbp = KDB_MAXBPT; | ||
377 | int highbp = 0; | ||
378 | int done = 0; | ||
379 | int i; | ||
380 | int diag = 0; | ||
381 | |||
382 | int cmd; /* KDBCMD_B? */ | ||
383 | #define KDBCMD_BC 0 | ||
384 | #define KDBCMD_BE 1 | ||
385 | #define KDBCMD_BD 2 | ||
386 | |||
387 | if (strcmp(argv[0], "be") == 0) | ||
388 | cmd = KDBCMD_BE; | ||
389 | else if (strcmp(argv[0], "bd") == 0) | ||
390 | cmd = KDBCMD_BD; | ||
391 | else | ||
392 | cmd = KDBCMD_BC; | ||
393 | |||
394 | if (argc != 1) | ||
395 | return KDB_ARGCOUNT; | ||
396 | |||
397 | if (strcmp(argv[1], "*") == 0) { | ||
398 | lowbp = 0; | ||
399 | highbp = KDB_MAXBPT; | ||
400 | } else { | ||
401 | diag = kdbgetularg(argv[1], &addr); | ||
402 | if (diag) | ||
403 | return diag; | ||
404 | |||
405 | /* | ||
406 | * For addresses less than the maximum breakpoint number, | ||
407 | * assume that the breakpoint number is desired. | ||
408 | */ | ||
409 | if (addr < KDB_MAXBPT) { | ||
410 | bp = &kdb_breakpoints[addr]; | ||
411 | lowbp = highbp = addr; | ||
412 | highbp++; | ||
413 | } else { | ||
414 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; | ||
415 | i++, bp++) { | ||
416 | if (bp->bp_addr == addr) { | ||
417 | lowbp = highbp = i; | ||
418 | highbp++; | ||
419 | break; | ||
420 | } | ||
421 | } | ||
422 | } | ||
423 | } | ||
424 | |||
425 | /* | ||
426 | * Now operate on the set of breakpoints matching the input | ||
427 | * criteria (either '*' for all, or an individual breakpoint). | ||
428 | */ | ||
429 | for (bp = &kdb_breakpoints[lowbp], i = lowbp; | ||
430 | i < highbp; | ||
431 | i++, bp++) { | ||
432 | if (bp->bp_free) | ||
433 | continue; | ||
434 | |||
435 | done++; | ||
436 | |||
437 | switch (cmd) { | ||
438 | case KDBCMD_BC: | ||
439 | bp->bp_enabled = 0; | ||
440 | |||
441 | kdb_printf("Breakpoint %d at " | ||
442 | kdb_bfd_vma_fmt " cleared\n", | ||
443 | i, bp->bp_addr); | ||
444 | |||
445 | bp->bp_addr = 0; | ||
446 | bp->bp_free = 1; | ||
447 | |||
448 | break; | ||
449 | case KDBCMD_BE: | ||
450 | bp->bp_enabled = 1; | ||
451 | |||
452 | kdb_printf("Breakpoint %d at " | ||
453 | kdb_bfd_vma_fmt " enabled", | ||
454 | i, bp->bp_addr); | ||
455 | |||
456 | kdb_printf("\n"); | ||
457 | break; | ||
458 | case KDBCMD_BD: | ||
459 | if (!bp->bp_enabled) | ||
460 | break; | ||
461 | |||
462 | bp->bp_enabled = 0; | ||
463 | |||
464 | kdb_printf("Breakpoint %d at " | ||
465 | kdb_bfd_vma_fmt " disabled\n", | ||
466 | i, bp->bp_addr); | ||
467 | |||
468 | break; | ||
469 | } | ||
470 | if (bp->bp_delay && (cmd == KDBCMD_BC || cmd == KDBCMD_BD)) { | ||
471 | bp->bp_delay = 0; | ||
472 | KDB_STATE_CLEAR(SSBPT); | ||
473 | } | ||
474 | } | ||
475 | |||
476 | return (!done) ? KDB_BPTNOTFOUND : 0; | ||
477 | } | ||
478 | |||
479 | /* | ||
480 | * kdb_ss | ||
481 | * | ||
482 | * Process the 'ss' (Single Step) and 'ssb' (Single Step to Branch) | ||
483 | * commands. | ||
484 | * | ||
485 | * ss | ||
486 | * ssb | ||
487 | * | ||
488 | * Parameters: | ||
489 | * argc Argument count | ||
490 | * argv Argument vector | ||
491 | * Outputs: | ||
492 | * None. | ||
493 | * Returns: | ||
494 | * KDB_CMD_SS[B] for success, a kdb error if failure. | ||
495 | * Locking: | ||
496 | * None. | ||
497 | * Remarks: | ||
498 | * | ||
499 | * Set the arch specific option to trigger a debug trap after the next | ||
500 | * instruction. | ||
501 | * | ||
502 | * For 'ssb', set the trace flag in the debug trap handler | ||
503 | * after printing the current insn and return directly without | ||
504 | * invoking the kdb command processor, until a branch instruction | ||
505 | * is encountered. | ||
506 | */ | ||
507 | |||
508 | static int kdb_ss(int argc, const char **argv) | ||
509 | { | ||
510 | int ssb = 0; | ||
511 | |||
512 | ssb = (strcmp(argv[0], "ssb") == 0); | ||
513 | if (argc != 0) | ||
514 | return KDB_ARGCOUNT; | ||
515 | /* | ||
516 | * Set trace flag and go. | ||
517 | */ | ||
518 | KDB_STATE_SET(DOING_SS); | ||
519 | if (ssb) { | ||
520 | KDB_STATE_SET(DOING_SSB); | ||
521 | return KDB_CMD_SSB; | ||
522 | } | ||
523 | return KDB_CMD_SS; | ||
524 | } | ||
525 | |||
526 | /* Initialize the breakpoint table and register breakpoint commands. */ | ||
527 | |||
528 | void __init kdb_initbptab(void) | ||
529 | { | ||
530 | int i; | ||
531 | kdb_bp_t *bp; | ||
532 | |||
533 | /* | ||
534 | * First time initialization. | ||
535 | */ | ||
536 | memset(&kdb_breakpoints, '\0', sizeof(kdb_breakpoints)); | ||
537 | |||
538 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; i++, bp++) | ||
539 | bp->bp_free = 1; | ||
540 | |||
541 | kdb_register_repeat("bp", kdb_bp, "[<vaddr>]", | ||
542 | "Set/Display breakpoints", 0, KDB_REPEAT_NO_ARGS); | ||
543 | kdb_register_repeat("bl", kdb_bp, "[<vaddr>]", | ||
544 | "Display breakpoints", 0, KDB_REPEAT_NO_ARGS); | ||
545 | if (arch_kgdb_ops.flags & KGDB_HW_BREAKPOINT) | ||
546 | kdb_register_repeat("bph", kdb_bp, "[<vaddr>]", | ||
547 | "[datar [length]|dataw [length]] Set hw brk", 0, KDB_REPEAT_NO_ARGS); | ||
548 | kdb_register_repeat("bc", kdb_bc, "<bpnum>", | ||
549 | "Clear Breakpoint", 0, KDB_REPEAT_NONE); | ||
550 | kdb_register_repeat("be", kdb_bc, "<bpnum>", | ||
551 | "Enable Breakpoint", 0, KDB_REPEAT_NONE); | ||
552 | kdb_register_repeat("bd", kdb_bc, "<bpnum>", | ||
553 | "Disable Breakpoint", 0, KDB_REPEAT_NONE); | ||
554 | |||
555 | kdb_register_repeat("ss", kdb_ss, "", | ||
556 | "Single Step", 1, KDB_REPEAT_NO_ARGS); | ||
557 | kdb_register_repeat("ssb", kdb_ss, "", | ||
558 | "Single step to branch/call", 0, KDB_REPEAT_NO_ARGS); | ||
559 | /* | ||
560 | * Architecture dependent initialization. | ||
561 | */ | ||
562 | } | ||
diff --git a/kernel/debug/kdb/kdb_bt.c b/kernel/debug/kdb/kdb_bt.c new file mode 100644 index 000000000000..2f62fe85f16a --- /dev/null +++ b/kernel/debug/kdb/kdb_bt.c | |||
@@ -0,0 +1,210 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Independent Stack Traceback | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (c) 1999-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
9 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
10 | */ | ||
11 | |||
12 | #include <linux/ctype.h> | ||
13 | #include <linux/string.h> | ||
14 | #include <linux/kernel.h> | ||
15 | #include <linux/sched.h> | ||
16 | #include <linux/kdb.h> | ||
17 | #include <linux/nmi.h> | ||
18 | #include <asm/system.h> | ||
19 | #include "kdb_private.h" | ||
20 | |||
21 | |||
22 | static void kdb_show_stack(struct task_struct *p, void *addr) | ||
23 | { | ||
24 | int old_lvl = console_loglevel; | ||
25 | console_loglevel = 15; | ||
26 | kdb_trap_printk++; | ||
27 | kdb_set_current_task(p); | ||
28 | if (addr) { | ||
29 | show_stack((struct task_struct *)p, addr); | ||
30 | } else if (kdb_current_regs) { | ||
31 | #ifdef CONFIG_X86 | ||
32 | show_stack(p, &kdb_current_regs->sp); | ||
33 | #else | ||
34 | show_stack(p, NULL); | ||
35 | #endif | ||
36 | } else { | ||
37 | show_stack(p, NULL); | ||
38 | } | ||
39 | console_loglevel = old_lvl; | ||
40 | kdb_trap_printk--; | ||
41 | } | ||
42 | |||
43 | /* | ||
44 | * kdb_bt | ||
45 | * | ||
46 | * This function implements the 'bt' command. Print a stack | ||
47 | * traceback. | ||
48 | * | ||
49 | * bt [<address-expression>] (addr-exp is for alternate stacks) | ||
50 | * btp <pid> Kernel stack for <pid> | ||
51 | * btt <address-expression> Kernel stack for task structure at | ||
52 | * <address-expression> | ||
53 | * bta [DRSTCZEUIMA] All useful processes, optionally | ||
54 | * filtered by state | ||
55 | * btc [<cpu>] The current process on one cpu, | ||
56 | * default is all cpus | ||
57 | * | ||
58 | * bt <address-expression> refers to a address on the stack, that location | ||
59 | * is assumed to contain a return address. | ||
60 | * | ||
61 | * btt <address-expression> refers to the address of a struct task. | ||
62 | * | ||
63 | * Inputs: | ||
64 | * argc argument count | ||
65 | * argv argument vector | ||
66 | * Outputs: | ||
67 | * None. | ||
68 | * Returns: | ||
69 | * zero for success, a kdb diagnostic if error | ||
70 | * Locking: | ||
71 | * none. | ||
72 | * Remarks: | ||
73 | * Backtrack works best when the code uses frame pointers. But even | ||
74 | * without frame pointers we should get a reasonable trace. | ||
75 | * | ||
76 | * mds comes in handy when examining the stack to do a manual traceback or | ||
77 | * to get a starting point for bt <address-expression>. | ||
78 | */ | ||
79 | |||
80 | static int | ||
81 | kdb_bt1(struct task_struct *p, unsigned long mask, | ||
82 | int argcount, int btaprompt) | ||
83 | { | ||
84 | char buffer[2]; | ||
85 | if (kdb_getarea(buffer[0], (unsigned long)p) || | ||
86 | kdb_getarea(buffer[0], (unsigned long)(p+1)-1)) | ||
87 | return KDB_BADADDR; | ||
88 | if (!kdb_task_state(p, mask)) | ||
89 | return 0; | ||
90 | kdb_printf("Stack traceback for pid %d\n", p->pid); | ||
91 | kdb_ps1(p); | ||
92 | kdb_show_stack(p, NULL); | ||
93 | if (btaprompt) { | ||
94 | kdb_getstr(buffer, sizeof(buffer), | ||
95 | "Enter <q> to end, <cr> to continue:"); | ||
96 | if (buffer[0] == 'q') { | ||
97 | kdb_printf("\n"); | ||
98 | return 1; | ||
99 | } | ||
100 | } | ||
101 | touch_nmi_watchdog(); | ||
102 | return 0; | ||
103 | } | ||
104 | |||
105 | int | ||
106 | kdb_bt(int argc, const char **argv) | ||
107 | { | ||
108 | int diag; | ||
109 | int argcount = 5; | ||
110 | int btaprompt = 1; | ||
111 | int nextarg; | ||
112 | unsigned long addr; | ||
113 | long offset; | ||
114 | |||
115 | kdbgetintenv("BTARGS", &argcount); /* Arguments to print */ | ||
116 | kdbgetintenv("BTAPROMPT", &btaprompt); /* Prompt after each | ||
117 | * proc in bta */ | ||
118 | |||
119 | if (strcmp(argv[0], "bta") == 0) { | ||
120 | struct task_struct *g, *p; | ||
121 | unsigned long cpu; | ||
122 | unsigned long mask = kdb_task_state_string(argc ? argv[1] : | ||
123 | NULL); | ||
124 | if (argc == 0) | ||
125 | kdb_ps_suppressed(); | ||
126 | /* Run the active tasks first */ | ||
127 | for_each_online_cpu(cpu) { | ||
128 | p = kdb_curr_task(cpu); | ||
129 | if (kdb_bt1(p, mask, argcount, btaprompt)) | ||
130 | return 0; | ||
131 | } | ||
132 | /* Now the inactive tasks */ | ||
133 | kdb_do_each_thread(g, p) { | ||
134 | if (task_curr(p)) | ||
135 | continue; | ||
136 | if (kdb_bt1(p, mask, argcount, btaprompt)) | ||
137 | return 0; | ||
138 | } kdb_while_each_thread(g, p); | ||
139 | } else if (strcmp(argv[0], "btp") == 0) { | ||
140 | struct task_struct *p; | ||
141 | unsigned long pid; | ||
142 | if (argc != 1) | ||
143 | return KDB_ARGCOUNT; | ||
144 | diag = kdbgetularg((char *)argv[1], &pid); | ||
145 | if (diag) | ||
146 | return diag; | ||
147 | p = find_task_by_pid_ns(pid, &init_pid_ns); | ||
148 | if (p) { | ||
149 | kdb_set_current_task(p); | ||
150 | return kdb_bt1(p, ~0UL, argcount, 0); | ||
151 | } | ||
152 | kdb_printf("No process with pid == %ld found\n", pid); | ||
153 | return 0; | ||
154 | } else if (strcmp(argv[0], "btt") == 0) { | ||
155 | if (argc != 1) | ||
156 | return KDB_ARGCOUNT; | ||
157 | diag = kdbgetularg((char *)argv[1], &addr); | ||
158 | if (diag) | ||
159 | return diag; | ||
160 | kdb_set_current_task((struct task_struct *)addr); | ||
161 | return kdb_bt1((struct task_struct *)addr, ~0UL, argcount, 0); | ||
162 | } else if (strcmp(argv[0], "btc") == 0) { | ||
163 | unsigned long cpu = ~0; | ||
164 | struct task_struct *save_current_task = kdb_current_task; | ||
165 | char buf[80]; | ||
166 | if (argc > 1) | ||
167 | return KDB_ARGCOUNT; | ||
168 | if (argc == 1) { | ||
169 | diag = kdbgetularg((char *)argv[1], &cpu); | ||
170 | if (diag) | ||
171 | return diag; | ||
172 | } | ||
173 | /* Recursive use of kdb_parse, do not use argv after | ||
174 | * this point */ | ||
175 | argv = NULL; | ||
176 | if (cpu != ~0) { | ||
177 | if (cpu >= num_possible_cpus() || !cpu_online(cpu)) { | ||
178 | kdb_printf("no process for cpu %ld\n", cpu); | ||
179 | return 0; | ||
180 | } | ||
181 | sprintf(buf, "btt 0x%p\n", KDB_TSK(cpu)); | ||
182 | kdb_parse(buf); | ||
183 | return 0; | ||
184 | } | ||
185 | kdb_printf("btc: cpu status: "); | ||
186 | kdb_parse("cpu\n"); | ||
187 | for_each_online_cpu(cpu) { | ||
188 | sprintf(buf, "btt 0x%p\n", KDB_TSK(cpu)); | ||
189 | kdb_parse(buf); | ||
190 | touch_nmi_watchdog(); | ||
191 | } | ||
192 | kdb_set_current_task(save_current_task); | ||
193 | return 0; | ||
194 | } else { | ||
195 | if (argc) { | ||
196 | nextarg = 1; | ||
197 | diag = kdbgetaddrarg(argc, argv, &nextarg, &addr, | ||
198 | &offset, NULL); | ||
199 | if (diag) | ||
200 | return diag; | ||
201 | kdb_show_stack(kdb_current_task, (void *)addr); | ||
202 | return 0; | ||
203 | } else { | ||
204 | return kdb_bt1(kdb_current_task, ~0UL, argcount, 0); | ||
205 | } | ||
206 | } | ||
207 | |||
208 | /* NOTREACHED */ | ||
209 | return 0; | ||
210 | } | ||
diff --git a/kernel/debug/kdb/kdb_cmds b/kernel/debug/kdb/kdb_cmds new file mode 100644 index 000000000000..56c88e4db309 --- /dev/null +++ b/kernel/debug/kdb/kdb_cmds | |||
@@ -0,0 +1,35 @@ | |||
1 | # Initial commands for kdb, alter to suit your needs. | ||
2 | # These commands are executed in kdb_init() context, no SMP, no | ||
3 | # processes. Commands that require process data (including stack or | ||
4 | # registers) are not reliable this early. set and bp commands should | ||
5 | # be safe. Global breakpoint commands affect each cpu as it is booted. | ||
6 | |||
7 | # Standard debugging information for first level support, just type archkdb | ||
8 | # or archkdbcpu or archkdbshort at the kdb prompt. | ||
9 | |||
10 | defcmd dumpcommon "" "Common kdb debugging" | ||
11 | set BTAPROMPT 0 | ||
12 | set LINES 10000 | ||
13 | -summary | ||
14 | -cpu | ||
15 | -ps | ||
16 | -dmesg 600 | ||
17 | -bt | ||
18 | endefcmd | ||
19 | |||
20 | defcmd dumpall "" "First line debugging" | ||
21 | set BTSYMARG 1 | ||
22 | set BTARGS 9 | ||
23 | pid R | ||
24 | -dumpcommon | ||
25 | -bta | ||
26 | endefcmd | ||
27 | |||
28 | defcmd dumpcpu "" "Same as dumpall but only tasks on cpus" | ||
29 | set BTSYMARG 1 | ||
30 | set BTARGS 9 | ||
31 | pid R | ||
32 | -dumpcommon | ||
33 | -btc | ||
34 | endefcmd | ||
35 | |||
diff --git a/kernel/debug/kdb/kdb_debugger.c b/kernel/debug/kdb/kdb_debugger.c new file mode 100644 index 000000000000..bf6e8270e957 --- /dev/null +++ b/kernel/debug/kdb/kdb_debugger.c | |||
@@ -0,0 +1,169 @@ | |||
1 | /* | ||
2 | * Created by: Jason Wessel <jason.wessel@windriver.com> | ||
3 | * | ||
4 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
5 | * | ||
6 | * This file is licensed under the terms of the GNU General Public | ||
7 | * License version 2. This program is licensed "as is" without any | ||
8 | * warranty of any kind, whether express or implied. | ||
9 | */ | ||
10 | |||
11 | #include <linux/kgdb.h> | ||
12 | #include <linux/kdb.h> | ||
13 | #include <linux/kdebug.h> | ||
14 | #include "kdb_private.h" | ||
15 | #include "../debug_core.h" | ||
16 | |||
17 | /* | ||
18 | * KDB interface to KGDB internals | ||
19 | */ | ||
20 | get_char_func kdb_poll_funcs[] = { | ||
21 | dbg_io_get_char, | ||
22 | NULL, | ||
23 | NULL, | ||
24 | NULL, | ||
25 | NULL, | ||
26 | NULL, | ||
27 | }; | ||
28 | EXPORT_SYMBOL_GPL(kdb_poll_funcs); | ||
29 | |||
30 | int kdb_poll_idx = 1; | ||
31 | EXPORT_SYMBOL_GPL(kdb_poll_idx); | ||
32 | |||
33 | int kdb_stub(struct kgdb_state *ks) | ||
34 | { | ||
35 | int error = 0; | ||
36 | kdb_bp_t *bp; | ||
37 | unsigned long addr = kgdb_arch_pc(ks->ex_vector, ks->linux_regs); | ||
38 | kdb_reason_t reason = KDB_REASON_OOPS; | ||
39 | kdb_dbtrap_t db_result = KDB_DB_NOBPT; | ||
40 | int i; | ||
41 | |||
42 | if (KDB_STATE(REENTRY)) { | ||
43 | reason = KDB_REASON_SWITCH; | ||
44 | KDB_STATE_CLEAR(REENTRY); | ||
45 | addr = instruction_pointer(ks->linux_regs); | ||
46 | } | ||
47 | ks->pass_exception = 0; | ||
48 | if (atomic_read(&kgdb_setting_breakpoint)) | ||
49 | reason = KDB_REASON_KEYBOARD; | ||
50 | |||
51 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; i++, bp++) { | ||
52 | if ((bp->bp_enabled) && (bp->bp_addr == addr)) { | ||
53 | reason = KDB_REASON_BREAK; | ||
54 | db_result = KDB_DB_BPT; | ||
55 | if (addr != instruction_pointer(ks->linux_regs)) | ||
56 | kgdb_arch_set_pc(ks->linux_regs, addr); | ||
57 | break; | ||
58 | } | ||
59 | } | ||
60 | if (reason == KDB_REASON_BREAK || reason == KDB_REASON_SWITCH) { | ||
61 | for (i = 0, bp = kdb_breakpoints; i < KDB_MAXBPT; i++, bp++) { | ||
62 | if (bp->bp_free) | ||
63 | continue; | ||
64 | if (bp->bp_addr == addr) { | ||
65 | bp->bp_delay = 1; | ||
66 | bp->bp_delayed = 1; | ||
67 | /* | ||
68 | * SSBPT is set when the kernel debugger must single step a | ||
69 | * task in order to re-establish an instruction breakpoint | ||
70 | * which uses the instruction replacement mechanism. It is | ||
71 | * cleared by any action that removes the need to single-step | ||
72 | * the breakpoint. | ||
73 | */ | ||
74 | reason = KDB_REASON_BREAK; | ||
75 | db_result = KDB_DB_BPT; | ||
76 | KDB_STATE_SET(SSBPT); | ||
77 | break; | ||
78 | } | ||
79 | } | ||
80 | } | ||
81 | |||
82 | if (reason != KDB_REASON_BREAK && ks->ex_vector == 0 && | ||
83 | ks->signo == SIGTRAP) { | ||
84 | reason = KDB_REASON_SSTEP; | ||
85 | db_result = KDB_DB_BPT; | ||
86 | } | ||
87 | /* Set initial kdb state variables */ | ||
88 | KDB_STATE_CLEAR(KGDB_TRANS); | ||
89 | kdb_initial_cpu = ks->cpu; | ||
90 | kdb_current_task = kgdb_info[ks->cpu].task; | ||
91 | kdb_current_regs = kgdb_info[ks->cpu].debuggerinfo; | ||
92 | /* Remove any breakpoints as needed by kdb and clear single step */ | ||
93 | kdb_bp_remove(); | ||
94 | KDB_STATE_CLEAR(DOING_SS); | ||
95 | KDB_STATE_CLEAR(DOING_SSB); | ||
96 | KDB_STATE_SET(PAGER); | ||
97 | /* zero out any offline cpu data */ | ||
98 | for_each_present_cpu(i) { | ||
99 | if (!cpu_online(i)) { | ||
100 | kgdb_info[i].debuggerinfo = NULL; | ||
101 | kgdb_info[i].task = NULL; | ||
102 | } | ||
103 | } | ||
104 | if (ks->err_code == DIE_OOPS || reason == KDB_REASON_OOPS) { | ||
105 | ks->pass_exception = 1; | ||
106 | KDB_FLAG_SET(CATASTROPHIC); | ||
107 | } | ||
108 | kdb_initial_cpu = ks->cpu; | ||
109 | if (KDB_STATE(SSBPT) && reason == KDB_REASON_SSTEP) { | ||
110 | KDB_STATE_CLEAR(SSBPT); | ||
111 | KDB_STATE_CLEAR(DOING_SS); | ||
112 | } else { | ||
113 | /* Start kdb main loop */ | ||
114 | error = kdb_main_loop(KDB_REASON_ENTER, reason, | ||
115 | ks->err_code, db_result, ks->linux_regs); | ||
116 | } | ||
117 | /* | ||
118 | * Upon exit from the kdb main loop setup break points and restart | ||
119 | * the system based on the requested continue state | ||
120 | */ | ||
121 | kdb_initial_cpu = -1; | ||
122 | kdb_current_task = NULL; | ||
123 | kdb_current_regs = NULL; | ||
124 | KDB_STATE_CLEAR(PAGER); | ||
125 | kdbnearsym_cleanup(); | ||
126 | if (error == KDB_CMD_KGDB) { | ||
127 | if (KDB_STATE(DOING_KGDB) || KDB_STATE(DOING_KGDB2)) { | ||
128 | /* | ||
129 | * This inteface glue which allows kdb to transition in into | ||
130 | * the gdb stub. In order to do this the '?' or '' gdb serial | ||
131 | * packet response is processed here. And then control is | ||
132 | * passed to the gdbstub. | ||
133 | */ | ||
134 | if (KDB_STATE(DOING_KGDB)) | ||
135 | gdbstub_state(ks, "?"); | ||
136 | else | ||
137 | gdbstub_state(ks, ""); | ||
138 | KDB_STATE_CLEAR(DOING_KGDB); | ||
139 | KDB_STATE_CLEAR(DOING_KGDB2); | ||
140 | } | ||
141 | return DBG_PASS_EVENT; | ||
142 | } | ||
143 | kdb_bp_install(ks->linux_regs); | ||
144 | dbg_activate_sw_breakpoints(); | ||
145 | /* Set the exit state to a single step or a continue */ | ||
146 | if (KDB_STATE(DOING_SS)) | ||
147 | gdbstub_state(ks, "s"); | ||
148 | else | ||
149 | gdbstub_state(ks, "c"); | ||
150 | |||
151 | KDB_FLAG_CLEAR(CATASTROPHIC); | ||
152 | |||
153 | /* Invoke arch specific exception handling prior to system resume */ | ||
154 | kgdb_info[ks->cpu].ret_state = gdbstub_state(ks, "e"); | ||
155 | if (ks->pass_exception) | ||
156 | kgdb_info[ks->cpu].ret_state = 1; | ||
157 | if (error == KDB_CMD_CPU) { | ||
158 | KDB_STATE_SET(REENTRY); | ||
159 | /* | ||
160 | * Force clear the single step bit because kdb emulates this | ||
161 | * differently vs the gdbstub | ||
162 | */ | ||
163 | kgdb_single_step = 0; | ||
164 | dbg_deactivate_sw_breakpoints(); | ||
165 | return DBG_SWITCH_CPU_EVENT; | ||
166 | } | ||
167 | return kgdb_info[ks->cpu].ret_state; | ||
168 | } | ||
169 | |||
diff --git a/kernel/debug/kdb/kdb_io.c b/kernel/debug/kdb/kdb_io.c new file mode 100644 index 000000000000..c9b7f4f90bba --- /dev/null +++ b/kernel/debug/kdb/kdb_io.c | |||
@@ -0,0 +1,826 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Independent Console I/O handler | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (c) 1999-2006 Silicon Graphics, Inc. All Rights Reserved. | ||
9 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
10 | */ | ||
11 | |||
12 | #include <linux/module.h> | ||
13 | #include <linux/types.h> | ||
14 | #include <linux/ctype.h> | ||
15 | #include <linux/kernel.h> | ||
16 | #include <linux/init.h> | ||
17 | #include <linux/kdev_t.h> | ||
18 | #include <linux/console.h> | ||
19 | #include <linux/string.h> | ||
20 | #include <linux/sched.h> | ||
21 | #include <linux/smp.h> | ||
22 | #include <linux/nmi.h> | ||
23 | #include <linux/delay.h> | ||
24 | #include <linux/kgdb.h> | ||
25 | #include <linux/kdb.h> | ||
26 | #include <linux/kallsyms.h> | ||
27 | #include "kdb_private.h" | ||
28 | |||
29 | #define CMD_BUFLEN 256 | ||
30 | char kdb_prompt_str[CMD_BUFLEN]; | ||
31 | |||
32 | int kdb_trap_printk; | ||
33 | |||
34 | static void kgdb_transition_check(char *buffer) | ||
35 | { | ||
36 | int slen = strlen(buffer); | ||
37 | if (strncmp(buffer, "$?#3f", slen) != 0 && | ||
38 | strncmp(buffer, "$qSupported#37", slen) != 0 && | ||
39 | strncmp(buffer, "+$qSupported#37", slen) != 0) { | ||
40 | KDB_STATE_SET(KGDB_TRANS); | ||
41 | kdb_printf("%s", buffer); | ||
42 | } | ||
43 | } | ||
44 | |||
45 | static int kdb_read_get_key(char *buffer, size_t bufsize) | ||
46 | { | ||
47 | #define ESCAPE_UDELAY 1000 | ||
48 | #define ESCAPE_DELAY (2*1000000/ESCAPE_UDELAY) /* 2 seconds worth of udelays */ | ||
49 | char escape_data[5]; /* longest vt100 escape sequence is 4 bytes */ | ||
50 | char *ped = escape_data; | ||
51 | int escape_delay = 0; | ||
52 | get_char_func *f, *f_escape = NULL; | ||
53 | int key; | ||
54 | |||
55 | for (f = &kdb_poll_funcs[0]; ; ++f) { | ||
56 | if (*f == NULL) { | ||
57 | /* Reset NMI watchdog once per poll loop */ | ||
58 | touch_nmi_watchdog(); | ||
59 | f = &kdb_poll_funcs[0]; | ||
60 | } | ||
61 | if (escape_delay == 2) { | ||
62 | *ped = '\0'; | ||
63 | ped = escape_data; | ||
64 | --escape_delay; | ||
65 | } | ||
66 | if (escape_delay == 1) { | ||
67 | key = *ped++; | ||
68 | if (!*ped) | ||
69 | --escape_delay; | ||
70 | break; | ||
71 | } | ||
72 | key = (*f)(); | ||
73 | if (key == -1) { | ||
74 | if (escape_delay) { | ||
75 | udelay(ESCAPE_UDELAY); | ||
76 | --escape_delay; | ||
77 | } | ||
78 | continue; | ||
79 | } | ||
80 | if (bufsize <= 2) { | ||
81 | if (key == '\r') | ||
82 | key = '\n'; | ||
83 | *buffer++ = key; | ||
84 | *buffer = '\0'; | ||
85 | return -1; | ||
86 | } | ||
87 | if (escape_delay == 0 && key == '\e') { | ||
88 | escape_delay = ESCAPE_DELAY; | ||
89 | ped = escape_data; | ||
90 | f_escape = f; | ||
91 | } | ||
92 | if (escape_delay) { | ||
93 | *ped++ = key; | ||
94 | if (f_escape != f) { | ||
95 | escape_delay = 2; | ||
96 | continue; | ||
97 | } | ||
98 | if (ped - escape_data == 1) { | ||
99 | /* \e */ | ||
100 | continue; | ||
101 | } else if (ped - escape_data == 2) { | ||
102 | /* \e<something> */ | ||
103 | if (key != '[') | ||
104 | escape_delay = 2; | ||
105 | continue; | ||
106 | } else if (ped - escape_data == 3) { | ||
107 | /* \e[<something> */ | ||
108 | int mapkey = 0; | ||
109 | switch (key) { | ||
110 | case 'A': /* \e[A, up arrow */ | ||
111 | mapkey = 16; | ||
112 | break; | ||
113 | case 'B': /* \e[B, down arrow */ | ||
114 | mapkey = 14; | ||
115 | break; | ||
116 | case 'C': /* \e[C, right arrow */ | ||
117 | mapkey = 6; | ||
118 | break; | ||
119 | case 'D': /* \e[D, left arrow */ | ||
120 | mapkey = 2; | ||
121 | break; | ||
122 | case '1': /* dropthrough */ | ||
123 | case '3': /* dropthrough */ | ||
124 | /* \e[<1,3,4>], may be home, del, end */ | ||
125 | case '4': | ||
126 | mapkey = -1; | ||
127 | break; | ||
128 | } | ||
129 | if (mapkey != -1) { | ||
130 | if (mapkey > 0) { | ||
131 | escape_data[0] = mapkey; | ||
132 | escape_data[1] = '\0'; | ||
133 | } | ||
134 | escape_delay = 2; | ||
135 | } | ||
136 | continue; | ||
137 | } else if (ped - escape_data == 4) { | ||
138 | /* \e[<1,3,4><something> */ | ||
139 | int mapkey = 0; | ||
140 | if (key == '~') { | ||
141 | switch (escape_data[2]) { | ||
142 | case '1': /* \e[1~, home */ | ||
143 | mapkey = 1; | ||
144 | break; | ||
145 | case '3': /* \e[3~, del */ | ||
146 | mapkey = 4; | ||
147 | break; | ||
148 | case '4': /* \e[4~, end */ | ||
149 | mapkey = 5; | ||
150 | break; | ||
151 | } | ||
152 | } | ||
153 | if (mapkey > 0) { | ||
154 | escape_data[0] = mapkey; | ||
155 | escape_data[1] = '\0'; | ||
156 | } | ||
157 | escape_delay = 2; | ||
158 | continue; | ||
159 | } | ||
160 | } | ||
161 | break; /* A key to process */ | ||
162 | } | ||
163 | return key; | ||
164 | } | ||
165 | |||
166 | /* | ||
167 | * kdb_read | ||
168 | * | ||
169 | * This function reads a string of characters, terminated by | ||
170 | * a newline, or by reaching the end of the supplied buffer, | ||
171 | * from the current kernel debugger console device. | ||
172 | * Parameters: | ||
173 | * buffer - Address of character buffer to receive input characters. | ||
174 | * bufsize - size, in bytes, of the character buffer | ||
175 | * Returns: | ||
176 | * Returns a pointer to the buffer containing the received | ||
177 | * character string. This string will be terminated by a | ||
178 | * newline character. | ||
179 | * Locking: | ||
180 | * No locks are required to be held upon entry to this | ||
181 | * function. It is not reentrant - it relies on the fact | ||
182 | * that while kdb is running on only one "master debug" cpu. | ||
183 | * Remarks: | ||
184 | * | ||
185 | * The buffer size must be >= 2. A buffer size of 2 means that the caller only | ||
186 | * wants a single key. | ||
187 | * | ||
188 | * An escape key could be the start of a vt100 control sequence such as \e[D | ||
189 | * (left arrow) or it could be a character in its own right. The standard | ||
190 | * method for detecting the difference is to wait for 2 seconds to see if there | ||
191 | * are any other characters. kdb is complicated by the lack of a timer service | ||
192 | * (interrupts are off), by multiple input sources and by the need to sometimes | ||
193 | * return after just one key. Escape sequence processing has to be done as | ||
194 | * states in the polling loop. | ||
195 | */ | ||
196 | |||
197 | static char *kdb_read(char *buffer, size_t bufsize) | ||
198 | { | ||
199 | char *cp = buffer; | ||
200 | char *bufend = buffer+bufsize-2; /* Reserve space for newline | ||
201 | * and null byte */ | ||
202 | char *lastchar; | ||
203 | char *p_tmp; | ||
204 | char tmp; | ||
205 | static char tmpbuffer[CMD_BUFLEN]; | ||
206 | int len = strlen(buffer); | ||
207 | int len_tmp; | ||
208 | int tab = 0; | ||
209 | int count; | ||
210 | int i; | ||
211 | int diag, dtab_count; | ||
212 | int key; | ||
213 | |||
214 | |||
215 | diag = kdbgetintenv("DTABCOUNT", &dtab_count); | ||
216 | if (diag) | ||
217 | dtab_count = 30; | ||
218 | |||
219 | if (len > 0) { | ||
220 | cp += len; | ||
221 | if (*(buffer+len-1) == '\n') | ||
222 | cp--; | ||
223 | } | ||
224 | |||
225 | lastchar = cp; | ||
226 | *cp = '\0'; | ||
227 | kdb_printf("%s", buffer); | ||
228 | poll_again: | ||
229 | key = kdb_read_get_key(buffer, bufsize); | ||
230 | if (key == -1) | ||
231 | return buffer; | ||
232 | if (key != 9) | ||
233 | tab = 0; | ||
234 | switch (key) { | ||
235 | case 8: /* backspace */ | ||
236 | if (cp > buffer) { | ||
237 | if (cp < lastchar) { | ||
238 | memcpy(tmpbuffer, cp, lastchar - cp); | ||
239 | memcpy(cp-1, tmpbuffer, lastchar - cp); | ||
240 | } | ||
241 | *(--lastchar) = '\0'; | ||
242 | --cp; | ||
243 | kdb_printf("\b%s \r", cp); | ||
244 | tmp = *cp; | ||
245 | *cp = '\0'; | ||
246 | kdb_printf(kdb_prompt_str); | ||
247 | kdb_printf("%s", buffer); | ||
248 | *cp = tmp; | ||
249 | } | ||
250 | break; | ||
251 | case 13: /* enter */ | ||
252 | *lastchar++ = '\n'; | ||
253 | *lastchar++ = '\0'; | ||
254 | kdb_printf("\n"); | ||
255 | return buffer; | ||
256 | case 4: /* Del */ | ||
257 | if (cp < lastchar) { | ||
258 | memcpy(tmpbuffer, cp+1, lastchar - cp - 1); | ||
259 | memcpy(cp, tmpbuffer, lastchar - cp - 1); | ||
260 | *(--lastchar) = '\0'; | ||
261 | kdb_printf("%s \r", cp); | ||
262 | tmp = *cp; | ||
263 | *cp = '\0'; | ||
264 | kdb_printf(kdb_prompt_str); | ||
265 | kdb_printf("%s", buffer); | ||
266 | *cp = tmp; | ||
267 | } | ||
268 | break; | ||
269 | case 1: /* Home */ | ||
270 | if (cp > buffer) { | ||
271 | kdb_printf("\r"); | ||
272 | kdb_printf(kdb_prompt_str); | ||
273 | cp = buffer; | ||
274 | } | ||
275 | break; | ||
276 | case 5: /* End */ | ||
277 | if (cp < lastchar) { | ||
278 | kdb_printf("%s", cp); | ||
279 | cp = lastchar; | ||
280 | } | ||
281 | break; | ||
282 | case 2: /* Left */ | ||
283 | if (cp > buffer) { | ||
284 | kdb_printf("\b"); | ||
285 | --cp; | ||
286 | } | ||
287 | break; | ||
288 | case 14: /* Down */ | ||
289 | memset(tmpbuffer, ' ', | ||
290 | strlen(kdb_prompt_str) + (lastchar-buffer)); | ||
291 | *(tmpbuffer+strlen(kdb_prompt_str) + | ||
292 | (lastchar-buffer)) = '\0'; | ||
293 | kdb_printf("\r%s\r", tmpbuffer); | ||
294 | *lastchar = (char)key; | ||
295 | *(lastchar+1) = '\0'; | ||
296 | return lastchar; | ||
297 | case 6: /* Right */ | ||
298 | if (cp < lastchar) { | ||
299 | kdb_printf("%c", *cp); | ||
300 | ++cp; | ||
301 | } | ||
302 | break; | ||
303 | case 16: /* Up */ | ||
304 | memset(tmpbuffer, ' ', | ||
305 | strlen(kdb_prompt_str) + (lastchar-buffer)); | ||
306 | *(tmpbuffer+strlen(kdb_prompt_str) + | ||
307 | (lastchar-buffer)) = '\0'; | ||
308 | kdb_printf("\r%s\r", tmpbuffer); | ||
309 | *lastchar = (char)key; | ||
310 | *(lastchar+1) = '\0'; | ||
311 | return lastchar; | ||
312 | case 9: /* Tab */ | ||
313 | if (tab < 2) | ||
314 | ++tab; | ||
315 | p_tmp = buffer; | ||
316 | while (*p_tmp == ' ') | ||
317 | p_tmp++; | ||
318 | if (p_tmp > cp) | ||
319 | break; | ||
320 | memcpy(tmpbuffer, p_tmp, cp-p_tmp); | ||
321 | *(tmpbuffer + (cp-p_tmp)) = '\0'; | ||
322 | p_tmp = strrchr(tmpbuffer, ' '); | ||
323 | if (p_tmp) | ||
324 | ++p_tmp; | ||
325 | else | ||
326 | p_tmp = tmpbuffer; | ||
327 | len = strlen(p_tmp); | ||
328 | count = kallsyms_symbol_complete(p_tmp, | ||
329 | sizeof(tmpbuffer) - | ||
330 | (p_tmp - tmpbuffer)); | ||
331 | if (tab == 2 && count > 0) { | ||
332 | kdb_printf("\n%d symbols are found.", count); | ||
333 | if (count > dtab_count) { | ||
334 | count = dtab_count; | ||
335 | kdb_printf(" But only first %d symbols will" | ||
336 | " be printed.\nYou can change the" | ||
337 | " environment variable DTABCOUNT.", | ||
338 | count); | ||
339 | } | ||
340 | kdb_printf("\n"); | ||
341 | for (i = 0; i < count; i++) { | ||
342 | if (kallsyms_symbol_next(p_tmp, i) < 0) | ||
343 | break; | ||
344 | kdb_printf("%s ", p_tmp); | ||
345 | *(p_tmp + len) = '\0'; | ||
346 | } | ||
347 | if (i >= dtab_count) | ||
348 | kdb_printf("..."); | ||
349 | kdb_printf("\n"); | ||
350 | kdb_printf(kdb_prompt_str); | ||
351 | kdb_printf("%s", buffer); | ||
352 | } else if (tab != 2 && count > 0) { | ||
353 | len_tmp = strlen(p_tmp); | ||
354 | strncpy(p_tmp+len_tmp, cp, lastchar-cp+1); | ||
355 | len_tmp = strlen(p_tmp); | ||
356 | strncpy(cp, p_tmp+len, len_tmp-len + 1); | ||
357 | len = len_tmp - len; | ||
358 | kdb_printf("%s", cp); | ||
359 | cp += len; | ||
360 | lastchar += len; | ||
361 | } | ||
362 | kdb_nextline = 1; /* reset output line number */ | ||
363 | break; | ||
364 | default: | ||
365 | if (key >= 32 && lastchar < bufend) { | ||
366 | if (cp < lastchar) { | ||
367 | memcpy(tmpbuffer, cp, lastchar - cp); | ||
368 | memcpy(cp+1, tmpbuffer, lastchar - cp); | ||
369 | *++lastchar = '\0'; | ||
370 | *cp = key; | ||
371 | kdb_printf("%s\r", cp); | ||
372 | ++cp; | ||
373 | tmp = *cp; | ||
374 | *cp = '\0'; | ||
375 | kdb_printf(kdb_prompt_str); | ||
376 | kdb_printf("%s", buffer); | ||
377 | *cp = tmp; | ||
378 | } else { | ||
379 | *++lastchar = '\0'; | ||
380 | *cp++ = key; | ||
381 | /* The kgdb transition check will hide | ||
382 | * printed characters if we think that | ||
383 | * kgdb is connecting, until the check | ||
384 | * fails */ | ||
385 | if (!KDB_STATE(KGDB_TRANS)) | ||
386 | kgdb_transition_check(buffer); | ||
387 | else | ||
388 | kdb_printf("%c", key); | ||
389 | } | ||
390 | /* Special escape to kgdb */ | ||
391 | if (lastchar - buffer >= 5 && | ||
392 | strcmp(lastchar - 5, "$?#3f") == 0) { | ||
393 | strcpy(buffer, "kgdb"); | ||
394 | KDB_STATE_SET(DOING_KGDB); | ||
395 | return buffer; | ||
396 | } | ||
397 | if (lastchar - buffer >= 14 && | ||
398 | strcmp(lastchar - 14, "$qSupported#37") == 0) { | ||
399 | strcpy(buffer, "kgdb"); | ||
400 | KDB_STATE_SET(DOING_KGDB2); | ||
401 | return buffer; | ||
402 | } | ||
403 | } | ||
404 | break; | ||
405 | } | ||
406 | goto poll_again; | ||
407 | } | ||
408 | |||
409 | /* | ||
410 | * kdb_getstr | ||
411 | * | ||
412 | * Print the prompt string and read a command from the | ||
413 | * input device. | ||
414 | * | ||
415 | * Parameters: | ||
416 | * buffer Address of buffer to receive command | ||
417 | * bufsize Size of buffer in bytes | ||
418 | * prompt Pointer to string to use as prompt string | ||
419 | * Returns: | ||
420 | * Pointer to command buffer. | ||
421 | * Locking: | ||
422 | * None. | ||
423 | * Remarks: | ||
424 | * For SMP kernels, the processor number will be | ||
425 | * substituted for %d, %x or %o in the prompt. | ||
426 | */ | ||
427 | |||
428 | char *kdb_getstr(char *buffer, size_t bufsize, char *prompt) | ||
429 | { | ||
430 | if (prompt && kdb_prompt_str != prompt) | ||
431 | strncpy(kdb_prompt_str, prompt, CMD_BUFLEN); | ||
432 | kdb_printf(kdb_prompt_str); | ||
433 | kdb_nextline = 1; /* Prompt and input resets line number */ | ||
434 | return kdb_read(buffer, bufsize); | ||
435 | } | ||
436 | |||
437 | /* | ||
438 | * kdb_input_flush | ||
439 | * | ||
440 | * Get rid of any buffered console input. | ||
441 | * | ||
442 | * Parameters: | ||
443 | * none | ||
444 | * Returns: | ||
445 | * nothing | ||
446 | * Locking: | ||
447 | * none | ||
448 | * Remarks: | ||
449 | * Call this function whenever you want to flush input. If there is any | ||
450 | * outstanding input, it ignores all characters until there has been no | ||
451 | * data for approximately 1ms. | ||
452 | */ | ||
453 | |||
454 | static void kdb_input_flush(void) | ||
455 | { | ||
456 | get_char_func *f; | ||
457 | int res; | ||
458 | int flush_delay = 1; | ||
459 | while (flush_delay) { | ||
460 | flush_delay--; | ||
461 | empty: | ||
462 | touch_nmi_watchdog(); | ||
463 | for (f = &kdb_poll_funcs[0]; *f; ++f) { | ||
464 | res = (*f)(); | ||
465 | if (res != -1) { | ||
466 | flush_delay = 1; | ||
467 | goto empty; | ||
468 | } | ||
469 | } | ||
470 | if (flush_delay) | ||
471 | mdelay(1); | ||
472 | } | ||
473 | } | ||
474 | |||
475 | /* | ||
476 | * kdb_printf | ||
477 | * | ||
478 | * Print a string to the output device(s). | ||
479 | * | ||
480 | * Parameters: | ||
481 | * printf-like format and optional args. | ||
482 | * Returns: | ||
483 | * 0 | ||
484 | * Locking: | ||
485 | * None. | ||
486 | * Remarks: | ||
487 | * use 'kdbcons->write()' to avoid polluting 'log_buf' with | ||
488 | * kdb output. | ||
489 | * | ||
490 | * If the user is doing a cmd args | grep srch | ||
491 | * then kdb_grepping_flag is set. | ||
492 | * In that case we need to accumulate full lines (ending in \n) before | ||
493 | * searching for the pattern. | ||
494 | */ | ||
495 | |||
496 | static char kdb_buffer[256]; /* A bit too big to go on stack */ | ||
497 | static char *next_avail = kdb_buffer; | ||
498 | static int size_avail; | ||
499 | static int suspend_grep; | ||
500 | |||
501 | /* | ||
502 | * search arg1 to see if it contains arg2 | ||
503 | * (kdmain.c provides flags for ^pat and pat$) | ||
504 | * | ||
505 | * return 1 for found, 0 for not found | ||
506 | */ | ||
507 | static int kdb_search_string(char *searched, char *searchfor) | ||
508 | { | ||
509 | char firstchar, *cp; | ||
510 | int len1, len2; | ||
511 | |||
512 | /* not counting the newline at the end of "searched" */ | ||
513 | len1 = strlen(searched)-1; | ||
514 | len2 = strlen(searchfor); | ||
515 | if (len1 < len2) | ||
516 | return 0; | ||
517 | if (kdb_grep_leading && kdb_grep_trailing && len1 != len2) | ||
518 | return 0; | ||
519 | if (kdb_grep_leading) { | ||
520 | if (!strncmp(searched, searchfor, len2)) | ||
521 | return 1; | ||
522 | } else if (kdb_grep_trailing) { | ||
523 | if (!strncmp(searched+len1-len2, searchfor, len2)) | ||
524 | return 1; | ||
525 | } else { | ||
526 | firstchar = *searchfor; | ||
527 | cp = searched; | ||
528 | while ((cp = strchr(cp, firstchar))) { | ||
529 | if (!strncmp(cp, searchfor, len2)) | ||
530 | return 1; | ||
531 | cp++; | ||
532 | } | ||
533 | } | ||
534 | return 0; | ||
535 | } | ||
536 | |||
537 | int vkdb_printf(const char *fmt, va_list ap) | ||
538 | { | ||
539 | int diag; | ||
540 | int linecount; | ||
541 | int logging, saved_loglevel = 0; | ||
542 | int saved_trap_printk; | ||
543 | int got_printf_lock = 0; | ||
544 | int retlen = 0; | ||
545 | int fnd, len; | ||
546 | char *cp, *cp2, *cphold = NULL, replaced_byte = ' '; | ||
547 | char *moreprompt = "more> "; | ||
548 | struct console *c = console_drivers; | ||
549 | static DEFINE_SPINLOCK(kdb_printf_lock); | ||
550 | unsigned long uninitialized_var(flags); | ||
551 | |||
552 | preempt_disable(); | ||
553 | saved_trap_printk = kdb_trap_printk; | ||
554 | kdb_trap_printk = 0; | ||
555 | |||
556 | /* Serialize kdb_printf if multiple cpus try to write at once. | ||
557 | * But if any cpu goes recursive in kdb, just print the output, | ||
558 | * even if it is interleaved with any other text. | ||
559 | */ | ||
560 | if (!KDB_STATE(PRINTF_LOCK)) { | ||
561 | KDB_STATE_SET(PRINTF_LOCK); | ||
562 | spin_lock_irqsave(&kdb_printf_lock, flags); | ||
563 | got_printf_lock = 1; | ||
564 | atomic_inc(&kdb_event); | ||
565 | } else { | ||
566 | __acquire(kdb_printf_lock); | ||
567 | } | ||
568 | |||
569 | diag = kdbgetintenv("LINES", &linecount); | ||
570 | if (diag || linecount <= 1) | ||
571 | linecount = 24; | ||
572 | |||
573 | diag = kdbgetintenv("LOGGING", &logging); | ||
574 | if (diag) | ||
575 | logging = 0; | ||
576 | |||
577 | if (!kdb_grepping_flag || suspend_grep) { | ||
578 | /* normally, every vsnprintf starts a new buffer */ | ||
579 | next_avail = kdb_buffer; | ||
580 | size_avail = sizeof(kdb_buffer); | ||
581 | } | ||
582 | vsnprintf(next_avail, size_avail, fmt, ap); | ||
583 | |||
584 | /* | ||
585 | * If kdb_parse() found that the command was cmd xxx | grep yyy | ||
586 | * then kdb_grepping_flag is set, and kdb_grep_string contains yyy | ||
587 | * | ||
588 | * Accumulate the print data up to a newline before searching it. | ||
589 | * (vsnprintf does null-terminate the string that it generates) | ||
590 | */ | ||
591 | |||
592 | /* skip the search if prints are temporarily unconditional */ | ||
593 | if (!suspend_grep && kdb_grepping_flag) { | ||
594 | cp = strchr(kdb_buffer, '\n'); | ||
595 | if (!cp) { | ||
596 | /* | ||
597 | * Special cases that don't end with newlines | ||
598 | * but should be written without one: | ||
599 | * The "[nn]kdb> " prompt should | ||
600 | * appear at the front of the buffer. | ||
601 | * | ||
602 | * The "[nn]more " prompt should also be | ||
603 | * (MOREPROMPT -> moreprompt) | ||
604 | * written * but we print that ourselves, | ||
605 | * we set the suspend_grep flag to make | ||
606 | * it unconditional. | ||
607 | * | ||
608 | */ | ||
609 | if (next_avail == kdb_buffer) { | ||
610 | /* | ||
611 | * these should occur after a newline, | ||
612 | * so they will be at the front of the | ||
613 | * buffer | ||
614 | */ | ||
615 | cp2 = kdb_buffer; | ||
616 | len = strlen(kdb_prompt_str); | ||
617 | if (!strncmp(cp2, kdb_prompt_str, len)) { | ||
618 | /* | ||
619 | * We're about to start a new | ||
620 | * command, so we can go back | ||
621 | * to normal mode. | ||
622 | */ | ||
623 | kdb_grepping_flag = 0; | ||
624 | goto kdb_printit; | ||
625 | } | ||
626 | } | ||
627 | /* no newline; don't search/write the buffer | ||
628 | until one is there */ | ||
629 | len = strlen(kdb_buffer); | ||
630 | next_avail = kdb_buffer + len; | ||
631 | size_avail = sizeof(kdb_buffer) - len; | ||
632 | goto kdb_print_out; | ||
633 | } | ||
634 | |||
635 | /* | ||
636 | * The newline is present; print through it or discard | ||
637 | * it, depending on the results of the search. | ||
638 | */ | ||
639 | cp++; /* to byte after the newline */ | ||
640 | replaced_byte = *cp; /* remember what/where it was */ | ||
641 | cphold = cp; | ||
642 | *cp = '\0'; /* end the string for our search */ | ||
643 | |||
644 | /* | ||
645 | * We now have a newline at the end of the string | ||
646 | * Only continue with this output if it contains the | ||
647 | * search string. | ||
648 | */ | ||
649 | fnd = kdb_search_string(kdb_buffer, kdb_grep_string); | ||
650 | if (!fnd) { | ||
651 | /* | ||
652 | * At this point the complete line at the start | ||
653 | * of kdb_buffer can be discarded, as it does | ||
654 | * not contain what the user is looking for. | ||
655 | * Shift the buffer left. | ||
656 | */ | ||
657 | *cphold = replaced_byte; | ||
658 | strcpy(kdb_buffer, cphold); | ||
659 | len = strlen(kdb_buffer); | ||
660 | next_avail = kdb_buffer + len; | ||
661 | size_avail = sizeof(kdb_buffer) - len; | ||
662 | goto kdb_print_out; | ||
663 | } | ||
664 | /* | ||
665 | * at this point the string is a full line and | ||
666 | * should be printed, up to the null. | ||
667 | */ | ||
668 | } | ||
669 | kdb_printit: | ||
670 | |||
671 | /* | ||
672 | * Write to all consoles. | ||
673 | */ | ||
674 | retlen = strlen(kdb_buffer); | ||
675 | if (!dbg_kdb_mode && kgdb_connected) { | ||
676 | gdbstub_msg_write(kdb_buffer, retlen); | ||
677 | } else { | ||
678 | if (!dbg_io_ops->is_console) { | ||
679 | len = strlen(kdb_buffer); | ||
680 | cp = kdb_buffer; | ||
681 | while (len--) { | ||
682 | dbg_io_ops->write_char(*cp); | ||
683 | cp++; | ||
684 | } | ||
685 | } | ||
686 | while (c) { | ||
687 | c->write(c, kdb_buffer, retlen); | ||
688 | touch_nmi_watchdog(); | ||
689 | c = c->next; | ||
690 | } | ||
691 | } | ||
692 | if (logging) { | ||
693 | saved_loglevel = console_loglevel; | ||
694 | console_loglevel = 0; | ||
695 | printk(KERN_INFO "%s", kdb_buffer); | ||
696 | } | ||
697 | |||
698 | if (KDB_STATE(PAGER) && strchr(kdb_buffer, '\n')) | ||
699 | kdb_nextline++; | ||
700 | |||
701 | /* check for having reached the LINES number of printed lines */ | ||
702 | if (kdb_nextline == linecount) { | ||
703 | char buf1[16] = ""; | ||
704 | #if defined(CONFIG_SMP) | ||
705 | char buf2[32]; | ||
706 | #endif | ||
707 | |||
708 | /* Watch out for recursion here. Any routine that calls | ||
709 | * kdb_printf will come back through here. And kdb_read | ||
710 | * uses kdb_printf to echo on serial consoles ... | ||
711 | */ | ||
712 | kdb_nextline = 1; /* In case of recursion */ | ||
713 | |||
714 | /* | ||
715 | * Pause until cr. | ||
716 | */ | ||
717 | moreprompt = kdbgetenv("MOREPROMPT"); | ||
718 | if (moreprompt == NULL) | ||
719 | moreprompt = "more> "; | ||
720 | |||
721 | #if defined(CONFIG_SMP) | ||
722 | if (strchr(moreprompt, '%')) { | ||
723 | sprintf(buf2, moreprompt, get_cpu()); | ||
724 | put_cpu(); | ||
725 | moreprompt = buf2; | ||
726 | } | ||
727 | #endif | ||
728 | |||
729 | kdb_input_flush(); | ||
730 | c = console_drivers; | ||
731 | |||
732 | if (!dbg_io_ops->is_console) { | ||
733 | len = strlen(moreprompt); | ||
734 | cp = moreprompt; | ||
735 | while (len--) { | ||
736 | dbg_io_ops->write_char(*cp); | ||
737 | cp++; | ||
738 | } | ||
739 | } | ||
740 | while (c) { | ||
741 | c->write(c, moreprompt, strlen(moreprompt)); | ||
742 | touch_nmi_watchdog(); | ||
743 | c = c->next; | ||
744 | } | ||
745 | |||
746 | if (logging) | ||
747 | printk("%s", moreprompt); | ||
748 | |||
749 | kdb_read(buf1, 2); /* '2' indicates to return | ||
750 | * immediately after getting one key. */ | ||
751 | kdb_nextline = 1; /* Really set output line 1 */ | ||
752 | |||
753 | /* empty and reset the buffer: */ | ||
754 | kdb_buffer[0] = '\0'; | ||
755 | next_avail = kdb_buffer; | ||
756 | size_avail = sizeof(kdb_buffer); | ||
757 | if ((buf1[0] == 'q') || (buf1[0] == 'Q')) { | ||
758 | /* user hit q or Q */ | ||
759 | KDB_FLAG_SET(CMD_INTERRUPT); /* command interrupted */ | ||
760 | KDB_STATE_CLEAR(PAGER); | ||
761 | /* end of command output; back to normal mode */ | ||
762 | kdb_grepping_flag = 0; | ||
763 | kdb_printf("\n"); | ||
764 | } else if (buf1[0] == ' ') { | ||
765 | kdb_printf("\n"); | ||
766 | suspend_grep = 1; /* for this recursion */ | ||
767 | } else if (buf1[0] == '\n') { | ||
768 | kdb_nextline = linecount - 1; | ||
769 | kdb_printf("\r"); | ||
770 | suspend_grep = 1; /* for this recursion */ | ||
771 | } else if (buf1[0] && buf1[0] != '\n') { | ||
772 | /* user hit something other than enter */ | ||
773 | suspend_grep = 1; /* for this recursion */ | ||
774 | kdb_printf("\nOnly 'q' or 'Q' are processed at more " | ||
775 | "prompt, input ignored\n"); | ||
776 | } else if (kdb_grepping_flag) { | ||
777 | /* user hit enter */ | ||
778 | suspend_grep = 1; /* for this recursion */ | ||
779 | kdb_printf("\n"); | ||
780 | } | ||
781 | kdb_input_flush(); | ||
782 | } | ||
783 | |||
784 | /* | ||
785 | * For grep searches, shift the printed string left. | ||
786 | * replaced_byte contains the character that was overwritten with | ||
787 | * the terminating null, and cphold points to the null. | ||
788 | * Then adjust the notion of available space in the buffer. | ||
789 | */ | ||
790 | if (kdb_grepping_flag && !suspend_grep) { | ||
791 | *cphold = replaced_byte; | ||
792 | strcpy(kdb_buffer, cphold); | ||
793 | len = strlen(kdb_buffer); | ||
794 | next_avail = kdb_buffer + len; | ||
795 | size_avail = sizeof(kdb_buffer) - len; | ||
796 | } | ||
797 | |||
798 | kdb_print_out: | ||
799 | suspend_grep = 0; /* end of what may have been a recursive call */ | ||
800 | if (logging) | ||
801 | console_loglevel = saved_loglevel; | ||
802 | if (KDB_STATE(PRINTF_LOCK) && got_printf_lock) { | ||
803 | got_printf_lock = 0; | ||
804 | spin_unlock_irqrestore(&kdb_printf_lock, flags); | ||
805 | KDB_STATE_CLEAR(PRINTF_LOCK); | ||
806 | atomic_dec(&kdb_event); | ||
807 | } else { | ||
808 | __release(kdb_printf_lock); | ||
809 | } | ||
810 | kdb_trap_printk = saved_trap_printk; | ||
811 | preempt_enable(); | ||
812 | return retlen; | ||
813 | } | ||
814 | |||
815 | int kdb_printf(const char *fmt, ...) | ||
816 | { | ||
817 | va_list ap; | ||
818 | int r; | ||
819 | |||
820 | va_start(ap, fmt); | ||
821 | r = vkdb_printf(fmt, ap); | ||
822 | va_end(ap); | ||
823 | |||
824 | return r; | ||
825 | } | ||
826 | |||
diff --git a/kernel/debug/kdb/kdb_keyboard.c b/kernel/debug/kdb/kdb_keyboard.c new file mode 100644 index 000000000000..4bca634975c0 --- /dev/null +++ b/kernel/debug/kdb/kdb_keyboard.c | |||
@@ -0,0 +1,212 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Dependent Console I/O handler | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. | ||
6 | * | ||
7 | * Copyright (c) 1999-2006 Silicon Graphics, Inc. All Rights Reserved. | ||
8 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
9 | */ | ||
10 | |||
11 | #include <linux/kdb.h> | ||
12 | #include <linux/keyboard.h> | ||
13 | #include <linux/ctype.h> | ||
14 | #include <linux/module.h> | ||
15 | #include <linux/io.h> | ||
16 | |||
17 | /* Keyboard Controller Registers on normal PCs. */ | ||
18 | |||
19 | #define KBD_STATUS_REG 0x64 /* Status register (R) */ | ||
20 | #define KBD_DATA_REG 0x60 /* Keyboard data register (R/W) */ | ||
21 | |||
22 | /* Status Register Bits */ | ||
23 | |||
24 | #define KBD_STAT_OBF 0x01 /* Keyboard output buffer full */ | ||
25 | #define KBD_STAT_MOUSE_OBF 0x20 /* Mouse output buffer full */ | ||
26 | |||
27 | static int kbd_exists; | ||
28 | |||
29 | /* | ||
30 | * Check if the keyboard controller has a keypress for us. | ||
31 | * Some parts (Enter Release, LED change) are still blocking polled here, | ||
32 | * but hopefully they are all short. | ||
33 | */ | ||
34 | int kdb_get_kbd_char(void) | ||
35 | { | ||
36 | int scancode, scanstatus; | ||
37 | static int shift_lock; /* CAPS LOCK state (0-off, 1-on) */ | ||
38 | static int shift_key; /* Shift next keypress */ | ||
39 | static int ctrl_key; | ||
40 | u_short keychar; | ||
41 | |||
42 | if (KDB_FLAG(NO_I8042) || KDB_FLAG(NO_VT_CONSOLE) || | ||
43 | (inb(KBD_STATUS_REG) == 0xff && inb(KBD_DATA_REG) == 0xff)) { | ||
44 | kbd_exists = 0; | ||
45 | return -1; | ||
46 | } | ||
47 | kbd_exists = 1; | ||
48 | |||
49 | if ((inb(KBD_STATUS_REG) & KBD_STAT_OBF) == 0) | ||
50 | return -1; | ||
51 | |||
52 | /* | ||
53 | * Fetch the scancode | ||
54 | */ | ||
55 | scancode = inb(KBD_DATA_REG); | ||
56 | scanstatus = inb(KBD_STATUS_REG); | ||
57 | |||
58 | /* | ||
59 | * Ignore mouse events. | ||
60 | */ | ||
61 | if (scanstatus & KBD_STAT_MOUSE_OBF) | ||
62 | return -1; | ||
63 | |||
64 | /* | ||
65 | * Ignore release, trigger on make | ||
66 | * (except for shift keys, where we want to | ||
67 | * keep the shift state so long as the key is | ||
68 | * held down). | ||
69 | */ | ||
70 | |||
71 | if (((scancode&0x7f) == 0x2a) || ((scancode&0x7f) == 0x36)) { | ||
72 | /* | ||
73 | * Next key may use shift table | ||
74 | */ | ||
75 | if ((scancode & 0x80) == 0) | ||
76 | shift_key = 1; | ||
77 | else | ||
78 | shift_key = 0; | ||
79 | return -1; | ||
80 | } | ||
81 | |||
82 | if ((scancode&0x7f) == 0x1d) { | ||
83 | /* | ||
84 | * Left ctrl key | ||
85 | */ | ||
86 | if ((scancode & 0x80) == 0) | ||
87 | ctrl_key = 1; | ||
88 | else | ||
89 | ctrl_key = 0; | ||
90 | return -1; | ||
91 | } | ||
92 | |||
93 | if ((scancode & 0x80) != 0) | ||
94 | return -1; | ||
95 | |||
96 | scancode &= 0x7f; | ||
97 | |||
98 | /* | ||
99 | * Translate scancode | ||
100 | */ | ||
101 | |||
102 | if (scancode == 0x3a) { | ||
103 | /* | ||
104 | * Toggle caps lock | ||
105 | */ | ||
106 | shift_lock ^= 1; | ||
107 | |||
108 | #ifdef KDB_BLINK_LED | ||
109 | kdb_toggleled(0x4); | ||
110 | #endif | ||
111 | return -1; | ||
112 | } | ||
113 | |||
114 | if (scancode == 0x0e) { | ||
115 | /* | ||
116 | * Backspace | ||
117 | */ | ||
118 | return 8; | ||
119 | } | ||
120 | |||
121 | /* Special Key */ | ||
122 | switch (scancode) { | ||
123 | case 0xF: /* Tab */ | ||
124 | return 9; | ||
125 | case 0x53: /* Del */ | ||
126 | return 4; | ||
127 | case 0x47: /* Home */ | ||
128 | return 1; | ||
129 | case 0x4F: /* End */ | ||
130 | return 5; | ||
131 | case 0x4B: /* Left */ | ||
132 | return 2; | ||
133 | case 0x48: /* Up */ | ||
134 | return 16; | ||
135 | case 0x50: /* Down */ | ||
136 | return 14; | ||
137 | case 0x4D: /* Right */ | ||
138 | return 6; | ||
139 | } | ||
140 | |||
141 | if (scancode == 0xe0) | ||
142 | return -1; | ||
143 | |||
144 | /* | ||
145 | * For Japanese 86/106 keyboards | ||
146 | * See comment in drivers/char/pc_keyb.c. | ||
147 | * - Masahiro Adegawa | ||
148 | */ | ||
149 | if (scancode == 0x73) | ||
150 | scancode = 0x59; | ||
151 | else if (scancode == 0x7d) | ||
152 | scancode = 0x7c; | ||
153 | |||
154 | if (!shift_lock && !shift_key && !ctrl_key) { | ||
155 | keychar = plain_map[scancode]; | ||
156 | } else if ((shift_lock || shift_key) && key_maps[1]) { | ||
157 | keychar = key_maps[1][scancode]; | ||
158 | } else if (ctrl_key && key_maps[4]) { | ||
159 | keychar = key_maps[4][scancode]; | ||
160 | } else { | ||
161 | keychar = 0x0020; | ||
162 | kdb_printf("Unknown state/scancode (%d)\n", scancode); | ||
163 | } | ||
164 | keychar &= 0x0fff; | ||
165 | if (keychar == '\t') | ||
166 | keychar = ' '; | ||
167 | switch (KTYP(keychar)) { | ||
168 | case KT_LETTER: | ||
169 | case KT_LATIN: | ||
170 | if (isprint(keychar)) | ||
171 | break; /* printable characters */ | ||
172 | /* drop through */ | ||
173 | case KT_SPEC: | ||
174 | if (keychar == K_ENTER) | ||
175 | break; | ||
176 | /* drop through */ | ||
177 | default: | ||
178 | return -1; /* ignore unprintables */ | ||
179 | } | ||
180 | |||
181 | if ((scancode & 0x7f) == 0x1c) { | ||
182 | /* | ||
183 | * enter key. All done. Absorb the release scancode. | ||
184 | */ | ||
185 | while ((inb(KBD_STATUS_REG) & KBD_STAT_OBF) == 0) | ||
186 | ; | ||
187 | |||
188 | /* | ||
189 | * Fetch the scancode | ||
190 | */ | ||
191 | scancode = inb(KBD_DATA_REG); | ||
192 | scanstatus = inb(KBD_STATUS_REG); | ||
193 | |||
194 | while (scanstatus & KBD_STAT_MOUSE_OBF) { | ||
195 | scancode = inb(KBD_DATA_REG); | ||
196 | scanstatus = inb(KBD_STATUS_REG); | ||
197 | } | ||
198 | |||
199 | if (scancode != 0x9c) { | ||
200 | /* | ||
201 | * Wasn't an enter-release, why not? | ||
202 | */ | ||
203 | kdb_printf("kdb: expected enter got 0x%x status 0x%x\n", | ||
204 | scancode, scanstatus); | ||
205 | } | ||
206 | |||
207 | return 13; | ||
208 | } | ||
209 | |||
210 | return keychar & 0xff; | ||
211 | } | ||
212 | EXPORT_SYMBOL_GPL(kdb_get_kbd_char); | ||
diff --git a/kernel/debug/kdb/kdb_main.c b/kernel/debug/kdb/kdb_main.c new file mode 100644 index 000000000000..caf057a3de0e --- /dev/null +++ b/kernel/debug/kdb/kdb_main.c | |||
@@ -0,0 +1,2956 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Independent Main Code | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (C) 1999-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
9 | * Copyright (C) 2000 Stephane Eranian <eranian@hpl.hp.com> | ||
10 | * Xscale (R) modifications copyright (C) 2003 Intel Corporation. | ||
11 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
12 | */ | ||
13 | |||
14 | #include <linux/ctype.h> | ||
15 | #include <linux/string.h> | ||
16 | #include <linux/kernel.h> | ||
17 | #include <linux/reboot.h> | ||
18 | #include <linux/sched.h> | ||
19 | #include <linux/sysrq.h> | ||
20 | #include <linux/smp.h> | ||
21 | #include <linux/utsname.h> | ||
22 | #include <linux/vmalloc.h> | ||
23 | #include <linux/module.h> | ||
24 | #include <linux/mm.h> | ||
25 | #include <linux/init.h> | ||
26 | #include <linux/kallsyms.h> | ||
27 | #include <linux/kgdb.h> | ||
28 | #include <linux/kdb.h> | ||
29 | #include <linux/notifier.h> | ||
30 | #include <linux/interrupt.h> | ||
31 | #include <linux/delay.h> | ||
32 | #include <linux/nmi.h> | ||
33 | #include <linux/time.h> | ||
34 | #include <linux/ptrace.h> | ||
35 | #include <linux/sysctl.h> | ||
36 | #include <linux/cpu.h> | ||
37 | #include <linux/kdebug.h> | ||
38 | #include <linux/proc_fs.h> | ||
39 | #include <linux/uaccess.h> | ||
40 | #include <linux/slab.h> | ||
41 | #include "kdb_private.h" | ||
42 | |||
43 | #define GREP_LEN 256 | ||
44 | char kdb_grep_string[GREP_LEN]; | ||
45 | int kdb_grepping_flag; | ||
46 | EXPORT_SYMBOL(kdb_grepping_flag); | ||
47 | int kdb_grep_leading; | ||
48 | int kdb_grep_trailing; | ||
49 | |||
50 | /* | ||
51 | * Kernel debugger state flags | ||
52 | */ | ||
53 | int kdb_flags; | ||
54 | atomic_t kdb_event; | ||
55 | |||
56 | /* | ||
57 | * kdb_lock protects updates to kdb_initial_cpu. Used to | ||
58 | * single thread processors through the kernel debugger. | ||
59 | */ | ||
60 | int kdb_initial_cpu = -1; /* cpu number that owns kdb */ | ||
61 | int kdb_nextline = 1; | ||
62 | int kdb_state; /* General KDB state */ | ||
63 | |||
64 | struct task_struct *kdb_current_task; | ||
65 | EXPORT_SYMBOL(kdb_current_task); | ||
66 | struct pt_regs *kdb_current_regs; | ||
67 | |||
68 | const char *kdb_diemsg; | ||
69 | static int kdb_go_count; | ||
70 | #ifdef CONFIG_KDB_CONTINUE_CATASTROPHIC | ||
71 | static unsigned int kdb_continue_catastrophic = | ||
72 | CONFIG_KDB_CONTINUE_CATASTROPHIC; | ||
73 | #else | ||
74 | static unsigned int kdb_continue_catastrophic; | ||
75 | #endif | ||
76 | |||
77 | /* kdb_commands describes the available commands. */ | ||
78 | static kdbtab_t *kdb_commands; | ||
79 | #define KDB_BASE_CMD_MAX 50 | ||
80 | static int kdb_max_commands = KDB_BASE_CMD_MAX; | ||
81 | static kdbtab_t kdb_base_commands[50]; | ||
82 | #define for_each_kdbcmd(cmd, num) \ | ||
83 | for ((cmd) = kdb_base_commands, (num) = 0; \ | ||
84 | num < kdb_max_commands; \ | ||
85 | num == KDB_BASE_CMD_MAX ? cmd = kdb_commands : cmd++, num++) | ||
86 | |||
87 | typedef struct _kdbmsg { | ||
88 | int km_diag; /* kdb diagnostic */ | ||
89 | char *km_msg; /* Corresponding message text */ | ||
90 | } kdbmsg_t; | ||
91 | |||
92 | #define KDBMSG(msgnum, text) \ | ||
93 | { KDB_##msgnum, text } | ||
94 | |||
95 | static kdbmsg_t kdbmsgs[] = { | ||
96 | KDBMSG(NOTFOUND, "Command Not Found"), | ||
97 | KDBMSG(ARGCOUNT, "Improper argument count, see usage."), | ||
98 | KDBMSG(BADWIDTH, "Illegal value for BYTESPERWORD use 1, 2, 4 or 8, " | ||
99 | "8 is only allowed on 64 bit systems"), | ||
100 | KDBMSG(BADRADIX, "Illegal value for RADIX use 8, 10 or 16"), | ||
101 | KDBMSG(NOTENV, "Cannot find environment variable"), | ||
102 | KDBMSG(NOENVVALUE, "Environment variable should have value"), | ||
103 | KDBMSG(NOTIMP, "Command not implemented"), | ||
104 | KDBMSG(ENVFULL, "Environment full"), | ||
105 | KDBMSG(ENVBUFFULL, "Environment buffer full"), | ||
106 | KDBMSG(TOOMANYBPT, "Too many breakpoints defined"), | ||
107 | #ifdef CONFIG_CPU_XSCALE | ||
108 | KDBMSG(TOOMANYDBREGS, "More breakpoints than ibcr registers defined"), | ||
109 | #else | ||
110 | KDBMSG(TOOMANYDBREGS, "More breakpoints than db registers defined"), | ||
111 | #endif | ||
112 | KDBMSG(DUPBPT, "Duplicate breakpoint address"), | ||
113 | KDBMSG(BPTNOTFOUND, "Breakpoint not found"), | ||
114 | KDBMSG(BADMODE, "Invalid IDMODE"), | ||
115 | KDBMSG(BADINT, "Illegal numeric value"), | ||
116 | KDBMSG(INVADDRFMT, "Invalid symbolic address format"), | ||
117 | KDBMSG(BADREG, "Invalid register name"), | ||
118 | KDBMSG(BADCPUNUM, "Invalid cpu number"), | ||
119 | KDBMSG(BADLENGTH, "Invalid length field"), | ||
120 | KDBMSG(NOBP, "No Breakpoint exists"), | ||
121 | KDBMSG(BADADDR, "Invalid address"), | ||
122 | }; | ||
123 | #undef KDBMSG | ||
124 | |||
125 | static const int __nkdb_err = sizeof(kdbmsgs) / sizeof(kdbmsg_t); | ||
126 | |||
127 | |||
128 | /* | ||
129 | * Initial environment. This is all kept static and local to | ||
130 | * this file. We don't want to rely on the memory allocation | ||
131 | * mechanisms in the kernel, so we use a very limited allocate-only | ||
132 | * heap for new and altered environment variables. The entire | ||
133 | * environment is limited to a fixed number of entries (add more | ||
134 | * to __env[] if required) and a fixed amount of heap (add more to | ||
135 | * KDB_ENVBUFSIZE if required). | ||
136 | */ | ||
137 | |||
138 | static char *__env[] = { | ||
139 | #if defined(CONFIG_SMP) | ||
140 | "PROMPT=[%d]kdb> ", | ||
141 | "MOREPROMPT=[%d]more> ", | ||
142 | #else | ||
143 | "PROMPT=kdb> ", | ||
144 | "MOREPROMPT=more> ", | ||
145 | #endif | ||
146 | "RADIX=16", | ||
147 | "MDCOUNT=8", /* lines of md output */ | ||
148 | "BTARGS=9", /* 9 possible args in bt */ | ||
149 | KDB_PLATFORM_ENV, | ||
150 | "DTABCOUNT=30", | ||
151 | "NOSECT=1", | ||
152 | (char *)0, | ||
153 | (char *)0, | ||
154 | (char *)0, | ||
155 | (char *)0, | ||
156 | (char *)0, | ||
157 | (char *)0, | ||
158 | (char *)0, | ||
159 | (char *)0, | ||
160 | (char *)0, | ||
161 | (char *)0, | ||
162 | (char *)0, | ||
163 | (char *)0, | ||
164 | (char *)0, | ||
165 | (char *)0, | ||
166 | (char *)0, | ||
167 | (char *)0, | ||
168 | (char *)0, | ||
169 | (char *)0, | ||
170 | (char *)0, | ||
171 | (char *)0, | ||
172 | (char *)0, | ||
173 | (char *)0, | ||
174 | (char *)0, | ||
175 | }; | ||
176 | |||
177 | static const int __nenv = (sizeof(__env) / sizeof(char *)); | ||
178 | |||
179 | struct task_struct *kdb_curr_task(int cpu) | ||
180 | { | ||
181 | struct task_struct *p = curr_task(cpu); | ||
182 | #ifdef _TIF_MCA_INIT | ||
183 | if ((task_thread_info(p)->flags & _TIF_MCA_INIT) && KDB_TSK(cpu)) | ||
184 | p = krp->p; | ||
185 | #endif | ||
186 | return p; | ||
187 | } | ||
188 | |||
189 | /* | ||
190 | * kdbgetenv - This function will return the character string value of | ||
191 | * an environment variable. | ||
192 | * Parameters: | ||
193 | * match A character string representing an environment variable. | ||
194 | * Returns: | ||
195 | * NULL No environment variable matches 'match' | ||
196 | * char* Pointer to string value of environment variable. | ||
197 | */ | ||
198 | char *kdbgetenv(const char *match) | ||
199 | { | ||
200 | char **ep = __env; | ||
201 | int matchlen = strlen(match); | ||
202 | int i; | ||
203 | |||
204 | for (i = 0; i < __nenv; i++) { | ||
205 | char *e = *ep++; | ||
206 | |||
207 | if (!e) | ||
208 | continue; | ||
209 | |||
210 | if ((strncmp(match, e, matchlen) == 0) | ||
211 | && ((e[matchlen] == '\0') | ||
212 | || (e[matchlen] == '='))) { | ||
213 | char *cp = strchr(e, '='); | ||
214 | return cp ? ++cp : ""; | ||
215 | } | ||
216 | } | ||
217 | return NULL; | ||
218 | } | ||
219 | |||
220 | /* | ||
221 | * kdballocenv - This function is used to allocate bytes for | ||
222 | * environment entries. | ||
223 | * Parameters: | ||
224 | * match A character string representing a numeric value | ||
225 | * Outputs: | ||
226 | * *value the unsigned long representation of the env variable 'match' | ||
227 | * Returns: | ||
228 | * Zero on success, a kdb diagnostic on failure. | ||
229 | * Remarks: | ||
230 | * We use a static environment buffer (envbuffer) to hold the values | ||
231 | * of dynamically generated environment variables (see kdb_set). Buffer | ||
232 | * space once allocated is never free'd, so over time, the amount of space | ||
233 | * (currently 512 bytes) will be exhausted if env variables are changed | ||
234 | * frequently. | ||
235 | */ | ||
236 | static char *kdballocenv(size_t bytes) | ||
237 | { | ||
238 | #define KDB_ENVBUFSIZE 512 | ||
239 | static char envbuffer[KDB_ENVBUFSIZE]; | ||
240 | static int envbufsize; | ||
241 | char *ep = NULL; | ||
242 | |||
243 | if ((KDB_ENVBUFSIZE - envbufsize) >= bytes) { | ||
244 | ep = &envbuffer[envbufsize]; | ||
245 | envbufsize += bytes; | ||
246 | } | ||
247 | return ep; | ||
248 | } | ||
249 | |||
250 | /* | ||
251 | * kdbgetulenv - This function will return the value of an unsigned | ||
252 | * long-valued environment variable. | ||
253 | * Parameters: | ||
254 | * match A character string representing a numeric value | ||
255 | * Outputs: | ||
256 | * *value the unsigned long represntation of the env variable 'match' | ||
257 | * Returns: | ||
258 | * Zero on success, a kdb diagnostic on failure. | ||
259 | */ | ||
260 | static int kdbgetulenv(const char *match, unsigned long *value) | ||
261 | { | ||
262 | char *ep; | ||
263 | |||
264 | ep = kdbgetenv(match); | ||
265 | if (!ep) | ||
266 | return KDB_NOTENV; | ||
267 | if (strlen(ep) == 0) | ||
268 | return KDB_NOENVVALUE; | ||
269 | |||
270 | *value = simple_strtoul(ep, NULL, 0); | ||
271 | |||
272 | return 0; | ||
273 | } | ||
274 | |||
275 | /* | ||
276 | * kdbgetintenv - This function will return the value of an | ||
277 | * integer-valued environment variable. | ||
278 | * Parameters: | ||
279 | * match A character string representing an integer-valued env variable | ||
280 | * Outputs: | ||
281 | * *value the integer representation of the environment variable 'match' | ||
282 | * Returns: | ||
283 | * Zero on success, a kdb diagnostic on failure. | ||
284 | */ | ||
285 | int kdbgetintenv(const char *match, int *value) | ||
286 | { | ||
287 | unsigned long val; | ||
288 | int diag; | ||
289 | |||
290 | diag = kdbgetulenv(match, &val); | ||
291 | if (!diag) | ||
292 | *value = (int) val; | ||
293 | return diag; | ||
294 | } | ||
295 | |||
296 | /* | ||
297 | * kdbgetularg - This function will convert a numeric string into an | ||
298 | * unsigned long value. | ||
299 | * Parameters: | ||
300 | * arg A character string representing a numeric value | ||
301 | * Outputs: | ||
302 | * *value the unsigned long represntation of arg. | ||
303 | * Returns: | ||
304 | * Zero on success, a kdb diagnostic on failure. | ||
305 | */ | ||
306 | int kdbgetularg(const char *arg, unsigned long *value) | ||
307 | { | ||
308 | char *endp; | ||
309 | unsigned long val; | ||
310 | |||
311 | val = simple_strtoul(arg, &endp, 0); | ||
312 | |||
313 | if (endp == arg) { | ||
314 | /* | ||
315 | * Also try base 16, for us folks too lazy to type the | ||
316 | * leading 0x... | ||
317 | */ | ||
318 | val = simple_strtoul(arg, &endp, 16); | ||
319 | if (endp == arg) | ||
320 | return KDB_BADINT; | ||
321 | } | ||
322 | |||
323 | *value = val; | ||
324 | |||
325 | return 0; | ||
326 | } | ||
327 | |||
328 | int kdbgetu64arg(const char *arg, u64 *value) | ||
329 | { | ||
330 | char *endp; | ||
331 | u64 val; | ||
332 | |||
333 | val = simple_strtoull(arg, &endp, 0); | ||
334 | |||
335 | if (endp == arg) { | ||
336 | |||
337 | val = simple_strtoull(arg, &endp, 16); | ||
338 | if (endp == arg) | ||
339 | return KDB_BADINT; | ||
340 | } | ||
341 | |||
342 | *value = val; | ||
343 | |||
344 | return 0; | ||
345 | } | ||
346 | |||
347 | /* | ||
348 | * kdb_set - This function implements the 'set' command. Alter an | ||
349 | * existing environment variable or create a new one. | ||
350 | */ | ||
351 | int kdb_set(int argc, const char **argv) | ||
352 | { | ||
353 | int i; | ||
354 | char *ep; | ||
355 | size_t varlen, vallen; | ||
356 | |||
357 | /* | ||
358 | * we can be invoked two ways: | ||
359 | * set var=value argv[1]="var", argv[2]="value" | ||
360 | * set var = value argv[1]="var", argv[2]="=", argv[3]="value" | ||
361 | * - if the latter, shift 'em down. | ||
362 | */ | ||
363 | if (argc == 3) { | ||
364 | argv[2] = argv[3]; | ||
365 | argc--; | ||
366 | } | ||
367 | |||
368 | if (argc != 2) | ||
369 | return KDB_ARGCOUNT; | ||
370 | |||
371 | /* | ||
372 | * Check for internal variables | ||
373 | */ | ||
374 | if (strcmp(argv[1], "KDBDEBUG") == 0) { | ||
375 | unsigned int debugflags; | ||
376 | char *cp; | ||
377 | |||
378 | debugflags = simple_strtoul(argv[2], &cp, 0); | ||
379 | if (cp == argv[2] || debugflags & ~KDB_DEBUG_FLAG_MASK) { | ||
380 | kdb_printf("kdb: illegal debug flags '%s'\n", | ||
381 | argv[2]); | ||
382 | return 0; | ||
383 | } | ||
384 | kdb_flags = (kdb_flags & | ||
385 | ~(KDB_DEBUG_FLAG_MASK << KDB_DEBUG_FLAG_SHIFT)) | ||
386 | | (debugflags << KDB_DEBUG_FLAG_SHIFT); | ||
387 | |||
388 | return 0; | ||
389 | } | ||
390 | |||
391 | /* | ||
392 | * Tokenizer squashed the '=' sign. argv[1] is variable | ||
393 | * name, argv[2] = value. | ||
394 | */ | ||
395 | varlen = strlen(argv[1]); | ||
396 | vallen = strlen(argv[2]); | ||
397 | ep = kdballocenv(varlen + vallen + 2); | ||
398 | if (ep == (char *)0) | ||
399 | return KDB_ENVBUFFULL; | ||
400 | |||
401 | sprintf(ep, "%s=%s", argv[1], argv[2]); | ||
402 | |||
403 | ep[varlen+vallen+1] = '\0'; | ||
404 | |||
405 | for (i = 0; i < __nenv; i++) { | ||
406 | if (__env[i] | ||
407 | && ((strncmp(__env[i], argv[1], varlen) == 0) | ||
408 | && ((__env[i][varlen] == '\0') | ||
409 | || (__env[i][varlen] == '=')))) { | ||
410 | __env[i] = ep; | ||
411 | return 0; | ||
412 | } | ||
413 | } | ||
414 | |||
415 | /* | ||
416 | * Wasn't existing variable. Fit into slot. | ||
417 | */ | ||
418 | for (i = 0; i < __nenv-1; i++) { | ||
419 | if (__env[i] == (char *)0) { | ||
420 | __env[i] = ep; | ||
421 | return 0; | ||
422 | } | ||
423 | } | ||
424 | |||
425 | return KDB_ENVFULL; | ||
426 | } | ||
427 | |||
428 | static int kdb_check_regs(void) | ||
429 | { | ||
430 | if (!kdb_current_regs) { | ||
431 | kdb_printf("No current kdb registers." | ||
432 | " You may need to select another task\n"); | ||
433 | return KDB_BADREG; | ||
434 | } | ||
435 | return 0; | ||
436 | } | ||
437 | |||
438 | /* | ||
439 | * kdbgetaddrarg - This function is responsible for parsing an | ||
440 | * address-expression and returning the value of the expression, | ||
441 | * symbol name, and offset to the caller. | ||
442 | * | ||
443 | * The argument may consist of a numeric value (decimal or | ||
444 | * hexidecimal), a symbol name, a register name (preceeded by the | ||
445 | * percent sign), an environment variable with a numeric value | ||
446 | * (preceeded by a dollar sign) or a simple arithmetic expression | ||
447 | * consisting of a symbol name, +/-, and a numeric constant value | ||
448 | * (offset). | ||
449 | * Parameters: | ||
450 | * argc - count of arguments in argv | ||
451 | * argv - argument vector | ||
452 | * *nextarg - index to next unparsed argument in argv[] | ||
453 | * regs - Register state at time of KDB entry | ||
454 | * Outputs: | ||
455 | * *value - receives the value of the address-expression | ||
456 | * *offset - receives the offset specified, if any | ||
457 | * *name - receives the symbol name, if any | ||
458 | * *nextarg - index to next unparsed argument in argv[] | ||
459 | * Returns: | ||
460 | * zero is returned on success, a kdb diagnostic code is | ||
461 | * returned on error. | ||
462 | */ | ||
463 | int kdbgetaddrarg(int argc, const char **argv, int *nextarg, | ||
464 | unsigned long *value, long *offset, | ||
465 | char **name) | ||
466 | { | ||
467 | unsigned long addr; | ||
468 | unsigned long off = 0; | ||
469 | int positive; | ||
470 | int diag; | ||
471 | int found = 0; | ||
472 | char *symname; | ||
473 | char symbol = '\0'; | ||
474 | char *cp; | ||
475 | kdb_symtab_t symtab; | ||
476 | |||
477 | /* | ||
478 | * Process arguments which follow the following syntax: | ||
479 | * | ||
480 | * symbol | numeric-address [+/- numeric-offset] | ||
481 | * %register | ||
482 | * $environment-variable | ||
483 | */ | ||
484 | |||
485 | if (*nextarg > argc) | ||
486 | return KDB_ARGCOUNT; | ||
487 | |||
488 | symname = (char *)argv[*nextarg]; | ||
489 | |||
490 | /* | ||
491 | * If there is no whitespace between the symbol | ||
492 | * or address and the '+' or '-' symbols, we | ||
493 | * remember the character and replace it with a | ||
494 | * null so the symbol/value can be properly parsed | ||
495 | */ | ||
496 | cp = strpbrk(symname, "+-"); | ||
497 | if (cp != NULL) { | ||
498 | symbol = *cp; | ||
499 | *cp++ = '\0'; | ||
500 | } | ||
501 | |||
502 | if (symname[0] == '$') { | ||
503 | diag = kdbgetulenv(&symname[1], &addr); | ||
504 | if (diag) | ||
505 | return diag; | ||
506 | } else if (symname[0] == '%') { | ||
507 | diag = kdb_check_regs(); | ||
508 | if (diag) | ||
509 | return diag; | ||
510 | /* Implement register values with % at a later time as it is | ||
511 | * arch optional. | ||
512 | */ | ||
513 | return KDB_NOTIMP; | ||
514 | } else { | ||
515 | found = kdbgetsymval(symname, &symtab); | ||
516 | if (found) { | ||
517 | addr = symtab.sym_start; | ||
518 | } else { | ||
519 | diag = kdbgetularg(argv[*nextarg], &addr); | ||
520 | if (diag) | ||
521 | return diag; | ||
522 | } | ||
523 | } | ||
524 | |||
525 | if (!found) | ||
526 | found = kdbnearsym(addr, &symtab); | ||
527 | |||
528 | (*nextarg)++; | ||
529 | |||
530 | if (name) | ||
531 | *name = symname; | ||
532 | if (value) | ||
533 | *value = addr; | ||
534 | if (offset && name && *name) | ||
535 | *offset = addr - symtab.sym_start; | ||
536 | |||
537 | if ((*nextarg > argc) | ||
538 | && (symbol == '\0')) | ||
539 | return 0; | ||
540 | |||
541 | /* | ||
542 | * check for +/- and offset | ||
543 | */ | ||
544 | |||
545 | if (symbol == '\0') { | ||
546 | if ((argv[*nextarg][0] != '+') | ||
547 | && (argv[*nextarg][0] != '-')) { | ||
548 | /* | ||
549 | * Not our argument. Return. | ||
550 | */ | ||
551 | return 0; | ||
552 | } else { | ||
553 | positive = (argv[*nextarg][0] == '+'); | ||
554 | (*nextarg)++; | ||
555 | } | ||
556 | } else | ||
557 | positive = (symbol == '+'); | ||
558 | |||
559 | /* | ||
560 | * Now there must be an offset! | ||
561 | */ | ||
562 | if ((*nextarg > argc) | ||
563 | && (symbol == '\0')) { | ||
564 | return KDB_INVADDRFMT; | ||
565 | } | ||
566 | |||
567 | if (!symbol) { | ||
568 | cp = (char *)argv[*nextarg]; | ||
569 | (*nextarg)++; | ||
570 | } | ||
571 | |||
572 | diag = kdbgetularg(cp, &off); | ||
573 | if (diag) | ||
574 | return diag; | ||
575 | |||
576 | if (!positive) | ||
577 | off = -off; | ||
578 | |||
579 | if (offset) | ||
580 | *offset += off; | ||
581 | |||
582 | if (value) | ||
583 | *value += off; | ||
584 | |||
585 | return 0; | ||
586 | } | ||
587 | |||
588 | static void kdb_cmderror(int diag) | ||
589 | { | ||
590 | int i; | ||
591 | |||
592 | if (diag >= 0) { | ||
593 | kdb_printf("no error detected (diagnostic is %d)\n", diag); | ||
594 | return; | ||
595 | } | ||
596 | |||
597 | for (i = 0; i < __nkdb_err; i++) { | ||
598 | if (kdbmsgs[i].km_diag == diag) { | ||
599 | kdb_printf("diag: %d: %s\n", diag, kdbmsgs[i].km_msg); | ||
600 | return; | ||
601 | } | ||
602 | } | ||
603 | |||
604 | kdb_printf("Unknown diag %d\n", -diag); | ||
605 | } | ||
606 | |||
607 | /* | ||
608 | * kdb_defcmd, kdb_defcmd2 - This function implements the 'defcmd' | ||
609 | * command which defines one command as a set of other commands, | ||
610 | * terminated by endefcmd. kdb_defcmd processes the initial | ||
611 | * 'defcmd' command, kdb_defcmd2 is invoked from kdb_parse for | ||
612 | * the following commands until 'endefcmd'. | ||
613 | * Inputs: | ||
614 | * argc argument count | ||
615 | * argv argument vector | ||
616 | * Returns: | ||
617 | * zero for success, a kdb diagnostic if error | ||
618 | */ | ||
619 | struct defcmd_set { | ||
620 | int count; | ||
621 | int usable; | ||
622 | char *name; | ||
623 | char *usage; | ||
624 | char *help; | ||
625 | char **command; | ||
626 | }; | ||
627 | static struct defcmd_set *defcmd_set; | ||
628 | static int defcmd_set_count; | ||
629 | static int defcmd_in_progress; | ||
630 | |||
631 | /* Forward references */ | ||
632 | static int kdb_exec_defcmd(int argc, const char **argv); | ||
633 | |||
634 | static int kdb_defcmd2(const char *cmdstr, const char *argv0) | ||
635 | { | ||
636 | struct defcmd_set *s = defcmd_set + defcmd_set_count - 1; | ||
637 | char **save_command = s->command; | ||
638 | if (strcmp(argv0, "endefcmd") == 0) { | ||
639 | defcmd_in_progress = 0; | ||
640 | if (!s->count) | ||
641 | s->usable = 0; | ||
642 | if (s->usable) | ||
643 | kdb_register(s->name, kdb_exec_defcmd, | ||
644 | s->usage, s->help, 0); | ||
645 | return 0; | ||
646 | } | ||
647 | if (!s->usable) | ||
648 | return KDB_NOTIMP; | ||
649 | s->command = kmalloc((s->count + 1) * sizeof(*(s->command)), GFP_KDB); | ||
650 | if (!s->command) { | ||
651 | kdb_printf("Could not allocate new kdb_defcmd table for %s\n", | ||
652 | cmdstr); | ||
653 | s->usable = 0; | ||
654 | return KDB_NOTIMP; | ||
655 | } | ||
656 | memcpy(s->command, save_command, s->count * sizeof(*(s->command))); | ||
657 | s->command[s->count++] = kdb_strdup(cmdstr, GFP_KDB); | ||
658 | kfree(save_command); | ||
659 | return 0; | ||
660 | } | ||
661 | |||
662 | static int kdb_defcmd(int argc, const char **argv) | ||
663 | { | ||
664 | struct defcmd_set *save_defcmd_set = defcmd_set, *s; | ||
665 | if (defcmd_in_progress) { | ||
666 | kdb_printf("kdb: nested defcmd detected, assuming missing " | ||
667 | "endefcmd\n"); | ||
668 | kdb_defcmd2("endefcmd", "endefcmd"); | ||
669 | } | ||
670 | if (argc == 0) { | ||
671 | int i; | ||
672 | for (s = defcmd_set; s < defcmd_set + defcmd_set_count; ++s) { | ||
673 | kdb_printf("defcmd %s \"%s\" \"%s\"\n", s->name, | ||
674 | s->usage, s->help); | ||
675 | for (i = 0; i < s->count; ++i) | ||
676 | kdb_printf("%s", s->command[i]); | ||
677 | kdb_printf("endefcmd\n"); | ||
678 | } | ||
679 | return 0; | ||
680 | } | ||
681 | if (argc != 3) | ||
682 | return KDB_ARGCOUNT; | ||
683 | defcmd_set = kmalloc((defcmd_set_count + 1) * sizeof(*defcmd_set), | ||
684 | GFP_KDB); | ||
685 | if (!defcmd_set) { | ||
686 | kdb_printf("Could not allocate new defcmd_set entry for %s\n", | ||
687 | argv[1]); | ||
688 | defcmd_set = save_defcmd_set; | ||
689 | return KDB_NOTIMP; | ||
690 | } | ||
691 | memcpy(defcmd_set, save_defcmd_set, | ||
692 | defcmd_set_count * sizeof(*defcmd_set)); | ||
693 | kfree(save_defcmd_set); | ||
694 | s = defcmd_set + defcmd_set_count; | ||
695 | memset(s, 0, sizeof(*s)); | ||
696 | s->usable = 1; | ||
697 | s->name = kdb_strdup(argv[1], GFP_KDB); | ||
698 | s->usage = kdb_strdup(argv[2], GFP_KDB); | ||
699 | s->help = kdb_strdup(argv[3], GFP_KDB); | ||
700 | if (s->usage[0] == '"') { | ||
701 | strcpy(s->usage, s->usage+1); | ||
702 | s->usage[strlen(s->usage)-1] = '\0'; | ||
703 | } | ||
704 | if (s->help[0] == '"') { | ||
705 | strcpy(s->help, s->help+1); | ||
706 | s->help[strlen(s->help)-1] = '\0'; | ||
707 | } | ||
708 | ++defcmd_set_count; | ||
709 | defcmd_in_progress = 1; | ||
710 | return 0; | ||
711 | } | ||
712 | |||
713 | /* | ||
714 | * kdb_exec_defcmd - Execute the set of commands associated with this | ||
715 | * defcmd name. | ||
716 | * Inputs: | ||
717 | * argc argument count | ||
718 | * argv argument vector | ||
719 | * Returns: | ||
720 | * zero for success, a kdb diagnostic if error | ||
721 | */ | ||
722 | static int kdb_exec_defcmd(int argc, const char **argv) | ||
723 | { | ||
724 | int i, ret; | ||
725 | struct defcmd_set *s; | ||
726 | if (argc != 0) | ||
727 | return KDB_ARGCOUNT; | ||
728 | for (s = defcmd_set, i = 0; i < defcmd_set_count; ++i, ++s) { | ||
729 | if (strcmp(s->name, argv[0]) == 0) | ||
730 | break; | ||
731 | } | ||
732 | if (i == defcmd_set_count) { | ||
733 | kdb_printf("kdb_exec_defcmd: could not find commands for %s\n", | ||
734 | argv[0]); | ||
735 | return KDB_NOTIMP; | ||
736 | } | ||
737 | for (i = 0; i < s->count; ++i) { | ||
738 | /* Recursive use of kdb_parse, do not use argv after | ||
739 | * this point */ | ||
740 | argv = NULL; | ||
741 | kdb_printf("[%s]kdb> %s\n", s->name, s->command[i]); | ||
742 | ret = kdb_parse(s->command[i]); | ||
743 | if (ret) | ||
744 | return ret; | ||
745 | } | ||
746 | return 0; | ||
747 | } | ||
748 | |||
749 | /* Command history */ | ||
750 | #define KDB_CMD_HISTORY_COUNT 32 | ||
751 | #define CMD_BUFLEN 200 /* kdb_printf: max printline | ||
752 | * size == 256 */ | ||
753 | static unsigned int cmd_head, cmd_tail; | ||
754 | static unsigned int cmdptr; | ||
755 | static char cmd_hist[KDB_CMD_HISTORY_COUNT][CMD_BUFLEN]; | ||
756 | static char cmd_cur[CMD_BUFLEN]; | ||
757 | |||
758 | /* | ||
759 | * The "str" argument may point to something like | grep xyz | ||
760 | */ | ||
761 | static void parse_grep(const char *str) | ||
762 | { | ||
763 | int len; | ||
764 | char *cp = (char *)str, *cp2; | ||
765 | |||
766 | /* sanity check: we should have been called with the \ first */ | ||
767 | if (*cp != '|') | ||
768 | return; | ||
769 | cp++; | ||
770 | while (isspace(*cp)) | ||
771 | cp++; | ||
772 | if (strncmp(cp, "grep ", 5)) { | ||
773 | kdb_printf("invalid 'pipe', see grephelp\n"); | ||
774 | return; | ||
775 | } | ||
776 | cp += 5; | ||
777 | while (isspace(*cp)) | ||
778 | cp++; | ||
779 | cp2 = strchr(cp, '\n'); | ||
780 | if (cp2) | ||
781 | *cp2 = '\0'; /* remove the trailing newline */ | ||
782 | len = strlen(cp); | ||
783 | if (len == 0) { | ||
784 | kdb_printf("invalid 'pipe', see grephelp\n"); | ||
785 | return; | ||
786 | } | ||
787 | /* now cp points to a nonzero length search string */ | ||
788 | if (*cp == '"') { | ||
789 | /* allow it be "x y z" by removing the "'s - there must | ||
790 | be two of them */ | ||
791 | cp++; | ||
792 | cp2 = strchr(cp, '"'); | ||
793 | if (!cp2) { | ||
794 | kdb_printf("invalid quoted string, see grephelp\n"); | ||
795 | return; | ||
796 | } | ||
797 | *cp2 = '\0'; /* end the string where the 2nd " was */ | ||
798 | } | ||
799 | kdb_grep_leading = 0; | ||
800 | if (*cp == '^') { | ||
801 | kdb_grep_leading = 1; | ||
802 | cp++; | ||
803 | } | ||
804 | len = strlen(cp); | ||
805 | kdb_grep_trailing = 0; | ||
806 | if (*(cp+len-1) == '$') { | ||
807 | kdb_grep_trailing = 1; | ||
808 | *(cp+len-1) = '\0'; | ||
809 | } | ||
810 | len = strlen(cp); | ||
811 | if (!len) | ||
812 | return; | ||
813 | if (len >= GREP_LEN) { | ||
814 | kdb_printf("search string too long\n"); | ||
815 | return; | ||
816 | } | ||
817 | strcpy(kdb_grep_string, cp); | ||
818 | kdb_grepping_flag++; | ||
819 | return; | ||
820 | } | ||
821 | |||
822 | /* | ||
823 | * kdb_parse - Parse the command line, search the command table for a | ||
824 | * matching command and invoke the command function. This | ||
825 | * function may be called recursively, if it is, the second call | ||
826 | * will overwrite argv and cbuf. It is the caller's | ||
827 | * responsibility to save their argv if they recursively call | ||
828 | * kdb_parse(). | ||
829 | * Parameters: | ||
830 | * cmdstr The input command line to be parsed. | ||
831 | * regs The registers at the time kdb was entered. | ||
832 | * Returns: | ||
833 | * Zero for success, a kdb diagnostic if failure. | ||
834 | * Remarks: | ||
835 | * Limited to 20 tokens. | ||
836 | * | ||
837 | * Real rudimentary tokenization. Basically only whitespace | ||
838 | * is considered a token delimeter (but special consideration | ||
839 | * is taken of the '=' sign as used by the 'set' command). | ||
840 | * | ||
841 | * The algorithm used to tokenize the input string relies on | ||
842 | * there being at least one whitespace (or otherwise useless) | ||
843 | * character between tokens as the character immediately following | ||
844 | * the token is altered in-place to a null-byte to terminate the | ||
845 | * token string. | ||
846 | */ | ||
847 | |||
848 | #define MAXARGC 20 | ||
849 | |||
850 | int kdb_parse(const char *cmdstr) | ||
851 | { | ||
852 | static char *argv[MAXARGC]; | ||
853 | static int argc; | ||
854 | static char cbuf[CMD_BUFLEN+2]; | ||
855 | char *cp; | ||
856 | char *cpp, quoted; | ||
857 | kdbtab_t *tp; | ||
858 | int i, escaped, ignore_errors = 0, check_grep; | ||
859 | |||
860 | /* | ||
861 | * First tokenize the command string. | ||
862 | */ | ||
863 | cp = (char *)cmdstr; | ||
864 | kdb_grepping_flag = check_grep = 0; | ||
865 | |||
866 | if (KDB_FLAG(CMD_INTERRUPT)) { | ||
867 | /* Previous command was interrupted, newline must not | ||
868 | * repeat the command */ | ||
869 | KDB_FLAG_CLEAR(CMD_INTERRUPT); | ||
870 | KDB_STATE_SET(PAGER); | ||
871 | argc = 0; /* no repeat */ | ||
872 | } | ||
873 | |||
874 | if (*cp != '\n' && *cp != '\0') { | ||
875 | argc = 0; | ||
876 | cpp = cbuf; | ||
877 | while (*cp) { | ||
878 | /* skip whitespace */ | ||
879 | while (isspace(*cp)) | ||
880 | cp++; | ||
881 | if ((*cp == '\0') || (*cp == '\n') || | ||
882 | (*cp == '#' && !defcmd_in_progress)) | ||
883 | break; | ||
884 | /* special case: check for | grep pattern */ | ||
885 | if (*cp == '|') { | ||
886 | check_grep++; | ||
887 | break; | ||
888 | } | ||
889 | if (cpp >= cbuf + CMD_BUFLEN) { | ||
890 | kdb_printf("kdb_parse: command buffer " | ||
891 | "overflow, command ignored\n%s\n", | ||
892 | cmdstr); | ||
893 | return KDB_NOTFOUND; | ||
894 | } | ||
895 | if (argc >= MAXARGC - 1) { | ||
896 | kdb_printf("kdb_parse: too many arguments, " | ||
897 | "command ignored\n%s\n", cmdstr); | ||
898 | return KDB_NOTFOUND; | ||
899 | } | ||
900 | argv[argc++] = cpp; | ||
901 | escaped = 0; | ||
902 | quoted = '\0'; | ||
903 | /* Copy to next unquoted and unescaped | ||
904 | * whitespace or '=' */ | ||
905 | while (*cp && *cp != '\n' && | ||
906 | (escaped || quoted || !isspace(*cp))) { | ||
907 | if (cpp >= cbuf + CMD_BUFLEN) | ||
908 | break; | ||
909 | if (escaped) { | ||
910 | escaped = 0; | ||
911 | *cpp++ = *cp++; | ||
912 | continue; | ||
913 | } | ||
914 | if (*cp == '\\') { | ||
915 | escaped = 1; | ||
916 | ++cp; | ||
917 | continue; | ||
918 | } | ||
919 | if (*cp == quoted) | ||
920 | quoted = '\0'; | ||
921 | else if (*cp == '\'' || *cp == '"') | ||
922 | quoted = *cp; | ||
923 | *cpp = *cp++; | ||
924 | if (*cpp == '=' && !quoted) | ||
925 | break; | ||
926 | ++cpp; | ||
927 | } | ||
928 | *cpp++ = '\0'; /* Squash a ws or '=' character */ | ||
929 | } | ||
930 | } | ||
931 | if (!argc) | ||
932 | return 0; | ||
933 | if (check_grep) | ||
934 | parse_grep(cp); | ||
935 | if (defcmd_in_progress) { | ||
936 | int result = kdb_defcmd2(cmdstr, argv[0]); | ||
937 | if (!defcmd_in_progress) { | ||
938 | argc = 0; /* avoid repeat on endefcmd */ | ||
939 | *(argv[0]) = '\0'; | ||
940 | } | ||
941 | return result; | ||
942 | } | ||
943 | if (argv[0][0] == '-' && argv[0][1] && | ||
944 | (argv[0][1] < '0' || argv[0][1] > '9')) { | ||
945 | ignore_errors = 1; | ||
946 | ++argv[0]; | ||
947 | } | ||
948 | |||
949 | for_each_kdbcmd(tp, i) { | ||
950 | if (tp->cmd_name) { | ||
951 | /* | ||
952 | * If this command is allowed to be abbreviated, | ||
953 | * check to see if this is it. | ||
954 | */ | ||
955 | |||
956 | if (tp->cmd_minlen | ||
957 | && (strlen(argv[0]) <= tp->cmd_minlen)) { | ||
958 | if (strncmp(argv[0], | ||
959 | tp->cmd_name, | ||
960 | tp->cmd_minlen) == 0) { | ||
961 | break; | ||
962 | } | ||
963 | } | ||
964 | |||
965 | if (strcmp(argv[0], tp->cmd_name) == 0) | ||
966 | break; | ||
967 | } | ||
968 | } | ||
969 | |||
970 | /* | ||
971 | * If we don't find a command by this name, see if the first | ||
972 | * few characters of this match any of the known commands. | ||
973 | * e.g., md1c20 should match md. | ||
974 | */ | ||
975 | if (i == kdb_max_commands) { | ||
976 | for_each_kdbcmd(tp, i) { | ||
977 | if (tp->cmd_name) { | ||
978 | if (strncmp(argv[0], | ||
979 | tp->cmd_name, | ||
980 | strlen(tp->cmd_name)) == 0) { | ||
981 | break; | ||
982 | } | ||
983 | } | ||
984 | } | ||
985 | } | ||
986 | |||
987 | if (i < kdb_max_commands) { | ||
988 | int result; | ||
989 | KDB_STATE_SET(CMD); | ||
990 | result = (*tp->cmd_func)(argc-1, (const char **)argv); | ||
991 | if (result && ignore_errors && result > KDB_CMD_GO) | ||
992 | result = 0; | ||
993 | KDB_STATE_CLEAR(CMD); | ||
994 | switch (tp->cmd_repeat) { | ||
995 | case KDB_REPEAT_NONE: | ||
996 | argc = 0; | ||
997 | if (argv[0]) | ||
998 | *(argv[0]) = '\0'; | ||
999 | break; | ||
1000 | case KDB_REPEAT_NO_ARGS: | ||
1001 | argc = 1; | ||
1002 | if (argv[1]) | ||
1003 | *(argv[1]) = '\0'; | ||
1004 | break; | ||
1005 | case KDB_REPEAT_WITH_ARGS: | ||
1006 | break; | ||
1007 | } | ||
1008 | return result; | ||
1009 | } | ||
1010 | |||
1011 | /* | ||
1012 | * If the input with which we were presented does not | ||
1013 | * map to an existing command, attempt to parse it as an | ||
1014 | * address argument and display the result. Useful for | ||
1015 | * obtaining the address of a variable, or the nearest symbol | ||
1016 | * to an address contained in a register. | ||
1017 | */ | ||
1018 | { | ||
1019 | unsigned long value; | ||
1020 | char *name = NULL; | ||
1021 | long offset; | ||
1022 | int nextarg = 0; | ||
1023 | |||
1024 | if (kdbgetaddrarg(0, (const char **)argv, &nextarg, | ||
1025 | &value, &offset, &name)) { | ||
1026 | return KDB_NOTFOUND; | ||
1027 | } | ||
1028 | |||
1029 | kdb_printf("%s = ", argv[0]); | ||
1030 | kdb_symbol_print(value, NULL, KDB_SP_DEFAULT); | ||
1031 | kdb_printf("\n"); | ||
1032 | return 0; | ||
1033 | } | ||
1034 | } | ||
1035 | |||
1036 | |||
1037 | static int handle_ctrl_cmd(char *cmd) | ||
1038 | { | ||
1039 | #define CTRL_P 16 | ||
1040 | #define CTRL_N 14 | ||
1041 | |||
1042 | /* initial situation */ | ||
1043 | if (cmd_head == cmd_tail) | ||
1044 | return 0; | ||
1045 | switch (*cmd) { | ||
1046 | case CTRL_P: | ||
1047 | if (cmdptr != cmd_tail) | ||
1048 | cmdptr = (cmdptr-1) % KDB_CMD_HISTORY_COUNT; | ||
1049 | strncpy(cmd_cur, cmd_hist[cmdptr], CMD_BUFLEN); | ||
1050 | return 1; | ||
1051 | case CTRL_N: | ||
1052 | if (cmdptr != cmd_head) | ||
1053 | cmdptr = (cmdptr+1) % KDB_CMD_HISTORY_COUNT; | ||
1054 | strncpy(cmd_cur, cmd_hist[cmdptr], CMD_BUFLEN); | ||
1055 | return 1; | ||
1056 | } | ||
1057 | return 0; | ||
1058 | } | ||
1059 | |||
1060 | /* | ||
1061 | * kdb_reboot - This function implements the 'reboot' command. Reboot | ||
1062 | * the system immediately, or loop for ever on failure. | ||
1063 | */ | ||
1064 | static int kdb_reboot(int argc, const char **argv) | ||
1065 | { | ||
1066 | emergency_restart(); | ||
1067 | kdb_printf("Hmm, kdb_reboot did not reboot, spinning here\n"); | ||
1068 | while (1) | ||
1069 | cpu_relax(); | ||
1070 | /* NOTREACHED */ | ||
1071 | return 0; | ||
1072 | } | ||
1073 | |||
1074 | static void kdb_dumpregs(struct pt_regs *regs) | ||
1075 | { | ||
1076 | int old_lvl = console_loglevel; | ||
1077 | console_loglevel = 15; | ||
1078 | kdb_trap_printk++; | ||
1079 | show_regs(regs); | ||
1080 | kdb_trap_printk--; | ||
1081 | kdb_printf("\n"); | ||
1082 | console_loglevel = old_lvl; | ||
1083 | } | ||
1084 | |||
1085 | void kdb_set_current_task(struct task_struct *p) | ||
1086 | { | ||
1087 | kdb_current_task = p; | ||
1088 | |||
1089 | if (kdb_task_has_cpu(p)) { | ||
1090 | kdb_current_regs = KDB_TSKREGS(kdb_process_cpu(p)); | ||
1091 | return; | ||
1092 | } | ||
1093 | kdb_current_regs = NULL; | ||
1094 | } | ||
1095 | |||
1096 | /* | ||
1097 | * kdb_local - The main code for kdb. This routine is invoked on a | ||
1098 | * specific processor, it is not global. The main kdb() routine | ||
1099 | * ensures that only one processor at a time is in this routine. | ||
1100 | * This code is called with the real reason code on the first | ||
1101 | * entry to a kdb session, thereafter it is called with reason | ||
1102 | * SWITCH, even if the user goes back to the original cpu. | ||
1103 | * Inputs: | ||
1104 | * reason The reason KDB was invoked | ||
1105 | * error The hardware-defined error code | ||
1106 | * regs The exception frame at time of fault/breakpoint. | ||
1107 | * db_result Result code from the break or debug point. | ||
1108 | * Returns: | ||
1109 | * 0 KDB was invoked for an event which it wasn't responsible | ||
1110 | * 1 KDB handled the event for which it was invoked. | ||
1111 | * KDB_CMD_GO User typed 'go'. | ||
1112 | * KDB_CMD_CPU User switched to another cpu. | ||
1113 | * KDB_CMD_SS Single step. | ||
1114 | * KDB_CMD_SSB Single step until branch. | ||
1115 | */ | ||
1116 | static int kdb_local(kdb_reason_t reason, int error, struct pt_regs *regs, | ||
1117 | kdb_dbtrap_t db_result) | ||
1118 | { | ||
1119 | char *cmdbuf; | ||
1120 | int diag; | ||
1121 | struct task_struct *kdb_current = | ||
1122 | kdb_curr_task(raw_smp_processor_id()); | ||
1123 | |||
1124 | KDB_DEBUG_STATE("kdb_local 1", reason); | ||
1125 | kdb_go_count = 0; | ||
1126 | if (reason == KDB_REASON_DEBUG) { | ||
1127 | /* special case below */ | ||
1128 | } else { | ||
1129 | kdb_printf("\nEntering kdb (current=0x%p, pid %d) ", | ||
1130 | kdb_current, kdb_current->pid); | ||
1131 | #if defined(CONFIG_SMP) | ||
1132 | kdb_printf("on processor %d ", raw_smp_processor_id()); | ||
1133 | #endif | ||
1134 | } | ||
1135 | |||
1136 | switch (reason) { | ||
1137 | case KDB_REASON_DEBUG: | ||
1138 | { | ||
1139 | /* | ||
1140 | * If re-entering kdb after a single step | ||
1141 | * command, don't print the message. | ||
1142 | */ | ||
1143 | switch (db_result) { | ||
1144 | case KDB_DB_BPT: | ||
1145 | kdb_printf("\nEntering kdb (0x%p, pid %d) ", | ||
1146 | kdb_current, kdb_current->pid); | ||
1147 | #if defined(CONFIG_SMP) | ||
1148 | kdb_printf("on processor %d ", raw_smp_processor_id()); | ||
1149 | #endif | ||
1150 | kdb_printf("due to Debug @ " kdb_machreg_fmt "\n", | ||
1151 | instruction_pointer(regs)); | ||
1152 | break; | ||
1153 | case KDB_DB_SSB: | ||
1154 | /* | ||
1155 | * In the midst of ssb command. Just return. | ||
1156 | */ | ||
1157 | KDB_DEBUG_STATE("kdb_local 3", reason); | ||
1158 | return KDB_CMD_SSB; /* Continue with SSB command */ | ||
1159 | |||
1160 | break; | ||
1161 | case KDB_DB_SS: | ||
1162 | break; | ||
1163 | case KDB_DB_SSBPT: | ||
1164 | KDB_DEBUG_STATE("kdb_local 4", reason); | ||
1165 | return 1; /* kdba_db_trap did the work */ | ||
1166 | default: | ||
1167 | kdb_printf("kdb: Bad result from kdba_db_trap: %d\n", | ||
1168 | db_result); | ||
1169 | break; | ||
1170 | } | ||
1171 | |||
1172 | } | ||
1173 | break; | ||
1174 | case KDB_REASON_ENTER: | ||
1175 | if (KDB_STATE(KEYBOARD)) | ||
1176 | kdb_printf("due to Keyboard Entry\n"); | ||
1177 | else | ||
1178 | kdb_printf("due to KDB_ENTER()\n"); | ||
1179 | break; | ||
1180 | case KDB_REASON_KEYBOARD: | ||
1181 | KDB_STATE_SET(KEYBOARD); | ||
1182 | kdb_printf("due to Keyboard Entry\n"); | ||
1183 | break; | ||
1184 | case KDB_REASON_ENTER_SLAVE: | ||
1185 | /* drop through, slaves only get released via cpu switch */ | ||
1186 | case KDB_REASON_SWITCH: | ||
1187 | kdb_printf("due to cpu switch\n"); | ||
1188 | break; | ||
1189 | case KDB_REASON_OOPS: | ||
1190 | kdb_printf("Oops: %s\n", kdb_diemsg); | ||
1191 | kdb_printf("due to oops @ " kdb_machreg_fmt "\n", | ||
1192 | instruction_pointer(regs)); | ||
1193 | kdb_dumpregs(regs); | ||
1194 | break; | ||
1195 | case KDB_REASON_NMI: | ||
1196 | kdb_printf("due to NonMaskable Interrupt @ " | ||
1197 | kdb_machreg_fmt "\n", | ||
1198 | instruction_pointer(regs)); | ||
1199 | kdb_dumpregs(regs); | ||
1200 | break; | ||
1201 | case KDB_REASON_SSTEP: | ||
1202 | case KDB_REASON_BREAK: | ||
1203 | kdb_printf("due to %s @ " kdb_machreg_fmt "\n", | ||
1204 | reason == KDB_REASON_BREAK ? | ||
1205 | "Breakpoint" : "SS trap", instruction_pointer(regs)); | ||
1206 | /* | ||
1207 | * Determine if this breakpoint is one that we | ||
1208 | * are interested in. | ||
1209 | */ | ||
1210 | if (db_result != KDB_DB_BPT) { | ||
1211 | kdb_printf("kdb: error return from kdba_bp_trap: %d\n", | ||
1212 | db_result); | ||
1213 | KDB_DEBUG_STATE("kdb_local 6", reason); | ||
1214 | return 0; /* Not for us, dismiss it */ | ||
1215 | } | ||
1216 | break; | ||
1217 | case KDB_REASON_RECURSE: | ||
1218 | kdb_printf("due to Recursion @ " kdb_machreg_fmt "\n", | ||
1219 | instruction_pointer(regs)); | ||
1220 | break; | ||
1221 | default: | ||
1222 | kdb_printf("kdb: unexpected reason code: %d\n", reason); | ||
1223 | KDB_DEBUG_STATE("kdb_local 8", reason); | ||
1224 | return 0; /* Not for us, dismiss it */ | ||
1225 | } | ||
1226 | |||
1227 | while (1) { | ||
1228 | /* | ||
1229 | * Initialize pager context. | ||
1230 | */ | ||
1231 | kdb_nextline = 1; | ||
1232 | KDB_STATE_CLEAR(SUPPRESS); | ||
1233 | |||
1234 | cmdbuf = cmd_cur; | ||
1235 | *cmdbuf = '\0'; | ||
1236 | *(cmd_hist[cmd_head]) = '\0'; | ||
1237 | |||
1238 | if (KDB_FLAG(ONLY_DO_DUMP)) { | ||
1239 | /* kdb is off but a catastrophic error requires a dump. | ||
1240 | * Take the dump and reboot. | ||
1241 | * Turn on logging so the kdb output appears in the log | ||
1242 | * buffer in the dump. | ||
1243 | */ | ||
1244 | const char *setargs[] = { "set", "LOGGING", "1" }; | ||
1245 | kdb_set(2, setargs); | ||
1246 | kdb_reboot(0, NULL); | ||
1247 | /*NOTREACHED*/ | ||
1248 | } | ||
1249 | |||
1250 | do_full_getstr: | ||
1251 | #if defined(CONFIG_SMP) | ||
1252 | snprintf(kdb_prompt_str, CMD_BUFLEN, kdbgetenv("PROMPT"), | ||
1253 | raw_smp_processor_id()); | ||
1254 | #else | ||
1255 | snprintf(kdb_prompt_str, CMD_BUFLEN, kdbgetenv("PROMPT")); | ||
1256 | #endif | ||
1257 | if (defcmd_in_progress) | ||
1258 | strncat(kdb_prompt_str, "[defcmd]", CMD_BUFLEN); | ||
1259 | |||
1260 | /* | ||
1261 | * Fetch command from keyboard | ||
1262 | */ | ||
1263 | cmdbuf = kdb_getstr(cmdbuf, CMD_BUFLEN, kdb_prompt_str); | ||
1264 | if (*cmdbuf != '\n') { | ||
1265 | if (*cmdbuf < 32) { | ||
1266 | if (cmdptr == cmd_head) { | ||
1267 | strncpy(cmd_hist[cmd_head], cmd_cur, | ||
1268 | CMD_BUFLEN); | ||
1269 | *(cmd_hist[cmd_head] + | ||
1270 | strlen(cmd_hist[cmd_head])-1) = '\0'; | ||
1271 | } | ||
1272 | if (!handle_ctrl_cmd(cmdbuf)) | ||
1273 | *(cmd_cur+strlen(cmd_cur)-1) = '\0'; | ||
1274 | cmdbuf = cmd_cur; | ||
1275 | goto do_full_getstr; | ||
1276 | } else { | ||
1277 | strncpy(cmd_hist[cmd_head], cmd_cur, | ||
1278 | CMD_BUFLEN); | ||
1279 | } | ||
1280 | |||
1281 | cmd_head = (cmd_head+1) % KDB_CMD_HISTORY_COUNT; | ||
1282 | if (cmd_head == cmd_tail) | ||
1283 | cmd_tail = (cmd_tail+1) % KDB_CMD_HISTORY_COUNT; | ||
1284 | } | ||
1285 | |||
1286 | cmdptr = cmd_head; | ||
1287 | diag = kdb_parse(cmdbuf); | ||
1288 | if (diag == KDB_NOTFOUND) { | ||
1289 | kdb_printf("Unknown kdb command: '%s'\n", cmdbuf); | ||
1290 | diag = 0; | ||
1291 | } | ||
1292 | if (diag == KDB_CMD_GO | ||
1293 | || diag == KDB_CMD_CPU | ||
1294 | || diag == KDB_CMD_SS | ||
1295 | || diag == KDB_CMD_SSB | ||
1296 | || diag == KDB_CMD_KGDB) | ||
1297 | break; | ||
1298 | |||
1299 | if (diag) | ||
1300 | kdb_cmderror(diag); | ||
1301 | } | ||
1302 | KDB_DEBUG_STATE("kdb_local 9", diag); | ||
1303 | return diag; | ||
1304 | } | ||
1305 | |||
1306 | |||
1307 | /* | ||
1308 | * kdb_print_state - Print the state data for the current processor | ||
1309 | * for debugging. | ||
1310 | * Inputs: | ||
1311 | * text Identifies the debug point | ||
1312 | * value Any integer value to be printed, e.g. reason code. | ||
1313 | */ | ||
1314 | void kdb_print_state(const char *text, int value) | ||
1315 | { | ||
1316 | kdb_printf("state: %s cpu %d value %d initial %d state %x\n", | ||
1317 | text, raw_smp_processor_id(), value, kdb_initial_cpu, | ||
1318 | kdb_state); | ||
1319 | } | ||
1320 | |||
1321 | /* | ||
1322 | * kdb_main_loop - After initial setup and assignment of the | ||
1323 | * controlling cpu, all cpus are in this loop. One cpu is in | ||
1324 | * control and will issue the kdb prompt, the others will spin | ||
1325 | * until 'go' or cpu switch. | ||
1326 | * | ||
1327 | * To get a consistent view of the kernel stacks for all | ||
1328 | * processes, this routine is invoked from the main kdb code via | ||
1329 | * an architecture specific routine. kdba_main_loop is | ||
1330 | * responsible for making the kernel stacks consistent for all | ||
1331 | * processes, there should be no difference between a blocked | ||
1332 | * process and a running process as far as kdb is concerned. | ||
1333 | * Inputs: | ||
1334 | * reason The reason KDB was invoked | ||
1335 | * error The hardware-defined error code | ||
1336 | * reason2 kdb's current reason code. | ||
1337 | * Initially error but can change | ||
1338 | * acording to kdb state. | ||
1339 | * db_result Result code from break or debug point. | ||
1340 | * regs The exception frame at time of fault/breakpoint. | ||
1341 | * should always be valid. | ||
1342 | * Returns: | ||
1343 | * 0 KDB was invoked for an event which it wasn't responsible | ||
1344 | * 1 KDB handled the event for which it was invoked. | ||
1345 | */ | ||
1346 | int kdb_main_loop(kdb_reason_t reason, kdb_reason_t reason2, int error, | ||
1347 | kdb_dbtrap_t db_result, struct pt_regs *regs) | ||
1348 | { | ||
1349 | int result = 1; | ||
1350 | /* Stay in kdb() until 'go', 'ss[b]' or an error */ | ||
1351 | while (1) { | ||
1352 | /* | ||
1353 | * All processors except the one that is in control | ||
1354 | * will spin here. | ||
1355 | */ | ||
1356 | KDB_DEBUG_STATE("kdb_main_loop 1", reason); | ||
1357 | while (KDB_STATE(HOLD_CPU)) { | ||
1358 | /* state KDB is turned off by kdb_cpu to see if the | ||
1359 | * other cpus are still live, each cpu in this loop | ||
1360 | * turns it back on. | ||
1361 | */ | ||
1362 | if (!KDB_STATE(KDB)) | ||
1363 | KDB_STATE_SET(KDB); | ||
1364 | } | ||
1365 | |||
1366 | KDB_STATE_CLEAR(SUPPRESS); | ||
1367 | KDB_DEBUG_STATE("kdb_main_loop 2", reason); | ||
1368 | if (KDB_STATE(LEAVING)) | ||
1369 | break; /* Another cpu said 'go' */ | ||
1370 | /* Still using kdb, this processor is in control */ | ||
1371 | result = kdb_local(reason2, error, regs, db_result); | ||
1372 | KDB_DEBUG_STATE("kdb_main_loop 3", result); | ||
1373 | |||
1374 | if (result == KDB_CMD_CPU) | ||
1375 | break; | ||
1376 | |||
1377 | if (result == KDB_CMD_SS) { | ||
1378 | KDB_STATE_SET(DOING_SS); | ||
1379 | break; | ||
1380 | } | ||
1381 | |||
1382 | if (result == KDB_CMD_SSB) { | ||
1383 | KDB_STATE_SET(DOING_SS); | ||
1384 | KDB_STATE_SET(DOING_SSB); | ||
1385 | break; | ||
1386 | } | ||
1387 | |||
1388 | if (result == KDB_CMD_KGDB) { | ||
1389 | if (!(KDB_STATE(DOING_KGDB) || KDB_STATE(DOING_KGDB2))) | ||
1390 | kdb_printf("Entering please attach debugger " | ||
1391 | "or use $D#44+ or $3#33\n"); | ||
1392 | break; | ||
1393 | } | ||
1394 | if (result && result != 1 && result != KDB_CMD_GO) | ||
1395 | kdb_printf("\nUnexpected kdb_local return code %d\n", | ||
1396 | result); | ||
1397 | KDB_DEBUG_STATE("kdb_main_loop 4", reason); | ||
1398 | break; | ||
1399 | } | ||
1400 | if (KDB_STATE(DOING_SS)) | ||
1401 | KDB_STATE_CLEAR(SSBPT); | ||
1402 | |||
1403 | return result; | ||
1404 | } | ||
1405 | |||
1406 | /* | ||
1407 | * kdb_mdr - This function implements the guts of the 'mdr', memory | ||
1408 | * read command. | ||
1409 | * mdr <addr arg>,<byte count> | ||
1410 | * Inputs: | ||
1411 | * addr Start address | ||
1412 | * count Number of bytes | ||
1413 | * Returns: | ||
1414 | * Always 0. Any errors are detected and printed by kdb_getarea. | ||
1415 | */ | ||
1416 | static int kdb_mdr(unsigned long addr, unsigned int count) | ||
1417 | { | ||
1418 | unsigned char c; | ||
1419 | while (count--) { | ||
1420 | if (kdb_getarea(c, addr)) | ||
1421 | return 0; | ||
1422 | kdb_printf("%02x", c); | ||
1423 | addr++; | ||
1424 | } | ||
1425 | kdb_printf("\n"); | ||
1426 | return 0; | ||
1427 | } | ||
1428 | |||
1429 | /* | ||
1430 | * kdb_md - This function implements the 'md', 'md1', 'md2', 'md4', | ||
1431 | * 'md8' 'mdr' and 'mds' commands. | ||
1432 | * | ||
1433 | * md|mds [<addr arg> [<line count> [<radix>]]] | ||
1434 | * mdWcN [<addr arg> [<line count> [<radix>]]] | ||
1435 | * where W = is the width (1, 2, 4 or 8) and N is the count. | ||
1436 | * for eg., md1c20 reads 20 bytes, 1 at a time. | ||
1437 | * mdr <addr arg>,<byte count> | ||
1438 | */ | ||
1439 | static void kdb_md_line(const char *fmtstr, unsigned long addr, | ||
1440 | int symbolic, int nosect, int bytesperword, | ||
1441 | int num, int repeat, int phys) | ||
1442 | { | ||
1443 | /* print just one line of data */ | ||
1444 | kdb_symtab_t symtab; | ||
1445 | char cbuf[32]; | ||
1446 | char *c = cbuf; | ||
1447 | int i; | ||
1448 | unsigned long word; | ||
1449 | |||
1450 | memset(cbuf, '\0', sizeof(cbuf)); | ||
1451 | if (phys) | ||
1452 | kdb_printf("phys " kdb_machreg_fmt0 " ", addr); | ||
1453 | else | ||
1454 | kdb_printf(kdb_machreg_fmt0 " ", addr); | ||
1455 | |||
1456 | for (i = 0; i < num && repeat--; i++) { | ||
1457 | if (phys) { | ||
1458 | if (kdb_getphysword(&word, addr, bytesperword)) | ||
1459 | break; | ||
1460 | } else if (kdb_getword(&word, addr, bytesperword)) | ||
1461 | break; | ||
1462 | kdb_printf(fmtstr, word); | ||
1463 | if (symbolic) | ||
1464 | kdbnearsym(word, &symtab); | ||
1465 | else | ||
1466 | memset(&symtab, 0, sizeof(symtab)); | ||
1467 | if (symtab.sym_name) { | ||
1468 | kdb_symbol_print(word, &symtab, 0); | ||
1469 | if (!nosect) { | ||
1470 | kdb_printf("\n"); | ||
1471 | kdb_printf(" %s %s " | ||
1472 | kdb_machreg_fmt " " | ||
1473 | kdb_machreg_fmt " " | ||
1474 | kdb_machreg_fmt, symtab.mod_name, | ||
1475 | symtab.sec_name, symtab.sec_start, | ||
1476 | symtab.sym_start, symtab.sym_end); | ||
1477 | } | ||
1478 | addr += bytesperword; | ||
1479 | } else { | ||
1480 | union { | ||
1481 | u64 word; | ||
1482 | unsigned char c[8]; | ||
1483 | } wc; | ||
1484 | unsigned char *cp; | ||
1485 | #ifdef __BIG_ENDIAN | ||
1486 | cp = wc.c + 8 - bytesperword; | ||
1487 | #else | ||
1488 | cp = wc.c; | ||
1489 | #endif | ||
1490 | wc.word = word; | ||
1491 | #define printable_char(c) \ | ||
1492 | ({unsigned char __c = c; isascii(__c) && isprint(__c) ? __c : '.'; }) | ||
1493 | switch (bytesperword) { | ||
1494 | case 8: | ||
1495 | *c++ = printable_char(*cp++); | ||
1496 | *c++ = printable_char(*cp++); | ||
1497 | *c++ = printable_char(*cp++); | ||
1498 | *c++ = printable_char(*cp++); | ||
1499 | addr += 4; | ||
1500 | case 4: | ||
1501 | *c++ = printable_char(*cp++); | ||
1502 | *c++ = printable_char(*cp++); | ||
1503 | addr += 2; | ||
1504 | case 2: | ||
1505 | *c++ = printable_char(*cp++); | ||
1506 | addr++; | ||
1507 | case 1: | ||
1508 | *c++ = printable_char(*cp++); | ||
1509 | addr++; | ||
1510 | break; | ||
1511 | } | ||
1512 | #undef printable_char | ||
1513 | } | ||
1514 | } | ||
1515 | kdb_printf("%*s %s\n", (int)((num-i)*(2*bytesperword + 1)+1), | ||
1516 | " ", cbuf); | ||
1517 | } | ||
1518 | |||
1519 | static int kdb_md(int argc, const char **argv) | ||
1520 | { | ||
1521 | static unsigned long last_addr; | ||
1522 | static int last_radix, last_bytesperword, last_repeat; | ||
1523 | int radix = 16, mdcount = 8, bytesperword = KDB_WORD_SIZE, repeat; | ||
1524 | int nosect = 0; | ||
1525 | char fmtchar, fmtstr[64]; | ||
1526 | unsigned long addr; | ||
1527 | unsigned long word; | ||
1528 | long offset = 0; | ||
1529 | int symbolic = 0; | ||
1530 | int valid = 0; | ||
1531 | int phys = 0; | ||
1532 | |||
1533 | kdbgetintenv("MDCOUNT", &mdcount); | ||
1534 | kdbgetintenv("RADIX", &radix); | ||
1535 | kdbgetintenv("BYTESPERWORD", &bytesperword); | ||
1536 | |||
1537 | /* Assume 'md <addr>' and start with environment values */ | ||
1538 | repeat = mdcount * 16 / bytesperword; | ||
1539 | |||
1540 | if (strcmp(argv[0], "mdr") == 0) { | ||
1541 | if (argc != 2) | ||
1542 | return KDB_ARGCOUNT; | ||
1543 | valid = 1; | ||
1544 | } else if (isdigit(argv[0][2])) { | ||
1545 | bytesperword = (int)(argv[0][2] - '0'); | ||
1546 | if (bytesperword == 0) { | ||
1547 | bytesperword = last_bytesperword; | ||
1548 | if (bytesperword == 0) | ||
1549 | bytesperword = 4; | ||
1550 | } | ||
1551 | last_bytesperword = bytesperword; | ||
1552 | repeat = mdcount * 16 / bytesperword; | ||
1553 | if (!argv[0][3]) | ||
1554 | valid = 1; | ||
1555 | else if (argv[0][3] == 'c' && argv[0][4]) { | ||
1556 | char *p; | ||
1557 | repeat = simple_strtoul(argv[0] + 4, &p, 10); | ||
1558 | mdcount = ((repeat * bytesperword) + 15) / 16; | ||
1559 | valid = !*p; | ||
1560 | } | ||
1561 | last_repeat = repeat; | ||
1562 | } else if (strcmp(argv[0], "md") == 0) | ||
1563 | valid = 1; | ||
1564 | else if (strcmp(argv[0], "mds") == 0) | ||
1565 | valid = 1; | ||
1566 | else if (strcmp(argv[0], "mdp") == 0) { | ||
1567 | phys = valid = 1; | ||
1568 | } | ||
1569 | if (!valid) | ||
1570 | return KDB_NOTFOUND; | ||
1571 | |||
1572 | if (argc == 0) { | ||
1573 | if (last_addr == 0) | ||
1574 | return KDB_ARGCOUNT; | ||
1575 | addr = last_addr; | ||
1576 | radix = last_radix; | ||
1577 | bytesperword = last_bytesperword; | ||
1578 | repeat = last_repeat; | ||
1579 | mdcount = ((repeat * bytesperword) + 15) / 16; | ||
1580 | } | ||
1581 | |||
1582 | if (argc) { | ||
1583 | unsigned long val; | ||
1584 | int diag, nextarg = 1; | ||
1585 | diag = kdbgetaddrarg(argc, argv, &nextarg, &addr, | ||
1586 | &offset, NULL); | ||
1587 | if (diag) | ||
1588 | return diag; | ||
1589 | if (argc > nextarg+2) | ||
1590 | return KDB_ARGCOUNT; | ||
1591 | |||
1592 | if (argc >= nextarg) { | ||
1593 | diag = kdbgetularg(argv[nextarg], &val); | ||
1594 | if (!diag) { | ||
1595 | mdcount = (int) val; | ||
1596 | repeat = mdcount * 16 / bytesperword; | ||
1597 | } | ||
1598 | } | ||
1599 | if (argc >= nextarg+1) { | ||
1600 | diag = kdbgetularg(argv[nextarg+1], &val); | ||
1601 | if (!diag) | ||
1602 | radix = (int) val; | ||
1603 | } | ||
1604 | } | ||
1605 | |||
1606 | if (strcmp(argv[0], "mdr") == 0) | ||
1607 | return kdb_mdr(addr, mdcount); | ||
1608 | |||
1609 | switch (radix) { | ||
1610 | case 10: | ||
1611 | fmtchar = 'd'; | ||
1612 | break; | ||
1613 | case 16: | ||
1614 | fmtchar = 'x'; | ||
1615 | break; | ||
1616 | case 8: | ||
1617 | fmtchar = 'o'; | ||
1618 | break; | ||
1619 | default: | ||
1620 | return KDB_BADRADIX; | ||
1621 | } | ||
1622 | |||
1623 | last_radix = radix; | ||
1624 | |||
1625 | if (bytesperword > KDB_WORD_SIZE) | ||
1626 | return KDB_BADWIDTH; | ||
1627 | |||
1628 | switch (bytesperword) { | ||
1629 | case 8: | ||
1630 | sprintf(fmtstr, "%%16.16l%c ", fmtchar); | ||
1631 | break; | ||
1632 | case 4: | ||
1633 | sprintf(fmtstr, "%%8.8l%c ", fmtchar); | ||
1634 | break; | ||
1635 | case 2: | ||
1636 | sprintf(fmtstr, "%%4.4l%c ", fmtchar); | ||
1637 | break; | ||
1638 | case 1: | ||
1639 | sprintf(fmtstr, "%%2.2l%c ", fmtchar); | ||
1640 | break; | ||
1641 | default: | ||
1642 | return KDB_BADWIDTH; | ||
1643 | } | ||
1644 | |||
1645 | last_repeat = repeat; | ||
1646 | last_bytesperword = bytesperword; | ||
1647 | |||
1648 | if (strcmp(argv[0], "mds") == 0) { | ||
1649 | symbolic = 1; | ||
1650 | /* Do not save these changes as last_*, they are temporary mds | ||
1651 | * overrides. | ||
1652 | */ | ||
1653 | bytesperword = KDB_WORD_SIZE; | ||
1654 | repeat = mdcount; | ||
1655 | kdbgetintenv("NOSECT", &nosect); | ||
1656 | } | ||
1657 | |||
1658 | /* Round address down modulo BYTESPERWORD */ | ||
1659 | |||
1660 | addr &= ~(bytesperword-1); | ||
1661 | |||
1662 | while (repeat > 0) { | ||
1663 | unsigned long a; | ||
1664 | int n, z, num = (symbolic ? 1 : (16 / bytesperword)); | ||
1665 | |||
1666 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
1667 | return 0; | ||
1668 | for (a = addr, z = 0; z < repeat; a += bytesperword, ++z) { | ||
1669 | if (phys) { | ||
1670 | if (kdb_getphysword(&word, a, bytesperword) | ||
1671 | || word) | ||
1672 | break; | ||
1673 | } else if (kdb_getword(&word, a, bytesperword) || word) | ||
1674 | break; | ||
1675 | } | ||
1676 | n = min(num, repeat); | ||
1677 | kdb_md_line(fmtstr, addr, symbolic, nosect, bytesperword, | ||
1678 | num, repeat, phys); | ||
1679 | addr += bytesperword * n; | ||
1680 | repeat -= n; | ||
1681 | z = (z + num - 1) / num; | ||
1682 | if (z > 2) { | ||
1683 | int s = num * (z-2); | ||
1684 | kdb_printf(kdb_machreg_fmt0 "-" kdb_machreg_fmt0 | ||
1685 | " zero suppressed\n", | ||
1686 | addr, addr + bytesperword * s - 1); | ||
1687 | addr += bytesperword * s; | ||
1688 | repeat -= s; | ||
1689 | } | ||
1690 | } | ||
1691 | last_addr = addr; | ||
1692 | |||
1693 | return 0; | ||
1694 | } | ||
1695 | |||
1696 | /* | ||
1697 | * kdb_mm - This function implements the 'mm' command. | ||
1698 | * mm address-expression new-value | ||
1699 | * Remarks: | ||
1700 | * mm works on machine words, mmW works on bytes. | ||
1701 | */ | ||
1702 | static int kdb_mm(int argc, const char **argv) | ||
1703 | { | ||
1704 | int diag; | ||
1705 | unsigned long addr; | ||
1706 | long offset = 0; | ||
1707 | unsigned long contents; | ||
1708 | int nextarg; | ||
1709 | int width; | ||
1710 | |||
1711 | if (argv[0][2] && !isdigit(argv[0][2])) | ||
1712 | return KDB_NOTFOUND; | ||
1713 | |||
1714 | if (argc < 2) | ||
1715 | return KDB_ARGCOUNT; | ||
1716 | |||
1717 | nextarg = 1; | ||
1718 | diag = kdbgetaddrarg(argc, argv, &nextarg, &addr, &offset, NULL); | ||
1719 | if (diag) | ||
1720 | return diag; | ||
1721 | |||
1722 | if (nextarg > argc) | ||
1723 | return KDB_ARGCOUNT; | ||
1724 | diag = kdbgetaddrarg(argc, argv, &nextarg, &contents, NULL, NULL); | ||
1725 | if (diag) | ||
1726 | return diag; | ||
1727 | |||
1728 | if (nextarg != argc + 1) | ||
1729 | return KDB_ARGCOUNT; | ||
1730 | |||
1731 | width = argv[0][2] ? (argv[0][2] - '0') : (KDB_WORD_SIZE); | ||
1732 | diag = kdb_putword(addr, contents, width); | ||
1733 | if (diag) | ||
1734 | return diag; | ||
1735 | |||
1736 | kdb_printf(kdb_machreg_fmt " = " kdb_machreg_fmt "\n", addr, contents); | ||
1737 | |||
1738 | return 0; | ||
1739 | } | ||
1740 | |||
1741 | /* | ||
1742 | * kdb_go - This function implements the 'go' command. | ||
1743 | * go [address-expression] | ||
1744 | */ | ||
1745 | static int kdb_go(int argc, const char **argv) | ||
1746 | { | ||
1747 | unsigned long addr; | ||
1748 | int diag; | ||
1749 | int nextarg; | ||
1750 | long offset; | ||
1751 | |||
1752 | if (argc == 1) { | ||
1753 | if (raw_smp_processor_id() != kdb_initial_cpu) { | ||
1754 | kdb_printf("go <address> must be issued from the " | ||
1755 | "initial cpu, do cpu %d first\n", | ||
1756 | kdb_initial_cpu); | ||
1757 | return KDB_ARGCOUNT; | ||
1758 | } | ||
1759 | nextarg = 1; | ||
1760 | diag = kdbgetaddrarg(argc, argv, &nextarg, | ||
1761 | &addr, &offset, NULL); | ||
1762 | if (diag) | ||
1763 | return diag; | ||
1764 | } else if (argc) { | ||
1765 | return KDB_ARGCOUNT; | ||
1766 | } | ||
1767 | |||
1768 | diag = KDB_CMD_GO; | ||
1769 | if (KDB_FLAG(CATASTROPHIC)) { | ||
1770 | kdb_printf("Catastrophic error detected\n"); | ||
1771 | kdb_printf("kdb_continue_catastrophic=%d, ", | ||
1772 | kdb_continue_catastrophic); | ||
1773 | if (kdb_continue_catastrophic == 0 && kdb_go_count++ == 0) { | ||
1774 | kdb_printf("type go a second time if you really want " | ||
1775 | "to continue\n"); | ||
1776 | return 0; | ||
1777 | } | ||
1778 | if (kdb_continue_catastrophic == 2) { | ||
1779 | kdb_printf("forcing reboot\n"); | ||
1780 | kdb_reboot(0, NULL); | ||
1781 | } | ||
1782 | kdb_printf("attempting to continue\n"); | ||
1783 | } | ||
1784 | return diag; | ||
1785 | } | ||
1786 | |||
1787 | /* | ||
1788 | * kdb_rd - This function implements the 'rd' command. | ||
1789 | */ | ||
1790 | static int kdb_rd(int argc, const char **argv) | ||
1791 | { | ||
1792 | int len = kdb_check_regs(); | ||
1793 | #if DBG_MAX_REG_NUM > 0 | ||
1794 | int i; | ||
1795 | char *rname; | ||
1796 | int rsize; | ||
1797 | u64 reg64; | ||
1798 | u32 reg32; | ||
1799 | u16 reg16; | ||
1800 | u8 reg8; | ||
1801 | |||
1802 | if (len) | ||
1803 | return len; | ||
1804 | |||
1805 | for (i = 0; i < DBG_MAX_REG_NUM; i++) { | ||
1806 | rsize = dbg_reg_def[i].size * 2; | ||
1807 | if (rsize > 16) | ||
1808 | rsize = 2; | ||
1809 | if (len + strlen(dbg_reg_def[i].name) + 4 + rsize > 80) { | ||
1810 | len = 0; | ||
1811 | kdb_printf("\n"); | ||
1812 | } | ||
1813 | if (len) | ||
1814 | len += kdb_printf(" "); | ||
1815 | switch(dbg_reg_def[i].size * 8) { | ||
1816 | case 8: | ||
1817 | rname = dbg_get_reg(i, ®8, kdb_current_regs); | ||
1818 | if (!rname) | ||
1819 | break; | ||
1820 | len += kdb_printf("%s: %02x", rname, reg8); | ||
1821 | break; | ||
1822 | case 16: | ||
1823 | rname = dbg_get_reg(i, ®16, kdb_current_regs); | ||
1824 | if (!rname) | ||
1825 | break; | ||
1826 | len += kdb_printf("%s: %04x", rname, reg16); | ||
1827 | break; | ||
1828 | case 32: | ||
1829 | rname = dbg_get_reg(i, ®32, kdb_current_regs); | ||
1830 | if (!rname) | ||
1831 | break; | ||
1832 | len += kdb_printf("%s: %08x", rname, reg32); | ||
1833 | break; | ||
1834 | case 64: | ||
1835 | rname = dbg_get_reg(i, ®64, kdb_current_regs); | ||
1836 | if (!rname) | ||
1837 | break; | ||
1838 | len += kdb_printf("%s: %016llx", rname, reg64); | ||
1839 | break; | ||
1840 | default: | ||
1841 | len += kdb_printf("%s: ??", dbg_reg_def[i].name); | ||
1842 | } | ||
1843 | } | ||
1844 | kdb_printf("\n"); | ||
1845 | #else | ||
1846 | if (len) | ||
1847 | return len; | ||
1848 | |||
1849 | kdb_dumpregs(kdb_current_regs); | ||
1850 | #endif | ||
1851 | return 0; | ||
1852 | } | ||
1853 | |||
1854 | /* | ||
1855 | * kdb_rm - This function implements the 'rm' (register modify) command. | ||
1856 | * rm register-name new-contents | ||
1857 | * Remarks: | ||
1858 | * Allows register modification with the same restrictions as gdb | ||
1859 | */ | ||
1860 | static int kdb_rm(int argc, const char **argv) | ||
1861 | { | ||
1862 | #if DBG_MAX_REG_NUM > 0 | ||
1863 | int diag; | ||
1864 | const char *rname; | ||
1865 | int i; | ||
1866 | u64 reg64; | ||
1867 | u32 reg32; | ||
1868 | u16 reg16; | ||
1869 | u8 reg8; | ||
1870 | |||
1871 | if (argc != 2) | ||
1872 | return KDB_ARGCOUNT; | ||
1873 | /* | ||
1874 | * Allow presence or absence of leading '%' symbol. | ||
1875 | */ | ||
1876 | rname = argv[1]; | ||
1877 | if (*rname == '%') | ||
1878 | rname++; | ||
1879 | |||
1880 | diag = kdbgetu64arg(argv[2], ®64); | ||
1881 | if (diag) | ||
1882 | return diag; | ||
1883 | |||
1884 | diag = kdb_check_regs(); | ||
1885 | if (diag) | ||
1886 | return diag; | ||
1887 | |||
1888 | diag = KDB_BADREG; | ||
1889 | for (i = 0; i < DBG_MAX_REG_NUM; i++) { | ||
1890 | if (strcmp(rname, dbg_reg_def[i].name) == 0) { | ||
1891 | diag = 0; | ||
1892 | break; | ||
1893 | } | ||
1894 | } | ||
1895 | if (!diag) { | ||
1896 | switch(dbg_reg_def[i].size * 8) { | ||
1897 | case 8: | ||
1898 | reg8 = reg64; | ||
1899 | dbg_set_reg(i, ®8, kdb_current_regs); | ||
1900 | break; | ||
1901 | case 16: | ||
1902 | reg16 = reg64; | ||
1903 | dbg_set_reg(i, ®16, kdb_current_regs); | ||
1904 | break; | ||
1905 | case 32: | ||
1906 | reg32 = reg64; | ||
1907 | dbg_set_reg(i, ®32, kdb_current_regs); | ||
1908 | break; | ||
1909 | case 64: | ||
1910 | dbg_set_reg(i, ®64, kdb_current_regs); | ||
1911 | break; | ||
1912 | } | ||
1913 | } | ||
1914 | return diag; | ||
1915 | #else | ||
1916 | kdb_printf("ERROR: Register set currently not implemented\n"); | ||
1917 | return 0; | ||
1918 | #endif | ||
1919 | } | ||
1920 | |||
1921 | #if defined(CONFIG_MAGIC_SYSRQ) | ||
1922 | /* | ||
1923 | * kdb_sr - This function implements the 'sr' (SYSRQ key) command | ||
1924 | * which interfaces to the soi-disant MAGIC SYSRQ functionality. | ||
1925 | * sr <magic-sysrq-code> | ||
1926 | */ | ||
1927 | static int kdb_sr(int argc, const char **argv) | ||
1928 | { | ||
1929 | if (argc != 1) | ||
1930 | return KDB_ARGCOUNT; | ||
1931 | kdb_trap_printk++; | ||
1932 | __handle_sysrq(*argv[1], false); | ||
1933 | kdb_trap_printk--; | ||
1934 | |||
1935 | return 0; | ||
1936 | } | ||
1937 | #endif /* CONFIG_MAGIC_SYSRQ */ | ||
1938 | |||
1939 | /* | ||
1940 | * kdb_ef - This function implements the 'regs' (display exception | ||
1941 | * frame) command. This command takes an address and expects to | ||
1942 | * find an exception frame at that address, formats and prints | ||
1943 | * it. | ||
1944 | * regs address-expression | ||
1945 | * Remarks: | ||
1946 | * Not done yet. | ||
1947 | */ | ||
1948 | static int kdb_ef(int argc, const char **argv) | ||
1949 | { | ||
1950 | int diag; | ||
1951 | unsigned long addr; | ||
1952 | long offset; | ||
1953 | int nextarg; | ||
1954 | |||
1955 | if (argc != 1) | ||
1956 | return KDB_ARGCOUNT; | ||
1957 | |||
1958 | nextarg = 1; | ||
1959 | diag = kdbgetaddrarg(argc, argv, &nextarg, &addr, &offset, NULL); | ||
1960 | if (diag) | ||
1961 | return diag; | ||
1962 | show_regs((struct pt_regs *)addr); | ||
1963 | return 0; | ||
1964 | } | ||
1965 | |||
1966 | #if defined(CONFIG_MODULES) | ||
1967 | /* | ||
1968 | * kdb_lsmod - This function implements the 'lsmod' command. Lists | ||
1969 | * currently loaded kernel modules. | ||
1970 | * Mostly taken from userland lsmod. | ||
1971 | */ | ||
1972 | static int kdb_lsmod(int argc, const char **argv) | ||
1973 | { | ||
1974 | struct module *mod; | ||
1975 | |||
1976 | if (argc != 0) | ||
1977 | return KDB_ARGCOUNT; | ||
1978 | |||
1979 | kdb_printf("Module Size modstruct Used by\n"); | ||
1980 | list_for_each_entry(mod, kdb_modules, list) { | ||
1981 | |||
1982 | kdb_printf("%-20s%8u 0x%p ", mod->name, | ||
1983 | mod->core_size, (void *)mod); | ||
1984 | #ifdef CONFIG_MODULE_UNLOAD | ||
1985 | kdb_printf("%4d ", module_refcount(mod)); | ||
1986 | #endif | ||
1987 | if (mod->state == MODULE_STATE_GOING) | ||
1988 | kdb_printf(" (Unloading)"); | ||
1989 | else if (mod->state == MODULE_STATE_COMING) | ||
1990 | kdb_printf(" (Loading)"); | ||
1991 | else | ||
1992 | kdb_printf(" (Live)"); | ||
1993 | kdb_printf(" 0x%p", mod->module_core); | ||
1994 | |||
1995 | #ifdef CONFIG_MODULE_UNLOAD | ||
1996 | { | ||
1997 | struct module_use *use; | ||
1998 | kdb_printf(" [ "); | ||
1999 | list_for_each_entry(use, &mod->source_list, | ||
2000 | source_list) | ||
2001 | kdb_printf("%s ", use->target->name); | ||
2002 | kdb_printf("]\n"); | ||
2003 | } | ||
2004 | #endif | ||
2005 | } | ||
2006 | |||
2007 | return 0; | ||
2008 | } | ||
2009 | |||
2010 | #endif /* CONFIG_MODULES */ | ||
2011 | |||
2012 | /* | ||
2013 | * kdb_env - This function implements the 'env' command. Display the | ||
2014 | * current environment variables. | ||
2015 | */ | ||
2016 | |||
2017 | static int kdb_env(int argc, const char **argv) | ||
2018 | { | ||
2019 | int i; | ||
2020 | |||
2021 | for (i = 0; i < __nenv; i++) { | ||
2022 | if (__env[i]) | ||
2023 | kdb_printf("%s\n", __env[i]); | ||
2024 | } | ||
2025 | |||
2026 | if (KDB_DEBUG(MASK)) | ||
2027 | kdb_printf("KDBFLAGS=0x%x\n", kdb_flags); | ||
2028 | |||
2029 | return 0; | ||
2030 | } | ||
2031 | |||
2032 | #ifdef CONFIG_PRINTK | ||
2033 | /* | ||
2034 | * kdb_dmesg - This function implements the 'dmesg' command to display | ||
2035 | * the contents of the syslog buffer. | ||
2036 | * dmesg [lines] [adjust] | ||
2037 | */ | ||
2038 | static int kdb_dmesg(int argc, const char **argv) | ||
2039 | { | ||
2040 | char *syslog_data[4], *start, *end, c = '\0', *p; | ||
2041 | int diag, logging, logsize, lines = 0, adjust = 0, n; | ||
2042 | |||
2043 | if (argc > 2) | ||
2044 | return KDB_ARGCOUNT; | ||
2045 | if (argc) { | ||
2046 | char *cp; | ||
2047 | lines = simple_strtol(argv[1], &cp, 0); | ||
2048 | if (*cp) | ||
2049 | lines = 0; | ||
2050 | if (argc > 1) { | ||
2051 | adjust = simple_strtoul(argv[2], &cp, 0); | ||
2052 | if (*cp || adjust < 0) | ||
2053 | adjust = 0; | ||
2054 | } | ||
2055 | } | ||
2056 | |||
2057 | /* disable LOGGING if set */ | ||
2058 | diag = kdbgetintenv("LOGGING", &logging); | ||
2059 | if (!diag && logging) { | ||
2060 | const char *setargs[] = { "set", "LOGGING", "0" }; | ||
2061 | kdb_set(2, setargs); | ||
2062 | } | ||
2063 | |||
2064 | /* syslog_data[0,1] physical start, end+1. syslog_data[2,3] | ||
2065 | * logical start, end+1. */ | ||
2066 | kdb_syslog_data(syslog_data); | ||
2067 | if (syslog_data[2] == syslog_data[3]) | ||
2068 | return 0; | ||
2069 | logsize = syslog_data[1] - syslog_data[0]; | ||
2070 | start = syslog_data[2]; | ||
2071 | end = syslog_data[3]; | ||
2072 | #define KDB_WRAP(p) (((p - syslog_data[0]) % logsize) + syslog_data[0]) | ||
2073 | for (n = 0, p = start; p < end; ++p) { | ||
2074 | c = *KDB_WRAP(p); | ||
2075 | if (c == '\n') | ||
2076 | ++n; | ||
2077 | } | ||
2078 | if (c != '\n') | ||
2079 | ++n; | ||
2080 | if (lines < 0) { | ||
2081 | if (adjust >= n) | ||
2082 | kdb_printf("buffer only contains %d lines, nothing " | ||
2083 | "printed\n", n); | ||
2084 | else if (adjust - lines >= n) | ||
2085 | kdb_printf("buffer only contains %d lines, last %d " | ||
2086 | "lines printed\n", n, n - adjust); | ||
2087 | if (adjust) { | ||
2088 | for (; start < end && adjust; ++start) { | ||
2089 | if (*KDB_WRAP(start) == '\n') | ||
2090 | --adjust; | ||
2091 | } | ||
2092 | if (start < end) | ||
2093 | ++start; | ||
2094 | } | ||
2095 | for (p = start; p < end && lines; ++p) { | ||
2096 | if (*KDB_WRAP(p) == '\n') | ||
2097 | ++lines; | ||
2098 | } | ||
2099 | end = p; | ||
2100 | } else if (lines > 0) { | ||
2101 | int skip = n - (adjust + lines); | ||
2102 | if (adjust >= n) { | ||
2103 | kdb_printf("buffer only contains %d lines, " | ||
2104 | "nothing printed\n", n); | ||
2105 | skip = n; | ||
2106 | } else if (skip < 0) { | ||
2107 | lines += skip; | ||
2108 | skip = 0; | ||
2109 | kdb_printf("buffer only contains %d lines, first " | ||
2110 | "%d lines printed\n", n, lines); | ||
2111 | } | ||
2112 | for (; start < end && skip; ++start) { | ||
2113 | if (*KDB_WRAP(start) == '\n') | ||
2114 | --skip; | ||
2115 | } | ||
2116 | for (p = start; p < end && lines; ++p) { | ||
2117 | if (*KDB_WRAP(p) == '\n') | ||
2118 | --lines; | ||
2119 | } | ||
2120 | end = p; | ||
2121 | } | ||
2122 | /* Do a line at a time (max 200 chars) to reduce protocol overhead */ | ||
2123 | c = '\n'; | ||
2124 | while (start != end) { | ||
2125 | char buf[201]; | ||
2126 | p = buf; | ||
2127 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
2128 | return 0; | ||
2129 | while (start < end && (c = *KDB_WRAP(start)) && | ||
2130 | (p - buf) < sizeof(buf)-1) { | ||
2131 | ++start; | ||
2132 | *p++ = c; | ||
2133 | if (c == '\n') | ||
2134 | break; | ||
2135 | } | ||
2136 | *p = '\0'; | ||
2137 | kdb_printf("%s", buf); | ||
2138 | } | ||
2139 | if (c != '\n') | ||
2140 | kdb_printf("\n"); | ||
2141 | |||
2142 | return 0; | ||
2143 | } | ||
2144 | #endif /* CONFIG_PRINTK */ | ||
2145 | /* | ||
2146 | * kdb_cpu - This function implements the 'cpu' command. | ||
2147 | * cpu [<cpunum>] | ||
2148 | * Returns: | ||
2149 | * KDB_CMD_CPU for success, a kdb diagnostic if error | ||
2150 | */ | ||
2151 | static void kdb_cpu_status(void) | ||
2152 | { | ||
2153 | int i, start_cpu, first_print = 1; | ||
2154 | char state, prev_state = '?'; | ||
2155 | |||
2156 | kdb_printf("Currently on cpu %d\n", raw_smp_processor_id()); | ||
2157 | kdb_printf("Available cpus: "); | ||
2158 | for (start_cpu = -1, i = 0; i < NR_CPUS; i++) { | ||
2159 | if (!cpu_online(i)) { | ||
2160 | state = 'F'; /* cpu is offline */ | ||
2161 | } else { | ||
2162 | state = ' '; /* cpu is responding to kdb */ | ||
2163 | if (kdb_task_state_char(KDB_TSK(i)) == 'I') | ||
2164 | state = 'I'; /* idle task */ | ||
2165 | } | ||
2166 | if (state != prev_state) { | ||
2167 | if (prev_state != '?') { | ||
2168 | if (!first_print) | ||
2169 | kdb_printf(", "); | ||
2170 | first_print = 0; | ||
2171 | kdb_printf("%d", start_cpu); | ||
2172 | if (start_cpu < i-1) | ||
2173 | kdb_printf("-%d", i-1); | ||
2174 | if (prev_state != ' ') | ||
2175 | kdb_printf("(%c)", prev_state); | ||
2176 | } | ||
2177 | prev_state = state; | ||
2178 | start_cpu = i; | ||
2179 | } | ||
2180 | } | ||
2181 | /* print the trailing cpus, ignoring them if they are all offline */ | ||
2182 | if (prev_state != 'F') { | ||
2183 | if (!first_print) | ||
2184 | kdb_printf(", "); | ||
2185 | kdb_printf("%d", start_cpu); | ||
2186 | if (start_cpu < i-1) | ||
2187 | kdb_printf("-%d", i-1); | ||
2188 | if (prev_state != ' ') | ||
2189 | kdb_printf("(%c)", prev_state); | ||
2190 | } | ||
2191 | kdb_printf("\n"); | ||
2192 | } | ||
2193 | |||
2194 | static int kdb_cpu(int argc, const char **argv) | ||
2195 | { | ||
2196 | unsigned long cpunum; | ||
2197 | int diag; | ||
2198 | |||
2199 | if (argc == 0) { | ||
2200 | kdb_cpu_status(); | ||
2201 | return 0; | ||
2202 | } | ||
2203 | |||
2204 | if (argc != 1) | ||
2205 | return KDB_ARGCOUNT; | ||
2206 | |||
2207 | diag = kdbgetularg(argv[1], &cpunum); | ||
2208 | if (diag) | ||
2209 | return diag; | ||
2210 | |||
2211 | /* | ||
2212 | * Validate cpunum | ||
2213 | */ | ||
2214 | if ((cpunum > NR_CPUS) || !cpu_online(cpunum)) | ||
2215 | return KDB_BADCPUNUM; | ||
2216 | |||
2217 | dbg_switch_cpu = cpunum; | ||
2218 | |||
2219 | /* | ||
2220 | * Switch to other cpu | ||
2221 | */ | ||
2222 | return KDB_CMD_CPU; | ||
2223 | } | ||
2224 | |||
2225 | /* The user may not realize that ps/bta with no parameters does not print idle | ||
2226 | * or sleeping system daemon processes, so tell them how many were suppressed. | ||
2227 | */ | ||
2228 | void kdb_ps_suppressed(void) | ||
2229 | { | ||
2230 | int idle = 0, daemon = 0; | ||
2231 | unsigned long mask_I = kdb_task_state_string("I"), | ||
2232 | mask_M = kdb_task_state_string("M"); | ||
2233 | unsigned long cpu; | ||
2234 | const struct task_struct *p, *g; | ||
2235 | for_each_online_cpu(cpu) { | ||
2236 | p = kdb_curr_task(cpu); | ||
2237 | if (kdb_task_state(p, mask_I)) | ||
2238 | ++idle; | ||
2239 | } | ||
2240 | kdb_do_each_thread(g, p) { | ||
2241 | if (kdb_task_state(p, mask_M)) | ||
2242 | ++daemon; | ||
2243 | } kdb_while_each_thread(g, p); | ||
2244 | if (idle || daemon) { | ||
2245 | if (idle) | ||
2246 | kdb_printf("%d idle process%s (state I)%s\n", | ||
2247 | idle, idle == 1 ? "" : "es", | ||
2248 | daemon ? " and " : ""); | ||
2249 | if (daemon) | ||
2250 | kdb_printf("%d sleeping system daemon (state M) " | ||
2251 | "process%s", daemon, | ||
2252 | daemon == 1 ? "" : "es"); | ||
2253 | kdb_printf(" suppressed,\nuse 'ps A' to see all.\n"); | ||
2254 | } | ||
2255 | } | ||
2256 | |||
2257 | /* | ||
2258 | * kdb_ps - This function implements the 'ps' command which shows a | ||
2259 | * list of the active processes. | ||
2260 | * ps [DRSTCZEUIMA] All processes, optionally filtered by state | ||
2261 | */ | ||
2262 | void kdb_ps1(const struct task_struct *p) | ||
2263 | { | ||
2264 | int cpu; | ||
2265 | unsigned long tmp; | ||
2266 | |||
2267 | if (!p || probe_kernel_read(&tmp, (char *)p, sizeof(unsigned long))) | ||
2268 | return; | ||
2269 | |||
2270 | cpu = kdb_process_cpu(p); | ||
2271 | kdb_printf("0x%p %8d %8d %d %4d %c 0x%p %c%s\n", | ||
2272 | (void *)p, p->pid, p->parent->pid, | ||
2273 | kdb_task_has_cpu(p), kdb_process_cpu(p), | ||
2274 | kdb_task_state_char(p), | ||
2275 | (void *)(&p->thread), | ||
2276 | p == kdb_curr_task(raw_smp_processor_id()) ? '*' : ' ', | ||
2277 | p->comm); | ||
2278 | if (kdb_task_has_cpu(p)) { | ||
2279 | if (!KDB_TSK(cpu)) { | ||
2280 | kdb_printf(" Error: no saved data for this cpu\n"); | ||
2281 | } else { | ||
2282 | if (KDB_TSK(cpu) != p) | ||
2283 | kdb_printf(" Error: does not match running " | ||
2284 | "process table (0x%p)\n", KDB_TSK(cpu)); | ||
2285 | } | ||
2286 | } | ||
2287 | } | ||
2288 | |||
2289 | static int kdb_ps(int argc, const char **argv) | ||
2290 | { | ||
2291 | struct task_struct *g, *p; | ||
2292 | unsigned long mask, cpu; | ||
2293 | |||
2294 | if (argc == 0) | ||
2295 | kdb_ps_suppressed(); | ||
2296 | kdb_printf("%-*s Pid Parent [*] cpu State %-*s Command\n", | ||
2297 | (int)(2*sizeof(void *))+2, "Task Addr", | ||
2298 | (int)(2*sizeof(void *))+2, "Thread"); | ||
2299 | mask = kdb_task_state_string(argc ? argv[1] : NULL); | ||
2300 | /* Run the active tasks first */ | ||
2301 | for_each_online_cpu(cpu) { | ||
2302 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
2303 | return 0; | ||
2304 | p = kdb_curr_task(cpu); | ||
2305 | if (kdb_task_state(p, mask)) | ||
2306 | kdb_ps1(p); | ||
2307 | } | ||
2308 | kdb_printf("\n"); | ||
2309 | /* Now the real tasks */ | ||
2310 | kdb_do_each_thread(g, p) { | ||
2311 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
2312 | return 0; | ||
2313 | if (kdb_task_state(p, mask)) | ||
2314 | kdb_ps1(p); | ||
2315 | } kdb_while_each_thread(g, p); | ||
2316 | |||
2317 | return 0; | ||
2318 | } | ||
2319 | |||
2320 | /* | ||
2321 | * kdb_pid - This function implements the 'pid' command which switches | ||
2322 | * the currently active process. | ||
2323 | * pid [<pid> | R] | ||
2324 | */ | ||
2325 | static int kdb_pid(int argc, const char **argv) | ||
2326 | { | ||
2327 | struct task_struct *p; | ||
2328 | unsigned long val; | ||
2329 | int diag; | ||
2330 | |||
2331 | if (argc > 1) | ||
2332 | return KDB_ARGCOUNT; | ||
2333 | |||
2334 | if (argc) { | ||
2335 | if (strcmp(argv[1], "R") == 0) { | ||
2336 | p = KDB_TSK(kdb_initial_cpu); | ||
2337 | } else { | ||
2338 | diag = kdbgetularg(argv[1], &val); | ||
2339 | if (diag) | ||
2340 | return KDB_BADINT; | ||
2341 | |||
2342 | p = find_task_by_pid_ns((pid_t)val, &init_pid_ns); | ||
2343 | if (!p) { | ||
2344 | kdb_printf("No task with pid=%d\n", (pid_t)val); | ||
2345 | return 0; | ||
2346 | } | ||
2347 | } | ||
2348 | kdb_set_current_task(p); | ||
2349 | } | ||
2350 | kdb_printf("KDB current process is %s(pid=%d)\n", | ||
2351 | kdb_current_task->comm, | ||
2352 | kdb_current_task->pid); | ||
2353 | |||
2354 | return 0; | ||
2355 | } | ||
2356 | |||
2357 | /* | ||
2358 | * kdb_ll - This function implements the 'll' command which follows a | ||
2359 | * linked list and executes an arbitrary command for each | ||
2360 | * element. | ||
2361 | */ | ||
2362 | static int kdb_ll(int argc, const char **argv) | ||
2363 | { | ||
2364 | int diag; | ||
2365 | unsigned long addr; | ||
2366 | long offset = 0; | ||
2367 | unsigned long va; | ||
2368 | unsigned long linkoffset; | ||
2369 | int nextarg; | ||
2370 | const char *command; | ||
2371 | |||
2372 | if (argc != 3) | ||
2373 | return KDB_ARGCOUNT; | ||
2374 | |||
2375 | nextarg = 1; | ||
2376 | diag = kdbgetaddrarg(argc, argv, &nextarg, &addr, &offset, NULL); | ||
2377 | if (diag) | ||
2378 | return diag; | ||
2379 | |||
2380 | diag = kdbgetularg(argv[2], &linkoffset); | ||
2381 | if (diag) | ||
2382 | return diag; | ||
2383 | |||
2384 | /* | ||
2385 | * Using the starting address as | ||
2386 | * the first element in the list, and assuming that | ||
2387 | * the list ends with a null pointer. | ||
2388 | */ | ||
2389 | |||
2390 | va = addr; | ||
2391 | command = kdb_strdup(argv[3], GFP_KDB); | ||
2392 | if (!command) { | ||
2393 | kdb_printf("%s: cannot duplicate command\n", __func__); | ||
2394 | return 0; | ||
2395 | } | ||
2396 | /* Recursive use of kdb_parse, do not use argv after this point */ | ||
2397 | argv = NULL; | ||
2398 | |||
2399 | while (va) { | ||
2400 | char buf[80]; | ||
2401 | |||
2402 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
2403 | return 0; | ||
2404 | |||
2405 | sprintf(buf, "%s " kdb_machreg_fmt "\n", command, va); | ||
2406 | diag = kdb_parse(buf); | ||
2407 | if (diag) | ||
2408 | return diag; | ||
2409 | |||
2410 | addr = va + linkoffset; | ||
2411 | if (kdb_getword(&va, addr, sizeof(va))) | ||
2412 | return 0; | ||
2413 | } | ||
2414 | kfree(command); | ||
2415 | |||
2416 | return 0; | ||
2417 | } | ||
2418 | |||
2419 | static int kdb_kgdb(int argc, const char **argv) | ||
2420 | { | ||
2421 | return KDB_CMD_KGDB; | ||
2422 | } | ||
2423 | |||
2424 | /* | ||
2425 | * kdb_help - This function implements the 'help' and '?' commands. | ||
2426 | */ | ||
2427 | static int kdb_help(int argc, const char **argv) | ||
2428 | { | ||
2429 | kdbtab_t *kt; | ||
2430 | int i; | ||
2431 | |||
2432 | kdb_printf("%-15.15s %-20.20s %s\n", "Command", "Usage", "Description"); | ||
2433 | kdb_printf("-----------------------------" | ||
2434 | "-----------------------------\n"); | ||
2435 | for_each_kdbcmd(kt, i) { | ||
2436 | if (kt->cmd_name) | ||
2437 | kdb_printf("%-15.15s %-20.20s %s\n", kt->cmd_name, | ||
2438 | kt->cmd_usage, kt->cmd_help); | ||
2439 | if (KDB_FLAG(CMD_INTERRUPT)) | ||
2440 | return 0; | ||
2441 | } | ||
2442 | return 0; | ||
2443 | } | ||
2444 | |||
2445 | /* | ||
2446 | * kdb_kill - This function implements the 'kill' commands. | ||
2447 | */ | ||
2448 | static int kdb_kill(int argc, const char **argv) | ||
2449 | { | ||
2450 | long sig, pid; | ||
2451 | char *endp; | ||
2452 | struct task_struct *p; | ||
2453 | struct siginfo info; | ||
2454 | |||
2455 | if (argc != 2) | ||
2456 | return KDB_ARGCOUNT; | ||
2457 | |||
2458 | sig = simple_strtol(argv[1], &endp, 0); | ||
2459 | if (*endp) | ||
2460 | return KDB_BADINT; | ||
2461 | if (sig >= 0) { | ||
2462 | kdb_printf("Invalid signal parameter.<-signal>\n"); | ||
2463 | return 0; | ||
2464 | } | ||
2465 | sig = -sig; | ||
2466 | |||
2467 | pid = simple_strtol(argv[2], &endp, 0); | ||
2468 | if (*endp) | ||
2469 | return KDB_BADINT; | ||
2470 | if (pid <= 0) { | ||
2471 | kdb_printf("Process ID must be large than 0.\n"); | ||
2472 | return 0; | ||
2473 | } | ||
2474 | |||
2475 | /* Find the process. */ | ||
2476 | p = find_task_by_pid_ns(pid, &init_pid_ns); | ||
2477 | if (!p) { | ||
2478 | kdb_printf("The specified process isn't found.\n"); | ||
2479 | return 0; | ||
2480 | } | ||
2481 | p = p->group_leader; | ||
2482 | info.si_signo = sig; | ||
2483 | info.si_errno = 0; | ||
2484 | info.si_code = SI_USER; | ||
2485 | info.si_pid = pid; /* same capabilities as process being signalled */ | ||
2486 | info.si_uid = 0; /* kdb has root authority */ | ||
2487 | kdb_send_sig_info(p, &info); | ||
2488 | return 0; | ||
2489 | } | ||
2490 | |||
2491 | struct kdb_tm { | ||
2492 | int tm_sec; /* seconds */ | ||
2493 | int tm_min; /* minutes */ | ||
2494 | int tm_hour; /* hours */ | ||
2495 | int tm_mday; /* day of the month */ | ||
2496 | int tm_mon; /* month */ | ||
2497 | int tm_year; /* year */ | ||
2498 | }; | ||
2499 | |||
2500 | static void kdb_gmtime(struct timespec *tv, struct kdb_tm *tm) | ||
2501 | { | ||
2502 | /* This will work from 1970-2099, 2100 is not a leap year */ | ||
2503 | static int mon_day[] = { 31, 29, 31, 30, 31, 30, 31, | ||
2504 | 31, 30, 31, 30, 31 }; | ||
2505 | memset(tm, 0, sizeof(*tm)); | ||
2506 | tm->tm_sec = tv->tv_sec % (24 * 60 * 60); | ||
2507 | tm->tm_mday = tv->tv_sec / (24 * 60 * 60) + | ||
2508 | (2 * 365 + 1); /* shift base from 1970 to 1968 */ | ||
2509 | tm->tm_min = tm->tm_sec / 60 % 60; | ||
2510 | tm->tm_hour = tm->tm_sec / 60 / 60; | ||
2511 | tm->tm_sec = tm->tm_sec % 60; | ||
2512 | tm->tm_year = 68 + 4*(tm->tm_mday / (4*365+1)); | ||
2513 | tm->tm_mday %= (4*365+1); | ||
2514 | mon_day[1] = 29; | ||
2515 | while (tm->tm_mday >= mon_day[tm->tm_mon]) { | ||
2516 | tm->tm_mday -= mon_day[tm->tm_mon]; | ||
2517 | if (++tm->tm_mon == 12) { | ||
2518 | tm->tm_mon = 0; | ||
2519 | ++tm->tm_year; | ||
2520 | mon_day[1] = 28; | ||
2521 | } | ||
2522 | } | ||
2523 | ++tm->tm_mday; | ||
2524 | } | ||
2525 | |||
2526 | /* | ||
2527 | * Most of this code has been lifted from kernel/timer.c::sys_sysinfo(). | ||
2528 | * I cannot call that code directly from kdb, it has an unconditional | ||
2529 | * cli()/sti() and calls routines that take locks which can stop the debugger. | ||
2530 | */ | ||
2531 | static void kdb_sysinfo(struct sysinfo *val) | ||
2532 | { | ||
2533 | struct timespec uptime; | ||
2534 | do_posix_clock_monotonic_gettime(&uptime); | ||
2535 | memset(val, 0, sizeof(*val)); | ||
2536 | val->uptime = uptime.tv_sec; | ||
2537 | val->loads[0] = avenrun[0]; | ||
2538 | val->loads[1] = avenrun[1]; | ||
2539 | val->loads[2] = avenrun[2]; | ||
2540 | val->procs = nr_threads-1; | ||
2541 | si_meminfo(val); | ||
2542 | |||
2543 | return; | ||
2544 | } | ||
2545 | |||
2546 | /* | ||
2547 | * kdb_summary - This function implements the 'summary' command. | ||
2548 | */ | ||
2549 | static int kdb_summary(int argc, const char **argv) | ||
2550 | { | ||
2551 | struct timespec now; | ||
2552 | struct kdb_tm tm; | ||
2553 | struct sysinfo val; | ||
2554 | |||
2555 | if (argc) | ||
2556 | return KDB_ARGCOUNT; | ||
2557 | |||
2558 | kdb_printf("sysname %s\n", init_uts_ns.name.sysname); | ||
2559 | kdb_printf("release %s\n", init_uts_ns.name.release); | ||
2560 | kdb_printf("version %s\n", init_uts_ns.name.version); | ||
2561 | kdb_printf("machine %s\n", init_uts_ns.name.machine); | ||
2562 | kdb_printf("nodename %s\n", init_uts_ns.name.nodename); | ||
2563 | kdb_printf("domainname %s\n", init_uts_ns.name.domainname); | ||
2564 | kdb_printf("ccversion %s\n", __stringify(CCVERSION)); | ||
2565 | |||
2566 | now = __current_kernel_time(); | ||
2567 | kdb_gmtime(&now, &tm); | ||
2568 | kdb_printf("date %04d-%02d-%02d %02d:%02d:%02d " | ||
2569 | "tz_minuteswest %d\n", | ||
2570 | 1900+tm.tm_year, tm.tm_mon+1, tm.tm_mday, | ||
2571 | tm.tm_hour, tm.tm_min, tm.tm_sec, | ||
2572 | sys_tz.tz_minuteswest); | ||
2573 | |||
2574 | kdb_sysinfo(&val); | ||
2575 | kdb_printf("uptime "); | ||
2576 | if (val.uptime > (24*60*60)) { | ||
2577 | int days = val.uptime / (24*60*60); | ||
2578 | val.uptime %= (24*60*60); | ||
2579 | kdb_printf("%d day%s ", days, days == 1 ? "" : "s"); | ||
2580 | } | ||
2581 | kdb_printf("%02ld:%02ld\n", val.uptime/(60*60), (val.uptime/60)%60); | ||
2582 | |||
2583 | /* lifted from fs/proc/proc_misc.c::loadavg_read_proc() */ | ||
2584 | |||
2585 | #define LOAD_INT(x) ((x) >> FSHIFT) | ||
2586 | #define LOAD_FRAC(x) LOAD_INT(((x) & (FIXED_1-1)) * 100) | ||
2587 | kdb_printf("load avg %ld.%02ld %ld.%02ld %ld.%02ld\n", | ||
2588 | LOAD_INT(val.loads[0]), LOAD_FRAC(val.loads[0]), | ||
2589 | LOAD_INT(val.loads[1]), LOAD_FRAC(val.loads[1]), | ||
2590 | LOAD_INT(val.loads[2]), LOAD_FRAC(val.loads[2])); | ||
2591 | #undef LOAD_INT | ||
2592 | #undef LOAD_FRAC | ||
2593 | /* Display in kilobytes */ | ||
2594 | #define K(x) ((x) << (PAGE_SHIFT - 10)) | ||
2595 | kdb_printf("\nMemTotal: %8lu kB\nMemFree: %8lu kB\n" | ||
2596 | "Buffers: %8lu kB\n", | ||
2597 | val.totalram, val.freeram, val.bufferram); | ||
2598 | return 0; | ||
2599 | } | ||
2600 | |||
2601 | /* | ||
2602 | * kdb_per_cpu - This function implements the 'per_cpu' command. | ||
2603 | */ | ||
2604 | static int kdb_per_cpu(int argc, const char **argv) | ||
2605 | { | ||
2606 | char buf[256], fmtstr[64]; | ||
2607 | kdb_symtab_t symtab; | ||
2608 | cpumask_t suppress = CPU_MASK_NONE; | ||
2609 | int cpu, diag; | ||
2610 | unsigned long addr, val, bytesperword = 0, whichcpu = ~0UL; | ||
2611 | |||
2612 | if (argc < 1 || argc > 3) | ||
2613 | return KDB_ARGCOUNT; | ||
2614 | |||
2615 | snprintf(buf, sizeof(buf), "per_cpu__%s", argv[1]); | ||
2616 | if (!kdbgetsymval(buf, &symtab)) { | ||
2617 | kdb_printf("%s is not a per_cpu variable\n", argv[1]); | ||
2618 | return KDB_BADADDR; | ||
2619 | } | ||
2620 | if (argc >= 2) { | ||
2621 | diag = kdbgetularg(argv[2], &bytesperword); | ||
2622 | if (diag) | ||
2623 | return diag; | ||
2624 | } | ||
2625 | if (!bytesperword) | ||
2626 | bytesperword = KDB_WORD_SIZE; | ||
2627 | else if (bytesperword > KDB_WORD_SIZE) | ||
2628 | return KDB_BADWIDTH; | ||
2629 | sprintf(fmtstr, "%%0%dlx ", (int)(2*bytesperword)); | ||
2630 | if (argc >= 3) { | ||
2631 | diag = kdbgetularg(argv[3], &whichcpu); | ||
2632 | if (diag) | ||
2633 | return diag; | ||
2634 | if (!cpu_online(whichcpu)) { | ||
2635 | kdb_printf("cpu %ld is not online\n", whichcpu); | ||
2636 | return KDB_BADCPUNUM; | ||
2637 | } | ||
2638 | } | ||
2639 | |||
2640 | /* Most architectures use __per_cpu_offset[cpu], some use | ||
2641 | * __per_cpu_offset(cpu), smp has no __per_cpu_offset. | ||
2642 | */ | ||
2643 | #ifdef __per_cpu_offset | ||
2644 | #define KDB_PCU(cpu) __per_cpu_offset(cpu) | ||
2645 | #else | ||
2646 | #ifdef CONFIG_SMP | ||
2647 | #define KDB_PCU(cpu) __per_cpu_offset[cpu] | ||
2648 | #else | ||
2649 | #define KDB_PCU(cpu) 0 | ||
2650 | #endif | ||
2651 | #endif | ||
2652 | |||
2653 | for_each_online_cpu(cpu) { | ||
2654 | if (whichcpu != ~0UL && whichcpu != cpu) | ||
2655 | continue; | ||
2656 | addr = symtab.sym_start + KDB_PCU(cpu); | ||
2657 | diag = kdb_getword(&val, addr, bytesperword); | ||
2658 | if (diag) { | ||
2659 | kdb_printf("%5d " kdb_bfd_vma_fmt0 " - unable to " | ||
2660 | "read, diag=%d\n", cpu, addr, diag); | ||
2661 | continue; | ||
2662 | } | ||
2663 | #ifdef CONFIG_SMP | ||
2664 | if (!val) { | ||
2665 | cpu_set(cpu, suppress); | ||
2666 | continue; | ||
2667 | } | ||
2668 | #endif /* CONFIG_SMP */ | ||
2669 | kdb_printf("%5d ", cpu); | ||
2670 | kdb_md_line(fmtstr, addr, | ||
2671 | bytesperword == KDB_WORD_SIZE, | ||
2672 | 1, bytesperword, 1, 1, 0); | ||
2673 | } | ||
2674 | if (cpus_weight(suppress) == 0) | ||
2675 | return 0; | ||
2676 | kdb_printf("Zero suppressed cpu(s):"); | ||
2677 | for (cpu = first_cpu(suppress); cpu < num_possible_cpus(); | ||
2678 | cpu = next_cpu(cpu, suppress)) { | ||
2679 | kdb_printf(" %d", cpu); | ||
2680 | if (cpu == num_possible_cpus() - 1 || | ||
2681 | next_cpu(cpu, suppress) != cpu + 1) | ||
2682 | continue; | ||
2683 | while (cpu < num_possible_cpus() && | ||
2684 | next_cpu(cpu, suppress) == cpu + 1) | ||
2685 | ++cpu; | ||
2686 | kdb_printf("-%d", cpu); | ||
2687 | } | ||
2688 | kdb_printf("\n"); | ||
2689 | |||
2690 | #undef KDB_PCU | ||
2691 | |||
2692 | return 0; | ||
2693 | } | ||
2694 | |||
2695 | /* | ||
2696 | * display help for the use of cmd | grep pattern | ||
2697 | */ | ||
2698 | static int kdb_grep_help(int argc, const char **argv) | ||
2699 | { | ||
2700 | kdb_printf("Usage of cmd args | grep pattern:\n"); | ||
2701 | kdb_printf(" Any command's output may be filtered through an "); | ||
2702 | kdb_printf("emulated 'pipe'.\n"); | ||
2703 | kdb_printf(" 'grep' is just a key word.\n"); | ||
2704 | kdb_printf(" The pattern may include a very limited set of " | ||
2705 | "metacharacters:\n"); | ||
2706 | kdb_printf(" pattern or ^pattern or pattern$ or ^pattern$\n"); | ||
2707 | kdb_printf(" And if there are spaces in the pattern, you may " | ||
2708 | "quote it:\n"); | ||
2709 | kdb_printf(" \"pat tern\" or \"^pat tern\" or \"pat tern$\"" | ||
2710 | " or \"^pat tern$\"\n"); | ||
2711 | return 0; | ||
2712 | } | ||
2713 | |||
2714 | /* | ||
2715 | * kdb_register_repeat - This function is used to register a kernel | ||
2716 | * debugger command. | ||
2717 | * Inputs: | ||
2718 | * cmd Command name | ||
2719 | * func Function to execute the command | ||
2720 | * usage A simple usage string showing arguments | ||
2721 | * help A simple help string describing command | ||
2722 | * repeat Does the command auto repeat on enter? | ||
2723 | * Returns: | ||
2724 | * zero for success, one if a duplicate command. | ||
2725 | */ | ||
2726 | #define kdb_command_extend 50 /* arbitrary */ | ||
2727 | int kdb_register_repeat(char *cmd, | ||
2728 | kdb_func_t func, | ||
2729 | char *usage, | ||
2730 | char *help, | ||
2731 | short minlen, | ||
2732 | kdb_repeat_t repeat) | ||
2733 | { | ||
2734 | int i; | ||
2735 | kdbtab_t *kp; | ||
2736 | |||
2737 | /* | ||
2738 | * Brute force method to determine duplicates | ||
2739 | */ | ||
2740 | for_each_kdbcmd(kp, i) { | ||
2741 | if (kp->cmd_name && (strcmp(kp->cmd_name, cmd) == 0)) { | ||
2742 | kdb_printf("Duplicate kdb command registered: " | ||
2743 | "%s, func %p help %s\n", cmd, func, help); | ||
2744 | return 1; | ||
2745 | } | ||
2746 | } | ||
2747 | |||
2748 | /* | ||
2749 | * Insert command into first available location in table | ||
2750 | */ | ||
2751 | for_each_kdbcmd(kp, i) { | ||
2752 | if (kp->cmd_name == NULL) | ||
2753 | break; | ||
2754 | } | ||
2755 | |||
2756 | if (i >= kdb_max_commands) { | ||
2757 | kdbtab_t *new = kmalloc((kdb_max_commands - KDB_BASE_CMD_MAX + | ||
2758 | kdb_command_extend) * sizeof(*new), GFP_KDB); | ||
2759 | if (!new) { | ||
2760 | kdb_printf("Could not allocate new kdb_command " | ||
2761 | "table\n"); | ||
2762 | return 1; | ||
2763 | } | ||
2764 | if (kdb_commands) { | ||
2765 | memcpy(new, kdb_commands, | ||
2766 | kdb_max_commands * sizeof(*new)); | ||
2767 | kfree(kdb_commands); | ||
2768 | } | ||
2769 | memset(new + kdb_max_commands, 0, | ||
2770 | kdb_command_extend * sizeof(*new)); | ||
2771 | kdb_commands = new; | ||
2772 | kp = kdb_commands + kdb_max_commands; | ||
2773 | kdb_max_commands += kdb_command_extend; | ||
2774 | } | ||
2775 | |||
2776 | kp->cmd_name = cmd; | ||
2777 | kp->cmd_func = func; | ||
2778 | kp->cmd_usage = usage; | ||
2779 | kp->cmd_help = help; | ||
2780 | kp->cmd_flags = 0; | ||
2781 | kp->cmd_minlen = minlen; | ||
2782 | kp->cmd_repeat = repeat; | ||
2783 | |||
2784 | return 0; | ||
2785 | } | ||
2786 | |||
2787 | /* | ||
2788 | * kdb_register - Compatibility register function for commands that do | ||
2789 | * not need to specify a repeat state. Equivalent to | ||
2790 | * kdb_register_repeat with KDB_REPEAT_NONE. | ||
2791 | * Inputs: | ||
2792 | * cmd Command name | ||
2793 | * func Function to execute the command | ||
2794 | * usage A simple usage string showing arguments | ||
2795 | * help A simple help string describing command | ||
2796 | * Returns: | ||
2797 | * zero for success, one if a duplicate command. | ||
2798 | */ | ||
2799 | int kdb_register(char *cmd, | ||
2800 | kdb_func_t func, | ||
2801 | char *usage, | ||
2802 | char *help, | ||
2803 | short minlen) | ||
2804 | { | ||
2805 | return kdb_register_repeat(cmd, func, usage, help, minlen, | ||
2806 | KDB_REPEAT_NONE); | ||
2807 | } | ||
2808 | |||
2809 | /* | ||
2810 | * kdb_unregister - This function is used to unregister a kernel | ||
2811 | * debugger command. It is generally called when a module which | ||
2812 | * implements kdb commands is unloaded. | ||
2813 | * Inputs: | ||
2814 | * cmd Command name | ||
2815 | * Returns: | ||
2816 | * zero for success, one command not registered. | ||
2817 | */ | ||
2818 | int kdb_unregister(char *cmd) | ||
2819 | { | ||
2820 | int i; | ||
2821 | kdbtab_t *kp; | ||
2822 | |||
2823 | /* | ||
2824 | * find the command. | ||
2825 | */ | ||
2826 | for (i = 0, kp = kdb_commands; i < kdb_max_commands; i++, kp++) { | ||
2827 | if (kp->cmd_name && (strcmp(kp->cmd_name, cmd) == 0)) { | ||
2828 | kp->cmd_name = NULL; | ||
2829 | return 0; | ||
2830 | } | ||
2831 | } | ||
2832 | |||
2833 | /* Couldn't find it. */ | ||
2834 | return 1; | ||
2835 | } | ||
2836 | |||
2837 | /* Initialize the kdb command table. */ | ||
2838 | static void __init kdb_inittab(void) | ||
2839 | { | ||
2840 | int i; | ||
2841 | kdbtab_t *kp; | ||
2842 | |||
2843 | for_each_kdbcmd(kp, i) | ||
2844 | kp->cmd_name = NULL; | ||
2845 | |||
2846 | kdb_register_repeat("md", kdb_md, "<vaddr>", | ||
2847 | "Display Memory Contents, also mdWcN, e.g. md8c1", 1, | ||
2848 | KDB_REPEAT_NO_ARGS); | ||
2849 | kdb_register_repeat("mdr", kdb_md, "<vaddr> <bytes>", | ||
2850 | "Display Raw Memory", 0, KDB_REPEAT_NO_ARGS); | ||
2851 | kdb_register_repeat("mdp", kdb_md, "<paddr> <bytes>", | ||
2852 | "Display Physical Memory", 0, KDB_REPEAT_NO_ARGS); | ||
2853 | kdb_register_repeat("mds", kdb_md, "<vaddr>", | ||
2854 | "Display Memory Symbolically", 0, KDB_REPEAT_NO_ARGS); | ||
2855 | kdb_register_repeat("mm", kdb_mm, "<vaddr> <contents>", | ||
2856 | "Modify Memory Contents", 0, KDB_REPEAT_NO_ARGS); | ||
2857 | kdb_register_repeat("go", kdb_go, "[<vaddr>]", | ||
2858 | "Continue Execution", 1, KDB_REPEAT_NONE); | ||
2859 | kdb_register_repeat("rd", kdb_rd, "", | ||
2860 | "Display Registers", 0, KDB_REPEAT_NONE); | ||
2861 | kdb_register_repeat("rm", kdb_rm, "<reg> <contents>", | ||
2862 | "Modify Registers", 0, KDB_REPEAT_NONE); | ||
2863 | kdb_register_repeat("ef", kdb_ef, "<vaddr>", | ||
2864 | "Display exception frame", 0, KDB_REPEAT_NONE); | ||
2865 | kdb_register_repeat("bt", kdb_bt, "[<vaddr>]", | ||
2866 | "Stack traceback", 1, KDB_REPEAT_NONE); | ||
2867 | kdb_register_repeat("btp", kdb_bt, "<pid>", | ||
2868 | "Display stack for process <pid>", 0, KDB_REPEAT_NONE); | ||
2869 | kdb_register_repeat("bta", kdb_bt, "[DRSTCZEUIMA]", | ||
2870 | "Display stack all processes", 0, KDB_REPEAT_NONE); | ||
2871 | kdb_register_repeat("btc", kdb_bt, "", | ||
2872 | "Backtrace current process on each cpu", 0, KDB_REPEAT_NONE); | ||
2873 | kdb_register_repeat("btt", kdb_bt, "<vaddr>", | ||
2874 | "Backtrace process given its struct task address", 0, | ||
2875 | KDB_REPEAT_NONE); | ||
2876 | kdb_register_repeat("ll", kdb_ll, "<first-element> <linkoffset> <cmd>", | ||
2877 | "Execute cmd for each element in linked list", 0, KDB_REPEAT_NONE); | ||
2878 | kdb_register_repeat("env", kdb_env, "", | ||
2879 | "Show environment variables", 0, KDB_REPEAT_NONE); | ||
2880 | kdb_register_repeat("set", kdb_set, "", | ||
2881 | "Set environment variables", 0, KDB_REPEAT_NONE); | ||
2882 | kdb_register_repeat("help", kdb_help, "", | ||
2883 | "Display Help Message", 1, KDB_REPEAT_NONE); | ||
2884 | kdb_register_repeat("?", kdb_help, "", | ||
2885 | "Display Help Message", 0, KDB_REPEAT_NONE); | ||
2886 | kdb_register_repeat("cpu", kdb_cpu, "<cpunum>", | ||
2887 | "Switch to new cpu", 0, KDB_REPEAT_NONE); | ||
2888 | kdb_register_repeat("kgdb", kdb_kgdb, "", | ||
2889 | "Enter kgdb mode", 0, KDB_REPEAT_NONE); | ||
2890 | kdb_register_repeat("ps", kdb_ps, "[<flags>|A]", | ||
2891 | "Display active task list", 0, KDB_REPEAT_NONE); | ||
2892 | kdb_register_repeat("pid", kdb_pid, "<pidnum>", | ||
2893 | "Switch to another task", 0, KDB_REPEAT_NONE); | ||
2894 | kdb_register_repeat("reboot", kdb_reboot, "", | ||
2895 | "Reboot the machine immediately", 0, KDB_REPEAT_NONE); | ||
2896 | #if defined(CONFIG_MODULES) | ||
2897 | kdb_register_repeat("lsmod", kdb_lsmod, "", | ||
2898 | "List loaded kernel modules", 0, KDB_REPEAT_NONE); | ||
2899 | #endif | ||
2900 | #if defined(CONFIG_MAGIC_SYSRQ) | ||
2901 | kdb_register_repeat("sr", kdb_sr, "<key>", | ||
2902 | "Magic SysRq key", 0, KDB_REPEAT_NONE); | ||
2903 | #endif | ||
2904 | #if defined(CONFIG_PRINTK) | ||
2905 | kdb_register_repeat("dmesg", kdb_dmesg, "[lines]", | ||
2906 | "Display syslog buffer", 0, KDB_REPEAT_NONE); | ||
2907 | #endif | ||
2908 | kdb_register_repeat("defcmd", kdb_defcmd, "name \"usage\" \"help\"", | ||
2909 | "Define a set of commands, down to endefcmd", 0, KDB_REPEAT_NONE); | ||
2910 | kdb_register_repeat("kill", kdb_kill, "<-signal> <pid>", | ||
2911 | "Send a signal to a process", 0, KDB_REPEAT_NONE); | ||
2912 | kdb_register_repeat("summary", kdb_summary, "", | ||
2913 | "Summarize the system", 4, KDB_REPEAT_NONE); | ||
2914 | kdb_register_repeat("per_cpu", kdb_per_cpu, "", | ||
2915 | "Display per_cpu variables", 3, KDB_REPEAT_NONE); | ||
2916 | kdb_register_repeat("grephelp", kdb_grep_help, "", | ||
2917 | "Display help on | grep", 0, KDB_REPEAT_NONE); | ||
2918 | } | ||
2919 | |||
2920 | /* Execute any commands defined in kdb_cmds. */ | ||
2921 | static void __init kdb_cmd_init(void) | ||
2922 | { | ||
2923 | int i, diag; | ||
2924 | for (i = 0; kdb_cmds[i]; ++i) { | ||
2925 | diag = kdb_parse(kdb_cmds[i]); | ||
2926 | if (diag) | ||
2927 | kdb_printf("kdb command %s failed, kdb diag %d\n", | ||
2928 | kdb_cmds[i], diag); | ||
2929 | } | ||
2930 | if (defcmd_in_progress) { | ||
2931 | kdb_printf("Incomplete 'defcmd' set, forcing endefcmd\n"); | ||
2932 | kdb_parse("endefcmd"); | ||
2933 | } | ||
2934 | } | ||
2935 | |||
2936 | /* Intialize kdb_printf, breakpoint tables and kdb state */ | ||
2937 | void __init kdb_init(int lvl) | ||
2938 | { | ||
2939 | static int kdb_init_lvl = KDB_NOT_INITIALIZED; | ||
2940 | int i; | ||
2941 | |||
2942 | if (kdb_init_lvl == KDB_INIT_FULL || lvl <= kdb_init_lvl) | ||
2943 | return; | ||
2944 | for (i = kdb_init_lvl; i < lvl; i++) { | ||
2945 | switch (i) { | ||
2946 | case KDB_NOT_INITIALIZED: | ||
2947 | kdb_inittab(); /* Initialize Command Table */ | ||
2948 | kdb_initbptab(); /* Initialize Breakpoints */ | ||
2949 | break; | ||
2950 | case KDB_INIT_EARLY: | ||
2951 | kdb_cmd_init(); /* Build kdb_cmds tables */ | ||
2952 | break; | ||
2953 | } | ||
2954 | } | ||
2955 | kdb_init_lvl = lvl; | ||
2956 | } | ||
diff --git a/kernel/debug/kdb/kdb_private.h b/kernel/debug/kdb/kdb_private.h new file mode 100644 index 000000000000..be775f7e81e0 --- /dev/null +++ b/kernel/debug/kdb/kdb_private.h | |||
@@ -0,0 +1,305 @@ | |||
1 | #ifndef _KDBPRIVATE_H | ||
2 | #define _KDBPRIVATE_H | ||
3 | |||
4 | /* | ||
5 | * Kernel Debugger Architecture Independent Private Headers | ||
6 | * | ||
7 | * This file is subject to the terms and conditions of the GNU General Public | ||
8 | * License. See the file "COPYING" in the main directory of this archive | ||
9 | * for more details. | ||
10 | * | ||
11 | * Copyright (c) 2000-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
12 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
13 | */ | ||
14 | |||
15 | #include <linux/kgdb.h> | ||
16 | #include "../debug_core.h" | ||
17 | |||
18 | /* Kernel Debugger Error codes. Must not overlap with command codes. */ | ||
19 | #define KDB_NOTFOUND (-1) | ||
20 | #define KDB_ARGCOUNT (-2) | ||
21 | #define KDB_BADWIDTH (-3) | ||
22 | #define KDB_BADRADIX (-4) | ||
23 | #define KDB_NOTENV (-5) | ||
24 | #define KDB_NOENVVALUE (-6) | ||
25 | #define KDB_NOTIMP (-7) | ||
26 | #define KDB_ENVFULL (-8) | ||
27 | #define KDB_ENVBUFFULL (-9) | ||
28 | #define KDB_TOOMANYBPT (-10) | ||
29 | #define KDB_TOOMANYDBREGS (-11) | ||
30 | #define KDB_DUPBPT (-12) | ||
31 | #define KDB_BPTNOTFOUND (-13) | ||
32 | #define KDB_BADMODE (-14) | ||
33 | #define KDB_BADINT (-15) | ||
34 | #define KDB_INVADDRFMT (-16) | ||
35 | #define KDB_BADREG (-17) | ||
36 | #define KDB_BADCPUNUM (-18) | ||
37 | #define KDB_BADLENGTH (-19) | ||
38 | #define KDB_NOBP (-20) | ||
39 | #define KDB_BADADDR (-21) | ||
40 | |||
41 | /* Kernel Debugger Command codes. Must not overlap with error codes. */ | ||
42 | #define KDB_CMD_GO (-1001) | ||
43 | #define KDB_CMD_CPU (-1002) | ||
44 | #define KDB_CMD_SS (-1003) | ||
45 | #define KDB_CMD_SSB (-1004) | ||
46 | #define KDB_CMD_KGDB (-1005) | ||
47 | #define KDB_CMD_KGDB2 (-1006) | ||
48 | |||
49 | /* Internal debug flags */ | ||
50 | #define KDB_DEBUG_FLAG_BP 0x0002 /* Breakpoint subsystem debug */ | ||
51 | #define KDB_DEBUG_FLAG_BB_SUMM 0x0004 /* Basic block analysis, summary only */ | ||
52 | #define KDB_DEBUG_FLAG_AR 0x0008 /* Activation record, generic */ | ||
53 | #define KDB_DEBUG_FLAG_ARA 0x0010 /* Activation record, arch specific */ | ||
54 | #define KDB_DEBUG_FLAG_BB 0x0020 /* All basic block analysis */ | ||
55 | #define KDB_DEBUG_FLAG_STATE 0x0040 /* State flags */ | ||
56 | #define KDB_DEBUG_FLAG_MASK 0xffff /* All debug flags */ | ||
57 | #define KDB_DEBUG_FLAG_SHIFT 16 /* Shift factor for dbflags */ | ||
58 | |||
59 | #define KDB_DEBUG(flag) (kdb_flags & \ | ||
60 | (KDB_DEBUG_FLAG_##flag << KDB_DEBUG_FLAG_SHIFT)) | ||
61 | #define KDB_DEBUG_STATE(text, value) if (KDB_DEBUG(STATE)) \ | ||
62 | kdb_print_state(text, value) | ||
63 | |||
64 | #if BITS_PER_LONG == 32 | ||
65 | |||
66 | #define KDB_PLATFORM_ENV "BYTESPERWORD=4" | ||
67 | |||
68 | #define kdb_machreg_fmt "0x%lx" | ||
69 | #define kdb_machreg_fmt0 "0x%08lx" | ||
70 | #define kdb_bfd_vma_fmt "0x%lx" | ||
71 | #define kdb_bfd_vma_fmt0 "0x%08lx" | ||
72 | #define kdb_elfw_addr_fmt "0x%x" | ||
73 | #define kdb_elfw_addr_fmt0 "0x%08x" | ||
74 | #define kdb_f_count_fmt "%d" | ||
75 | |||
76 | #elif BITS_PER_LONG == 64 | ||
77 | |||
78 | #define KDB_PLATFORM_ENV "BYTESPERWORD=8" | ||
79 | |||
80 | #define kdb_machreg_fmt "0x%lx" | ||
81 | #define kdb_machreg_fmt0 "0x%016lx" | ||
82 | #define kdb_bfd_vma_fmt "0x%lx" | ||
83 | #define kdb_bfd_vma_fmt0 "0x%016lx" | ||
84 | #define kdb_elfw_addr_fmt "0x%x" | ||
85 | #define kdb_elfw_addr_fmt0 "0x%016x" | ||
86 | #define kdb_f_count_fmt "%ld" | ||
87 | |||
88 | #endif | ||
89 | |||
90 | /* | ||
91 | * KDB_MAXBPT describes the total number of breakpoints | ||
92 | * supported by this architecure. | ||
93 | */ | ||
94 | #define KDB_MAXBPT 16 | ||
95 | |||
96 | /* Maximum number of arguments to a function */ | ||
97 | #define KDB_MAXARGS 16 | ||
98 | |||
99 | typedef enum { | ||
100 | KDB_REPEAT_NONE = 0, /* Do not repeat this command */ | ||
101 | KDB_REPEAT_NO_ARGS, /* Repeat the command without arguments */ | ||
102 | KDB_REPEAT_WITH_ARGS, /* Repeat the command including its arguments */ | ||
103 | } kdb_repeat_t; | ||
104 | |||
105 | typedef int (*kdb_func_t)(int, const char **); | ||
106 | |||
107 | /* Symbol table format returned by kallsyms. */ | ||
108 | typedef struct __ksymtab { | ||
109 | unsigned long value; /* Address of symbol */ | ||
110 | const char *mod_name; /* Module containing symbol or | ||
111 | * "kernel" */ | ||
112 | unsigned long mod_start; | ||
113 | unsigned long mod_end; | ||
114 | const char *sec_name; /* Section containing symbol */ | ||
115 | unsigned long sec_start; | ||
116 | unsigned long sec_end; | ||
117 | const char *sym_name; /* Full symbol name, including | ||
118 | * any version */ | ||
119 | unsigned long sym_start; | ||
120 | unsigned long sym_end; | ||
121 | } kdb_symtab_t; | ||
122 | extern int kallsyms_symbol_next(char *prefix_name, int flag); | ||
123 | extern int kallsyms_symbol_complete(char *prefix_name, int max_len); | ||
124 | |||
125 | /* Exported Symbols for kernel loadable modules to use. */ | ||
126 | extern int kdb_register(char *, kdb_func_t, char *, char *, short); | ||
127 | extern int kdb_register_repeat(char *, kdb_func_t, char *, char *, | ||
128 | short, kdb_repeat_t); | ||
129 | extern int kdb_unregister(char *); | ||
130 | |||
131 | extern int kdb_getarea_size(void *, unsigned long, size_t); | ||
132 | extern int kdb_putarea_size(unsigned long, void *, size_t); | ||
133 | |||
134 | /* | ||
135 | * Like get_user and put_user, kdb_getarea and kdb_putarea take variable | ||
136 | * names, not pointers. The underlying *_size functions take pointers. | ||
137 | */ | ||
138 | #define kdb_getarea(x, addr) kdb_getarea_size(&(x), addr, sizeof((x))) | ||
139 | #define kdb_putarea(addr, x) kdb_putarea_size(addr, &(x), sizeof((x))) | ||
140 | |||
141 | extern int kdb_getphysword(unsigned long *word, | ||
142 | unsigned long addr, size_t size); | ||
143 | extern int kdb_getword(unsigned long *, unsigned long, size_t); | ||
144 | extern int kdb_putword(unsigned long, unsigned long, size_t); | ||
145 | |||
146 | extern int kdbgetularg(const char *, unsigned long *); | ||
147 | extern char *kdbgetenv(const char *); | ||
148 | extern int kdbgetaddrarg(int, const char **, int*, unsigned long *, | ||
149 | long *, char **); | ||
150 | extern int kdbgetsymval(const char *, kdb_symtab_t *); | ||
151 | extern int kdbnearsym(unsigned long, kdb_symtab_t *); | ||
152 | extern void kdbnearsym_cleanup(void); | ||
153 | extern char *kdb_strdup(const char *str, gfp_t type); | ||
154 | extern void kdb_symbol_print(unsigned long, const kdb_symtab_t *, unsigned int); | ||
155 | |||
156 | /* Routine for debugging the debugger state. */ | ||
157 | extern void kdb_print_state(const char *, int); | ||
158 | |||
159 | extern int kdb_state; | ||
160 | #define KDB_STATE_KDB 0x00000001 /* Cpu is inside kdb */ | ||
161 | #define KDB_STATE_LEAVING 0x00000002 /* Cpu is leaving kdb */ | ||
162 | #define KDB_STATE_CMD 0x00000004 /* Running a kdb command */ | ||
163 | #define KDB_STATE_KDB_CONTROL 0x00000008 /* This cpu is under | ||
164 | * kdb control */ | ||
165 | #define KDB_STATE_HOLD_CPU 0x00000010 /* Hold this cpu inside kdb */ | ||
166 | #define KDB_STATE_DOING_SS 0x00000020 /* Doing ss command */ | ||
167 | #define KDB_STATE_DOING_SSB 0x00000040 /* Doing ssb command, | ||
168 | * DOING_SS is also set */ | ||
169 | #define KDB_STATE_SSBPT 0x00000080 /* Install breakpoint | ||
170 | * after one ss, independent of | ||
171 | * DOING_SS */ | ||
172 | #define KDB_STATE_REENTRY 0x00000100 /* Valid re-entry into kdb */ | ||
173 | #define KDB_STATE_SUPPRESS 0x00000200 /* Suppress error messages */ | ||
174 | #define KDB_STATE_PAGER 0x00000400 /* pager is available */ | ||
175 | #define KDB_STATE_GO_SWITCH 0x00000800 /* go is switching | ||
176 | * back to initial cpu */ | ||
177 | #define KDB_STATE_PRINTF_LOCK 0x00001000 /* Holds kdb_printf lock */ | ||
178 | #define KDB_STATE_WAIT_IPI 0x00002000 /* Waiting for kdb_ipi() NMI */ | ||
179 | #define KDB_STATE_RECURSE 0x00004000 /* Recursive entry to kdb */ | ||
180 | #define KDB_STATE_IP_ADJUSTED 0x00008000 /* Restart IP has been | ||
181 | * adjusted */ | ||
182 | #define KDB_STATE_GO1 0x00010000 /* go only releases one cpu */ | ||
183 | #define KDB_STATE_KEYBOARD 0x00020000 /* kdb entered via | ||
184 | * keyboard on this cpu */ | ||
185 | #define KDB_STATE_KEXEC 0x00040000 /* kexec issued */ | ||
186 | #define KDB_STATE_DOING_KGDB 0x00080000 /* kgdb enter now issued */ | ||
187 | #define KDB_STATE_DOING_KGDB2 0x00100000 /* kgdb enter now issued */ | ||
188 | #define KDB_STATE_KGDB_TRANS 0x00200000 /* Transition to kgdb */ | ||
189 | #define KDB_STATE_ARCH 0xff000000 /* Reserved for arch | ||
190 | * specific use */ | ||
191 | |||
192 | #define KDB_STATE(flag) (kdb_state & KDB_STATE_##flag) | ||
193 | #define KDB_STATE_SET(flag) ((void)(kdb_state |= KDB_STATE_##flag)) | ||
194 | #define KDB_STATE_CLEAR(flag) ((void)(kdb_state &= ~KDB_STATE_##flag)) | ||
195 | |||
196 | extern int kdb_nextline; /* Current number of lines displayed */ | ||
197 | |||
198 | typedef struct _kdb_bp { | ||
199 | unsigned long bp_addr; /* Address breakpoint is present at */ | ||
200 | unsigned int bp_free:1; /* This entry is available */ | ||
201 | unsigned int bp_enabled:1; /* Breakpoint is active in register */ | ||
202 | unsigned int bp_type:4; /* Uses hardware register */ | ||
203 | unsigned int bp_installed:1; /* Breakpoint is installed */ | ||
204 | unsigned int bp_delay:1; /* Do delayed bp handling */ | ||
205 | unsigned int bp_delayed:1; /* Delayed breakpoint */ | ||
206 | unsigned int bph_length; /* HW break length */ | ||
207 | } kdb_bp_t; | ||
208 | |||
209 | #ifdef CONFIG_KGDB_KDB | ||
210 | extern kdb_bp_t kdb_breakpoints[/* KDB_MAXBPT */]; | ||
211 | |||
212 | /* The KDB shell command table */ | ||
213 | typedef struct _kdbtab { | ||
214 | char *cmd_name; /* Command name */ | ||
215 | kdb_func_t cmd_func; /* Function to execute command */ | ||
216 | char *cmd_usage; /* Usage String for this command */ | ||
217 | char *cmd_help; /* Help message for this command */ | ||
218 | short cmd_flags; /* Parsing flags */ | ||
219 | short cmd_minlen; /* Minimum legal # command | ||
220 | * chars required */ | ||
221 | kdb_repeat_t cmd_repeat; /* Does command auto repeat on enter? */ | ||
222 | } kdbtab_t; | ||
223 | |||
224 | extern int kdb_bt(int, const char **); /* KDB display back trace */ | ||
225 | |||
226 | /* KDB breakpoint management functions */ | ||
227 | extern void kdb_initbptab(void); | ||
228 | extern void kdb_bp_install(struct pt_regs *); | ||
229 | extern void kdb_bp_remove(void); | ||
230 | |||
231 | typedef enum { | ||
232 | KDB_DB_BPT, /* Breakpoint */ | ||
233 | KDB_DB_SS, /* Single-step trap */ | ||
234 | KDB_DB_SSB, /* Single step to branch */ | ||
235 | KDB_DB_SSBPT, /* Single step over breakpoint */ | ||
236 | KDB_DB_NOBPT /* Spurious breakpoint */ | ||
237 | } kdb_dbtrap_t; | ||
238 | |||
239 | extern int kdb_main_loop(kdb_reason_t, kdb_reason_t, | ||
240 | int, kdb_dbtrap_t, struct pt_regs *); | ||
241 | |||
242 | /* Miscellaneous functions and data areas */ | ||
243 | extern int kdb_grepping_flag; | ||
244 | extern char kdb_grep_string[]; | ||
245 | extern int kdb_grep_leading; | ||
246 | extern int kdb_grep_trailing; | ||
247 | extern char *kdb_cmds[]; | ||
248 | extern void kdb_syslog_data(char *syslog_data[]); | ||
249 | extern unsigned long kdb_task_state_string(const char *); | ||
250 | extern char kdb_task_state_char (const struct task_struct *); | ||
251 | extern unsigned long kdb_task_state(const struct task_struct *p, | ||
252 | unsigned long mask); | ||
253 | extern void kdb_ps_suppressed(void); | ||
254 | extern void kdb_ps1(const struct task_struct *p); | ||
255 | extern void kdb_print_nameval(const char *name, unsigned long val); | ||
256 | extern void kdb_send_sig_info(struct task_struct *p, struct siginfo *info); | ||
257 | extern void kdb_meminfo_proc_show(void); | ||
258 | #ifdef CONFIG_KALLSYMS | ||
259 | extern const char *kdb_walk_kallsyms(loff_t *pos); | ||
260 | #else /* ! CONFIG_KALLSYMS */ | ||
261 | static inline const char *kdb_walk_kallsyms(loff_t *pos) | ||
262 | { | ||
263 | return NULL; | ||
264 | } | ||
265 | #endif /* ! CONFIG_KALLSYMS */ | ||
266 | extern char *kdb_getstr(char *, size_t, char *); | ||
267 | |||
268 | /* Defines for kdb_symbol_print */ | ||
269 | #define KDB_SP_SPACEB 0x0001 /* Space before string */ | ||
270 | #define KDB_SP_SPACEA 0x0002 /* Space after string */ | ||
271 | #define KDB_SP_PAREN 0x0004 /* Parenthesis around string */ | ||
272 | #define KDB_SP_VALUE 0x0008 /* Print the value of the address */ | ||
273 | #define KDB_SP_SYMSIZE 0x0010 /* Print the size of the symbol */ | ||
274 | #define KDB_SP_NEWLINE 0x0020 /* Newline after string */ | ||
275 | #define KDB_SP_DEFAULT (KDB_SP_VALUE|KDB_SP_PAREN) | ||
276 | |||
277 | #define KDB_TSK(cpu) kgdb_info[cpu].task | ||
278 | #define KDB_TSKREGS(cpu) kgdb_info[cpu].debuggerinfo | ||
279 | |||
280 | extern struct task_struct *kdb_curr_task(int); | ||
281 | |||
282 | #define kdb_task_has_cpu(p) (task_curr(p)) | ||
283 | |||
284 | /* Simplify coexistence with NPTL */ | ||
285 | #define kdb_do_each_thread(g, p) do_each_thread(g, p) | ||
286 | #define kdb_while_each_thread(g, p) while_each_thread(g, p) | ||
287 | |||
288 | #define GFP_KDB (in_interrupt() ? GFP_ATOMIC : GFP_KERNEL) | ||
289 | |||
290 | extern void *debug_kmalloc(size_t size, gfp_t flags); | ||
291 | extern void debug_kfree(void *); | ||
292 | extern void debug_kusage(void); | ||
293 | |||
294 | extern void kdb_set_current_task(struct task_struct *); | ||
295 | extern struct task_struct *kdb_current_task; | ||
296 | #ifdef CONFIG_MODULES | ||
297 | extern struct list_head *kdb_modules; | ||
298 | #endif /* CONFIG_MODULES */ | ||
299 | |||
300 | extern char kdb_prompt_str[]; | ||
301 | |||
302 | #define KDB_WORD_SIZE ((int)sizeof(unsigned long)) | ||
303 | |||
304 | #endif /* CONFIG_KGDB_KDB */ | ||
305 | #endif /* !_KDBPRIVATE_H */ | ||
diff --git a/kernel/debug/kdb/kdb_support.c b/kernel/debug/kdb/kdb_support.c new file mode 100644 index 000000000000..6b2485dcb050 --- /dev/null +++ b/kernel/debug/kdb/kdb_support.c | |||
@@ -0,0 +1,927 @@ | |||
1 | /* | ||
2 | * Kernel Debugger Architecture Independent Support Functions | ||
3 | * | ||
4 | * This file is subject to the terms and conditions of the GNU General Public | ||
5 | * License. See the file "COPYING" in the main directory of this archive | ||
6 | * for more details. | ||
7 | * | ||
8 | * Copyright (c) 1999-2004 Silicon Graphics, Inc. All Rights Reserved. | ||
9 | * Copyright (c) 2009 Wind River Systems, Inc. All Rights Reserved. | ||
10 | * 03/02/13 added new 2.5 kallsyms <xavier.bru@bull.net> | ||
11 | */ | ||
12 | |||
13 | #include <stdarg.h> | ||
14 | #include <linux/types.h> | ||
15 | #include <linux/sched.h> | ||
16 | #include <linux/mm.h> | ||
17 | #include <linux/kallsyms.h> | ||
18 | #include <linux/stddef.h> | ||
19 | #include <linux/vmalloc.h> | ||
20 | #include <linux/ptrace.h> | ||
21 | #include <linux/module.h> | ||
22 | #include <linux/highmem.h> | ||
23 | #include <linux/hardirq.h> | ||
24 | #include <linux/delay.h> | ||
25 | #include <linux/uaccess.h> | ||
26 | #include <linux/kdb.h> | ||
27 | #include <linux/slab.h> | ||
28 | #include "kdb_private.h" | ||
29 | |||
30 | /* | ||
31 | * kdbgetsymval - Return the address of the given symbol. | ||
32 | * | ||
33 | * Parameters: | ||
34 | * symname Character string containing symbol name | ||
35 | * symtab Structure to receive results | ||
36 | * Returns: | ||
37 | * 0 Symbol not found, symtab zero filled | ||
38 | * 1 Symbol mapped to module/symbol/section, data in symtab | ||
39 | */ | ||
40 | int kdbgetsymval(const char *symname, kdb_symtab_t *symtab) | ||
41 | { | ||
42 | if (KDB_DEBUG(AR)) | ||
43 | kdb_printf("kdbgetsymval: symname=%s, symtab=%p\n", symname, | ||
44 | symtab); | ||
45 | memset(symtab, 0, sizeof(*symtab)); | ||
46 | symtab->sym_start = kallsyms_lookup_name(symname); | ||
47 | if (symtab->sym_start) { | ||
48 | if (KDB_DEBUG(AR)) | ||
49 | kdb_printf("kdbgetsymval: returns 1, " | ||
50 | "symtab->sym_start=0x%lx\n", | ||
51 | symtab->sym_start); | ||
52 | return 1; | ||
53 | } | ||
54 | if (KDB_DEBUG(AR)) | ||
55 | kdb_printf("kdbgetsymval: returns 0\n"); | ||
56 | return 0; | ||
57 | } | ||
58 | EXPORT_SYMBOL(kdbgetsymval); | ||
59 | |||
60 | static char *kdb_name_table[100]; /* arbitrary size */ | ||
61 | |||
62 | /* | ||
63 | * kdbnearsym - Return the name of the symbol with the nearest address | ||
64 | * less than 'addr'. | ||
65 | * | ||
66 | * Parameters: | ||
67 | * addr Address to check for symbol near | ||
68 | * symtab Structure to receive results | ||
69 | * Returns: | ||
70 | * 0 No sections contain this address, symtab zero filled | ||
71 | * 1 Address mapped to module/symbol/section, data in symtab | ||
72 | * Remarks: | ||
73 | * 2.6 kallsyms has a "feature" where it unpacks the name into a | ||
74 | * string. If that string is reused before the caller expects it | ||
75 | * then the caller sees its string change without warning. To | ||
76 | * avoid cluttering up the main kdb code with lots of kdb_strdup, | ||
77 | * tests and kfree calls, kdbnearsym maintains an LRU list of the | ||
78 | * last few unique strings. The list is sized large enough to | ||
79 | * hold active strings, no kdb caller of kdbnearsym makes more | ||
80 | * than ~20 later calls before using a saved value. | ||
81 | */ | ||
82 | int kdbnearsym(unsigned long addr, kdb_symtab_t *symtab) | ||
83 | { | ||
84 | int ret = 0; | ||
85 | unsigned long symbolsize = 0; | ||
86 | unsigned long offset = 0; | ||
87 | #define knt1_size 128 /* must be >= kallsyms table size */ | ||
88 | char *knt1 = NULL; | ||
89 | |||
90 | if (KDB_DEBUG(AR)) | ||
91 | kdb_printf("kdbnearsym: addr=0x%lx, symtab=%p\n", addr, symtab); | ||
92 | memset(symtab, 0, sizeof(*symtab)); | ||
93 | |||
94 | if (addr < 4096) | ||
95 | goto out; | ||
96 | knt1 = debug_kmalloc(knt1_size, GFP_ATOMIC); | ||
97 | if (!knt1) { | ||
98 | kdb_printf("kdbnearsym: addr=0x%lx cannot kmalloc knt1\n", | ||
99 | addr); | ||
100 | goto out; | ||
101 | } | ||
102 | symtab->sym_name = kallsyms_lookup(addr, &symbolsize , &offset, | ||
103 | (char **)(&symtab->mod_name), knt1); | ||
104 | if (offset > 8*1024*1024) { | ||
105 | symtab->sym_name = NULL; | ||
106 | addr = offset = symbolsize = 0; | ||
107 | } | ||
108 | symtab->sym_start = addr - offset; | ||
109 | symtab->sym_end = symtab->sym_start + symbolsize; | ||
110 | ret = symtab->sym_name != NULL && *(symtab->sym_name) != '\0'; | ||
111 | |||
112 | if (ret) { | ||
113 | int i; | ||
114 | /* Another 2.6 kallsyms "feature". Sometimes the sym_name is | ||
115 | * set but the buffer passed into kallsyms_lookup is not used, | ||
116 | * so it contains garbage. The caller has to work out which | ||
117 | * buffer needs to be saved. | ||
118 | * | ||
119 | * What was Rusty smoking when he wrote that code? | ||
120 | */ | ||
121 | if (symtab->sym_name != knt1) { | ||
122 | strncpy(knt1, symtab->sym_name, knt1_size); | ||
123 | knt1[knt1_size-1] = '\0'; | ||
124 | } | ||
125 | for (i = 0; i < ARRAY_SIZE(kdb_name_table); ++i) { | ||
126 | if (kdb_name_table[i] && | ||
127 | strcmp(kdb_name_table[i], knt1) == 0) | ||
128 | break; | ||
129 | } | ||
130 | if (i >= ARRAY_SIZE(kdb_name_table)) { | ||
131 | debug_kfree(kdb_name_table[0]); | ||
132 | memcpy(kdb_name_table, kdb_name_table+1, | ||
133 | sizeof(kdb_name_table[0]) * | ||
134 | (ARRAY_SIZE(kdb_name_table)-1)); | ||
135 | } else { | ||
136 | debug_kfree(knt1); | ||
137 | knt1 = kdb_name_table[i]; | ||
138 | memcpy(kdb_name_table+i, kdb_name_table+i+1, | ||
139 | sizeof(kdb_name_table[0]) * | ||
140 | (ARRAY_SIZE(kdb_name_table)-i-1)); | ||
141 | } | ||
142 | i = ARRAY_SIZE(kdb_name_table) - 1; | ||
143 | kdb_name_table[i] = knt1; | ||
144 | symtab->sym_name = kdb_name_table[i]; | ||
145 | knt1 = NULL; | ||
146 | } | ||
147 | |||
148 | if (symtab->mod_name == NULL) | ||
149 | symtab->mod_name = "kernel"; | ||
150 | if (KDB_DEBUG(AR)) | ||
151 | kdb_printf("kdbnearsym: returns %d symtab->sym_start=0x%lx, " | ||
152 | "symtab->mod_name=%p, symtab->sym_name=%p (%s)\n", ret, | ||
153 | symtab->sym_start, symtab->mod_name, symtab->sym_name, | ||
154 | symtab->sym_name); | ||
155 | |||
156 | out: | ||
157 | debug_kfree(knt1); | ||
158 | return ret; | ||
159 | } | ||
160 | |||
161 | void kdbnearsym_cleanup(void) | ||
162 | { | ||
163 | int i; | ||
164 | for (i = 0; i < ARRAY_SIZE(kdb_name_table); ++i) { | ||
165 | if (kdb_name_table[i]) { | ||
166 | debug_kfree(kdb_name_table[i]); | ||
167 | kdb_name_table[i] = NULL; | ||
168 | } | ||
169 | } | ||
170 | } | ||
171 | |||
172 | static char ks_namebuf[KSYM_NAME_LEN+1], ks_namebuf_prev[KSYM_NAME_LEN+1]; | ||
173 | |||
174 | /* | ||
175 | * kallsyms_symbol_complete | ||
176 | * | ||
177 | * Parameters: | ||
178 | * prefix_name prefix of a symbol name to lookup | ||
179 | * max_len maximum length that can be returned | ||
180 | * Returns: | ||
181 | * Number of symbols which match the given prefix. | ||
182 | * Notes: | ||
183 | * prefix_name is changed to contain the longest unique prefix that | ||
184 | * starts with this prefix (tab completion). | ||
185 | */ | ||
186 | int kallsyms_symbol_complete(char *prefix_name, int max_len) | ||
187 | { | ||
188 | loff_t pos = 0; | ||
189 | int prefix_len = strlen(prefix_name), prev_len = 0; | ||
190 | int i, number = 0; | ||
191 | const char *name; | ||
192 | |||
193 | while ((name = kdb_walk_kallsyms(&pos))) { | ||
194 | if (strncmp(name, prefix_name, prefix_len) == 0) { | ||
195 | strcpy(ks_namebuf, name); | ||
196 | /* Work out the longest name that matches the prefix */ | ||
197 | if (++number == 1) { | ||
198 | prev_len = min_t(int, max_len-1, | ||
199 | strlen(ks_namebuf)); | ||
200 | memcpy(ks_namebuf_prev, ks_namebuf, prev_len); | ||
201 | ks_namebuf_prev[prev_len] = '\0'; | ||
202 | continue; | ||
203 | } | ||
204 | for (i = 0; i < prev_len; i++) { | ||
205 | if (ks_namebuf[i] != ks_namebuf_prev[i]) { | ||
206 | prev_len = i; | ||
207 | ks_namebuf_prev[i] = '\0'; | ||
208 | break; | ||
209 | } | ||
210 | } | ||
211 | } | ||
212 | } | ||
213 | if (prev_len > prefix_len) | ||
214 | memcpy(prefix_name, ks_namebuf_prev, prev_len+1); | ||
215 | return number; | ||
216 | } | ||
217 | |||
218 | /* | ||
219 | * kallsyms_symbol_next | ||
220 | * | ||
221 | * Parameters: | ||
222 | * prefix_name prefix of a symbol name to lookup | ||
223 | * flag 0 means search from the head, 1 means continue search. | ||
224 | * Returns: | ||
225 | * 1 if a symbol matches the given prefix. | ||
226 | * 0 if no string found | ||
227 | */ | ||
228 | int kallsyms_symbol_next(char *prefix_name, int flag) | ||
229 | { | ||
230 | int prefix_len = strlen(prefix_name); | ||
231 | static loff_t pos; | ||
232 | const char *name; | ||
233 | |||
234 | if (!flag) | ||
235 | pos = 0; | ||
236 | |||
237 | while ((name = kdb_walk_kallsyms(&pos))) { | ||
238 | if (strncmp(name, prefix_name, prefix_len) == 0) { | ||
239 | strncpy(prefix_name, name, strlen(name)+1); | ||
240 | return 1; | ||
241 | } | ||
242 | } | ||
243 | return 0; | ||
244 | } | ||
245 | |||
246 | /* | ||
247 | * kdb_symbol_print - Standard method for printing a symbol name and offset. | ||
248 | * Inputs: | ||
249 | * addr Address to be printed. | ||
250 | * symtab Address of symbol data, if NULL this routine does its | ||
251 | * own lookup. | ||
252 | * punc Punctuation for string, bit field. | ||
253 | * Remarks: | ||
254 | * The string and its punctuation is only printed if the address | ||
255 | * is inside the kernel, except that the value is always printed | ||
256 | * when requested. | ||
257 | */ | ||
258 | void kdb_symbol_print(unsigned long addr, const kdb_symtab_t *symtab_p, | ||
259 | unsigned int punc) | ||
260 | { | ||
261 | kdb_symtab_t symtab, *symtab_p2; | ||
262 | if (symtab_p) { | ||
263 | symtab_p2 = (kdb_symtab_t *)symtab_p; | ||
264 | } else { | ||
265 | symtab_p2 = &symtab; | ||
266 | kdbnearsym(addr, symtab_p2); | ||
267 | } | ||
268 | if (!(symtab_p2->sym_name || (punc & KDB_SP_VALUE))) | ||
269 | return; | ||
270 | if (punc & KDB_SP_SPACEB) | ||
271 | kdb_printf(" "); | ||
272 | if (punc & KDB_SP_VALUE) | ||
273 | kdb_printf(kdb_machreg_fmt0, addr); | ||
274 | if (symtab_p2->sym_name) { | ||
275 | if (punc & KDB_SP_VALUE) | ||
276 | kdb_printf(" "); | ||
277 | if (punc & KDB_SP_PAREN) | ||
278 | kdb_printf("("); | ||
279 | if (strcmp(symtab_p2->mod_name, "kernel")) | ||
280 | kdb_printf("[%s]", symtab_p2->mod_name); | ||
281 | kdb_printf("%s", symtab_p2->sym_name); | ||
282 | if (addr != symtab_p2->sym_start) | ||
283 | kdb_printf("+0x%lx", addr - symtab_p2->sym_start); | ||
284 | if (punc & KDB_SP_SYMSIZE) | ||
285 | kdb_printf("/0x%lx", | ||
286 | symtab_p2->sym_end - symtab_p2->sym_start); | ||
287 | if (punc & KDB_SP_PAREN) | ||
288 | kdb_printf(")"); | ||
289 | } | ||
290 | if (punc & KDB_SP_SPACEA) | ||
291 | kdb_printf(" "); | ||
292 | if (punc & KDB_SP_NEWLINE) | ||
293 | kdb_printf("\n"); | ||
294 | } | ||
295 | |||
296 | /* | ||
297 | * kdb_strdup - kdb equivalent of strdup, for disasm code. | ||
298 | * Inputs: | ||
299 | * str The string to duplicate. | ||
300 | * type Flags to kmalloc for the new string. | ||
301 | * Returns: | ||
302 | * Address of the new string, NULL if storage could not be allocated. | ||
303 | * Remarks: | ||
304 | * This is not in lib/string.c because it uses kmalloc which is not | ||
305 | * available when string.o is used in boot loaders. | ||
306 | */ | ||
307 | char *kdb_strdup(const char *str, gfp_t type) | ||
308 | { | ||
309 | int n = strlen(str)+1; | ||
310 | char *s = kmalloc(n, type); | ||
311 | if (!s) | ||
312 | return NULL; | ||
313 | return strcpy(s, str); | ||
314 | } | ||
315 | |||
316 | /* | ||
317 | * kdb_getarea_size - Read an area of data. The kdb equivalent of | ||
318 | * copy_from_user, with kdb messages for invalid addresses. | ||
319 | * Inputs: | ||
320 | * res Pointer to the area to receive the result. | ||
321 | * addr Address of the area to copy. | ||
322 | * size Size of the area. | ||
323 | * Returns: | ||
324 | * 0 for success, < 0 for error. | ||
325 | */ | ||
326 | int kdb_getarea_size(void *res, unsigned long addr, size_t size) | ||
327 | { | ||
328 | int ret = probe_kernel_read((char *)res, (char *)addr, size); | ||
329 | if (ret) { | ||
330 | if (!KDB_STATE(SUPPRESS)) { | ||
331 | kdb_printf("kdb_getarea: Bad address 0x%lx\n", addr); | ||
332 | KDB_STATE_SET(SUPPRESS); | ||
333 | } | ||
334 | ret = KDB_BADADDR; | ||
335 | } else { | ||
336 | KDB_STATE_CLEAR(SUPPRESS); | ||
337 | } | ||
338 | return ret; | ||
339 | } | ||
340 | |||
341 | /* | ||
342 | * kdb_putarea_size - Write an area of data. The kdb equivalent of | ||
343 | * copy_to_user, with kdb messages for invalid addresses. | ||
344 | * Inputs: | ||
345 | * addr Address of the area to write to. | ||
346 | * res Pointer to the area holding the data. | ||
347 | * size Size of the area. | ||
348 | * Returns: | ||
349 | * 0 for success, < 0 for error. | ||
350 | */ | ||
351 | int kdb_putarea_size(unsigned long addr, void *res, size_t size) | ||
352 | { | ||
353 | int ret = probe_kernel_read((char *)addr, (char *)res, size); | ||
354 | if (ret) { | ||
355 | if (!KDB_STATE(SUPPRESS)) { | ||
356 | kdb_printf("kdb_putarea: Bad address 0x%lx\n", addr); | ||
357 | KDB_STATE_SET(SUPPRESS); | ||
358 | } | ||
359 | ret = KDB_BADADDR; | ||
360 | } else { | ||
361 | KDB_STATE_CLEAR(SUPPRESS); | ||
362 | } | ||
363 | return ret; | ||
364 | } | ||
365 | |||
366 | /* | ||
367 | * kdb_getphys - Read data from a physical address. Validate the | ||
368 | * address is in range, use kmap_atomic() to get data | ||
369 | * similar to kdb_getarea() - but for phys addresses | ||
370 | * Inputs: | ||
371 | * res Pointer to the word to receive the result | ||
372 | * addr Physical address of the area to copy | ||
373 | * size Size of the area | ||
374 | * Returns: | ||
375 | * 0 for success, < 0 for error. | ||
376 | */ | ||
377 | static int kdb_getphys(void *res, unsigned long addr, size_t size) | ||
378 | { | ||
379 | unsigned long pfn; | ||
380 | void *vaddr; | ||
381 | struct page *page; | ||
382 | |||
383 | pfn = (addr >> PAGE_SHIFT); | ||
384 | if (!pfn_valid(pfn)) | ||
385 | return 1; | ||
386 | page = pfn_to_page(pfn); | ||
387 | vaddr = kmap_atomic(page, KM_KDB); | ||
388 | memcpy(res, vaddr + (addr & (PAGE_SIZE - 1)), size); | ||
389 | kunmap_atomic(vaddr, KM_KDB); | ||
390 | |||
391 | return 0; | ||
392 | } | ||
393 | |||
394 | /* | ||
395 | * kdb_getphysword | ||
396 | * Inputs: | ||
397 | * word Pointer to the word to receive the result. | ||
398 | * addr Address of the area to copy. | ||
399 | * size Size of the area. | ||
400 | * Returns: | ||
401 | * 0 for success, < 0 for error. | ||
402 | */ | ||
403 | int kdb_getphysword(unsigned long *word, unsigned long addr, size_t size) | ||
404 | { | ||
405 | int diag; | ||
406 | __u8 w1; | ||
407 | __u16 w2; | ||
408 | __u32 w4; | ||
409 | __u64 w8; | ||
410 | *word = 0; /* Default value if addr or size is invalid */ | ||
411 | |||
412 | switch (size) { | ||
413 | case 1: | ||
414 | diag = kdb_getphys(&w1, addr, sizeof(w1)); | ||
415 | if (!diag) | ||
416 | *word = w1; | ||
417 | break; | ||
418 | case 2: | ||
419 | diag = kdb_getphys(&w2, addr, sizeof(w2)); | ||
420 | if (!diag) | ||
421 | *word = w2; | ||
422 | break; | ||
423 | case 4: | ||
424 | diag = kdb_getphys(&w4, addr, sizeof(w4)); | ||
425 | if (!diag) | ||
426 | *word = w4; | ||
427 | break; | ||
428 | case 8: | ||
429 | if (size <= sizeof(*word)) { | ||
430 | diag = kdb_getphys(&w8, addr, sizeof(w8)); | ||
431 | if (!diag) | ||
432 | *word = w8; | ||
433 | break; | ||
434 | } | ||
435 | /* drop through */ | ||
436 | default: | ||
437 | diag = KDB_BADWIDTH; | ||
438 | kdb_printf("kdb_getphysword: bad width %ld\n", (long) size); | ||
439 | } | ||
440 | return diag; | ||
441 | } | ||
442 | |||
443 | /* | ||
444 | * kdb_getword - Read a binary value. Unlike kdb_getarea, this treats | ||
445 | * data as numbers. | ||
446 | * Inputs: | ||
447 | * word Pointer to the word to receive the result. | ||
448 | * addr Address of the area to copy. | ||
449 | * size Size of the area. | ||
450 | * Returns: | ||
451 | * 0 for success, < 0 for error. | ||
452 | */ | ||
453 | int kdb_getword(unsigned long *word, unsigned long addr, size_t size) | ||
454 | { | ||
455 | int diag; | ||
456 | __u8 w1; | ||
457 | __u16 w2; | ||
458 | __u32 w4; | ||
459 | __u64 w8; | ||
460 | *word = 0; /* Default value if addr or size is invalid */ | ||
461 | switch (size) { | ||
462 | case 1: | ||
463 | diag = kdb_getarea(w1, addr); | ||
464 | if (!diag) | ||
465 | *word = w1; | ||
466 | break; | ||
467 | case 2: | ||
468 | diag = kdb_getarea(w2, addr); | ||
469 | if (!diag) | ||
470 | *word = w2; | ||
471 | break; | ||
472 | case 4: | ||
473 | diag = kdb_getarea(w4, addr); | ||
474 | if (!diag) | ||
475 | *word = w4; | ||
476 | break; | ||
477 | case 8: | ||
478 | if (size <= sizeof(*word)) { | ||
479 | diag = kdb_getarea(w8, addr); | ||
480 | if (!diag) | ||
481 | *word = w8; | ||
482 | break; | ||
483 | } | ||
484 | /* drop through */ | ||
485 | default: | ||
486 | diag = KDB_BADWIDTH; | ||
487 | kdb_printf("kdb_getword: bad width %ld\n", (long) size); | ||
488 | } | ||
489 | return diag; | ||
490 | } | ||
491 | |||
492 | /* | ||
493 | * kdb_putword - Write a binary value. Unlike kdb_putarea, this | ||
494 | * treats data as numbers. | ||
495 | * Inputs: | ||
496 | * addr Address of the area to write to.. | ||
497 | * word The value to set. | ||
498 | * size Size of the area. | ||
499 | * Returns: | ||
500 | * 0 for success, < 0 for error. | ||
501 | */ | ||
502 | int kdb_putword(unsigned long addr, unsigned long word, size_t size) | ||
503 | { | ||
504 | int diag; | ||
505 | __u8 w1; | ||
506 | __u16 w2; | ||
507 | __u32 w4; | ||
508 | __u64 w8; | ||
509 | switch (size) { | ||
510 | case 1: | ||
511 | w1 = word; | ||
512 | diag = kdb_putarea(addr, w1); | ||
513 | break; | ||
514 | case 2: | ||
515 | w2 = word; | ||
516 | diag = kdb_putarea(addr, w2); | ||
517 | break; | ||
518 | case 4: | ||
519 | w4 = word; | ||
520 | diag = kdb_putarea(addr, w4); | ||
521 | break; | ||
522 | case 8: | ||
523 | if (size <= sizeof(word)) { | ||
524 | w8 = word; | ||
525 | diag = kdb_putarea(addr, w8); | ||
526 | break; | ||
527 | } | ||
528 | /* drop through */ | ||
529 | default: | ||
530 | diag = KDB_BADWIDTH; | ||
531 | kdb_printf("kdb_putword: bad width %ld\n", (long) size); | ||
532 | } | ||
533 | return diag; | ||
534 | } | ||
535 | |||
536 | /* | ||
537 | * kdb_task_state_string - Convert a string containing any of the | ||
538 | * letters DRSTCZEUIMA to a mask for the process state field and | ||
539 | * return the value. If no argument is supplied, return the mask | ||
540 | * that corresponds to environment variable PS, DRSTCZEU by | ||
541 | * default. | ||
542 | * Inputs: | ||
543 | * s String to convert | ||
544 | * Returns: | ||
545 | * Mask for process state. | ||
546 | * Notes: | ||
547 | * The mask folds data from several sources into a single long value, so | ||
548 | * be carefull not to overlap the bits. TASK_* bits are in the LSB, | ||
549 | * special cases like UNRUNNABLE are in the MSB. As of 2.6.10-rc1 there | ||
550 | * is no overlap between TASK_* and EXIT_* but that may not always be | ||
551 | * true, so EXIT_* bits are shifted left 16 bits before being stored in | ||
552 | * the mask. | ||
553 | */ | ||
554 | |||
555 | /* unrunnable is < 0 */ | ||
556 | #define UNRUNNABLE (1UL << (8*sizeof(unsigned long) - 1)) | ||
557 | #define RUNNING (1UL << (8*sizeof(unsigned long) - 2)) | ||
558 | #define IDLE (1UL << (8*sizeof(unsigned long) - 3)) | ||
559 | #define DAEMON (1UL << (8*sizeof(unsigned long) - 4)) | ||
560 | |||
561 | unsigned long kdb_task_state_string(const char *s) | ||
562 | { | ||
563 | long res = 0; | ||
564 | if (!s) { | ||
565 | s = kdbgetenv("PS"); | ||
566 | if (!s) | ||
567 | s = "DRSTCZEU"; /* default value for ps */ | ||
568 | } | ||
569 | while (*s) { | ||
570 | switch (*s) { | ||
571 | case 'D': | ||
572 | res |= TASK_UNINTERRUPTIBLE; | ||
573 | break; | ||
574 | case 'R': | ||
575 | res |= RUNNING; | ||
576 | break; | ||
577 | case 'S': | ||
578 | res |= TASK_INTERRUPTIBLE; | ||
579 | break; | ||
580 | case 'T': | ||
581 | res |= TASK_STOPPED; | ||
582 | break; | ||
583 | case 'C': | ||
584 | res |= TASK_TRACED; | ||
585 | break; | ||
586 | case 'Z': | ||
587 | res |= EXIT_ZOMBIE << 16; | ||
588 | break; | ||
589 | case 'E': | ||
590 | res |= EXIT_DEAD << 16; | ||
591 | break; | ||
592 | case 'U': | ||
593 | res |= UNRUNNABLE; | ||
594 | break; | ||
595 | case 'I': | ||
596 | res |= IDLE; | ||
597 | break; | ||
598 | case 'M': | ||
599 | res |= DAEMON; | ||
600 | break; | ||
601 | case 'A': | ||
602 | res = ~0UL; | ||
603 | break; | ||
604 | default: | ||
605 | kdb_printf("%s: unknown flag '%c' ignored\n", | ||
606 | __func__, *s); | ||
607 | break; | ||
608 | } | ||
609 | ++s; | ||
610 | } | ||
611 | return res; | ||
612 | } | ||
613 | |||
614 | /* | ||
615 | * kdb_task_state_char - Return the character that represents the task state. | ||
616 | * Inputs: | ||
617 | * p struct task for the process | ||
618 | * Returns: | ||
619 | * One character to represent the task state. | ||
620 | */ | ||
621 | char kdb_task_state_char (const struct task_struct *p) | ||
622 | { | ||
623 | int cpu; | ||
624 | char state; | ||
625 | unsigned long tmp; | ||
626 | |||
627 | if (!p || probe_kernel_read(&tmp, (char *)p, sizeof(unsigned long))) | ||
628 | return 'E'; | ||
629 | |||
630 | cpu = kdb_process_cpu(p); | ||
631 | state = (p->state == 0) ? 'R' : | ||
632 | (p->state < 0) ? 'U' : | ||
633 | (p->state & TASK_UNINTERRUPTIBLE) ? 'D' : | ||
634 | (p->state & TASK_STOPPED) ? 'T' : | ||
635 | (p->state & TASK_TRACED) ? 'C' : | ||
636 | (p->exit_state & EXIT_ZOMBIE) ? 'Z' : | ||
637 | (p->exit_state & EXIT_DEAD) ? 'E' : | ||
638 | (p->state & TASK_INTERRUPTIBLE) ? 'S' : '?'; | ||
639 | if (p->pid == 0) { | ||
640 | /* Idle task. Is it really idle, apart from the kdb | ||
641 | * interrupt? */ | ||
642 | if (!kdb_task_has_cpu(p) || kgdb_info[cpu].irq_depth == 1) { | ||
643 | if (cpu != kdb_initial_cpu) | ||
644 | state = 'I'; /* idle task */ | ||
645 | } | ||
646 | } else if (!p->mm && state == 'S') { | ||
647 | state = 'M'; /* sleeping system daemon */ | ||
648 | } | ||
649 | return state; | ||
650 | } | ||
651 | |||
652 | /* | ||
653 | * kdb_task_state - Return true if a process has the desired state | ||
654 | * given by the mask. | ||
655 | * Inputs: | ||
656 | * p struct task for the process | ||
657 | * mask mask from kdb_task_state_string to select processes | ||
658 | * Returns: | ||
659 | * True if the process matches at least one criteria defined by the mask. | ||
660 | */ | ||
661 | unsigned long kdb_task_state(const struct task_struct *p, unsigned long mask) | ||
662 | { | ||
663 | char state[] = { kdb_task_state_char(p), '\0' }; | ||
664 | return (mask & kdb_task_state_string(state)) != 0; | ||
665 | } | ||
666 | |||
667 | /* | ||
668 | * kdb_print_nameval - Print a name and its value, converting the | ||
669 | * value to a symbol lookup if possible. | ||
670 | * Inputs: | ||
671 | * name field name to print | ||
672 | * val value of field | ||
673 | */ | ||
674 | void kdb_print_nameval(const char *name, unsigned long val) | ||
675 | { | ||
676 | kdb_symtab_t symtab; | ||
677 | kdb_printf(" %-11.11s ", name); | ||
678 | if (kdbnearsym(val, &symtab)) | ||
679 | kdb_symbol_print(val, &symtab, | ||
680 | KDB_SP_VALUE|KDB_SP_SYMSIZE|KDB_SP_NEWLINE); | ||
681 | else | ||
682 | kdb_printf("0x%lx\n", val); | ||
683 | } | ||
684 | |||
685 | /* Last ditch allocator for debugging, so we can still debug even when | ||
686 | * the GFP_ATOMIC pool has been exhausted. The algorithms are tuned | ||
687 | * for space usage, not for speed. One smallish memory pool, the free | ||
688 | * chain is always in ascending address order to allow coalescing, | ||
689 | * allocations are done in brute force best fit. | ||
690 | */ | ||
691 | |||
692 | struct debug_alloc_header { | ||
693 | u32 next; /* offset of next header from start of pool */ | ||
694 | u32 size; | ||
695 | void *caller; | ||
696 | }; | ||
697 | |||
698 | /* The memory returned by this allocator must be aligned, which means | ||
699 | * so must the header size. Do not assume that sizeof(struct | ||
700 | * debug_alloc_header) is a multiple of the alignment, explicitly | ||
701 | * calculate the overhead of this header, including the alignment. | ||
702 | * The rest of this code must not use sizeof() on any header or | ||
703 | * pointer to a header. | ||
704 | */ | ||
705 | #define dah_align 8 | ||
706 | #define dah_overhead ALIGN(sizeof(struct debug_alloc_header), dah_align) | ||
707 | |||
708 | static u64 debug_alloc_pool_aligned[256*1024/dah_align]; /* 256K pool */ | ||
709 | static char *debug_alloc_pool = (char *)debug_alloc_pool_aligned; | ||
710 | static u32 dah_first, dah_first_call = 1, dah_used, dah_used_max; | ||
711 | |||
712 | /* Locking is awkward. The debug code is called from all contexts, | ||
713 | * including non maskable interrupts. A normal spinlock is not safe | ||
714 | * in NMI context. Try to get the debug allocator lock, if it cannot | ||
715 | * be obtained after a second then give up. If the lock could not be | ||
716 | * previously obtained on this cpu then only try once. | ||
717 | * | ||
718 | * sparse has no annotation for "this function _sometimes_ acquires a | ||
719 | * lock", so fudge the acquire/release notation. | ||
720 | */ | ||
721 | static DEFINE_SPINLOCK(dap_lock); | ||
722 | static int get_dap_lock(void) | ||
723 | __acquires(dap_lock) | ||
724 | { | ||
725 | static int dap_locked = -1; | ||
726 | int count; | ||
727 | if (dap_locked == smp_processor_id()) | ||
728 | count = 1; | ||
729 | else | ||
730 | count = 1000; | ||
731 | while (1) { | ||
732 | if (spin_trylock(&dap_lock)) { | ||
733 | dap_locked = -1; | ||
734 | return 1; | ||
735 | } | ||
736 | if (!count--) | ||
737 | break; | ||
738 | udelay(1000); | ||
739 | } | ||
740 | dap_locked = smp_processor_id(); | ||
741 | __acquire(dap_lock); | ||
742 | return 0; | ||
743 | } | ||
744 | |||
745 | void *debug_kmalloc(size_t size, gfp_t flags) | ||
746 | { | ||
747 | unsigned int rem, h_offset; | ||
748 | struct debug_alloc_header *best, *bestprev, *prev, *h; | ||
749 | void *p = NULL; | ||
750 | if (!get_dap_lock()) { | ||
751 | __release(dap_lock); /* we never actually got it */ | ||
752 | return NULL; | ||
753 | } | ||
754 | h = (struct debug_alloc_header *)(debug_alloc_pool + dah_first); | ||
755 | if (dah_first_call) { | ||
756 | h->size = sizeof(debug_alloc_pool_aligned) - dah_overhead; | ||
757 | dah_first_call = 0; | ||
758 | } | ||
759 | size = ALIGN(size, dah_align); | ||
760 | prev = best = bestprev = NULL; | ||
761 | while (1) { | ||
762 | if (h->size >= size && (!best || h->size < best->size)) { | ||
763 | best = h; | ||
764 | bestprev = prev; | ||
765 | if (h->size == size) | ||
766 | break; | ||
767 | } | ||
768 | if (!h->next) | ||
769 | break; | ||
770 | prev = h; | ||
771 | h = (struct debug_alloc_header *)(debug_alloc_pool + h->next); | ||
772 | } | ||
773 | if (!best) | ||
774 | goto out; | ||
775 | rem = best->size - size; | ||
776 | /* The pool must always contain at least one header */ | ||
777 | if (best->next == 0 && bestprev == NULL && rem < dah_overhead) | ||
778 | goto out; | ||
779 | if (rem >= dah_overhead) { | ||
780 | best->size = size; | ||
781 | h_offset = ((char *)best - debug_alloc_pool) + | ||
782 | dah_overhead + best->size; | ||
783 | h = (struct debug_alloc_header *)(debug_alloc_pool + h_offset); | ||
784 | h->size = rem - dah_overhead; | ||
785 | h->next = best->next; | ||
786 | } else | ||
787 | h_offset = best->next; | ||
788 | best->caller = __builtin_return_address(0); | ||
789 | dah_used += best->size; | ||
790 | dah_used_max = max(dah_used, dah_used_max); | ||
791 | if (bestprev) | ||
792 | bestprev->next = h_offset; | ||
793 | else | ||
794 | dah_first = h_offset; | ||
795 | p = (char *)best + dah_overhead; | ||
796 | memset(p, POISON_INUSE, best->size - 1); | ||
797 | *((char *)p + best->size - 1) = POISON_END; | ||
798 | out: | ||
799 | spin_unlock(&dap_lock); | ||
800 | return p; | ||
801 | } | ||
802 | |||
803 | void debug_kfree(void *p) | ||
804 | { | ||
805 | struct debug_alloc_header *h; | ||
806 | unsigned int h_offset; | ||
807 | if (!p) | ||
808 | return; | ||
809 | if ((char *)p < debug_alloc_pool || | ||
810 | (char *)p >= debug_alloc_pool + sizeof(debug_alloc_pool_aligned)) { | ||
811 | kfree(p); | ||
812 | return; | ||
813 | } | ||
814 | if (!get_dap_lock()) { | ||
815 | __release(dap_lock); /* we never actually got it */ | ||
816 | return; /* memory leak, cannot be helped */ | ||
817 | } | ||
818 | h = (struct debug_alloc_header *)((char *)p - dah_overhead); | ||
819 | memset(p, POISON_FREE, h->size - 1); | ||
820 | *((char *)p + h->size - 1) = POISON_END; | ||
821 | h->caller = NULL; | ||
822 | dah_used -= h->size; | ||
823 | h_offset = (char *)h - debug_alloc_pool; | ||
824 | if (h_offset < dah_first) { | ||
825 | h->next = dah_first; | ||
826 | dah_first = h_offset; | ||
827 | } else { | ||
828 | struct debug_alloc_header *prev; | ||
829 | unsigned int prev_offset; | ||
830 | prev = (struct debug_alloc_header *)(debug_alloc_pool + | ||
831 | dah_first); | ||
832 | while (1) { | ||
833 | if (!prev->next || prev->next > h_offset) | ||
834 | break; | ||
835 | prev = (struct debug_alloc_header *) | ||
836 | (debug_alloc_pool + prev->next); | ||
837 | } | ||
838 | prev_offset = (char *)prev - debug_alloc_pool; | ||
839 | if (prev_offset + dah_overhead + prev->size == h_offset) { | ||
840 | prev->size += dah_overhead + h->size; | ||
841 | memset(h, POISON_FREE, dah_overhead - 1); | ||
842 | *((char *)h + dah_overhead - 1) = POISON_END; | ||
843 | h = prev; | ||
844 | h_offset = prev_offset; | ||
845 | } else { | ||
846 | h->next = prev->next; | ||
847 | prev->next = h_offset; | ||
848 | } | ||
849 | } | ||
850 | if (h_offset + dah_overhead + h->size == h->next) { | ||
851 | struct debug_alloc_header *next; | ||
852 | next = (struct debug_alloc_header *) | ||
853 | (debug_alloc_pool + h->next); | ||
854 | h->size += dah_overhead + next->size; | ||
855 | h->next = next->next; | ||
856 | memset(next, POISON_FREE, dah_overhead - 1); | ||
857 | *((char *)next + dah_overhead - 1) = POISON_END; | ||
858 | } | ||
859 | spin_unlock(&dap_lock); | ||
860 | } | ||
861 | |||
862 | void debug_kusage(void) | ||
863 | { | ||
864 | struct debug_alloc_header *h_free, *h_used; | ||
865 | #ifdef CONFIG_IA64 | ||
866 | /* FIXME: using dah for ia64 unwind always results in a memory leak. | ||
867 | * Fix that memory leak first, then set debug_kusage_one_time = 1 for | ||
868 | * all architectures. | ||
869 | */ | ||
870 | static int debug_kusage_one_time; | ||
871 | #else | ||
872 | static int debug_kusage_one_time = 1; | ||
873 | #endif | ||
874 | if (!get_dap_lock()) { | ||
875 | __release(dap_lock); /* we never actually got it */ | ||
876 | return; | ||
877 | } | ||
878 | h_free = (struct debug_alloc_header *)(debug_alloc_pool + dah_first); | ||
879 | if (dah_first == 0 && | ||
880 | (h_free->size == sizeof(debug_alloc_pool_aligned) - dah_overhead || | ||
881 | dah_first_call)) | ||
882 | goto out; | ||
883 | if (!debug_kusage_one_time) | ||
884 | goto out; | ||
885 | debug_kusage_one_time = 0; | ||
886 | kdb_printf("%s: debug_kmalloc memory leak dah_first %d\n", | ||
887 | __func__, dah_first); | ||
888 | if (dah_first) { | ||
889 | h_used = (struct debug_alloc_header *)debug_alloc_pool; | ||
890 | kdb_printf("%s: h_used %p size %d\n", __func__, h_used, | ||
891 | h_used->size); | ||
892 | } | ||
893 | do { | ||
894 | h_used = (struct debug_alloc_header *) | ||
895 | ((char *)h_free + dah_overhead + h_free->size); | ||
896 | kdb_printf("%s: h_used %p size %d caller %p\n", | ||
897 | __func__, h_used, h_used->size, h_used->caller); | ||
898 | h_free = (struct debug_alloc_header *) | ||
899 | (debug_alloc_pool + h_free->next); | ||
900 | } while (h_free->next); | ||
901 | h_used = (struct debug_alloc_header *) | ||
902 | ((char *)h_free + dah_overhead + h_free->size); | ||
903 | if ((char *)h_used - debug_alloc_pool != | ||
904 | sizeof(debug_alloc_pool_aligned)) | ||
905 | kdb_printf("%s: h_used %p size %d caller %p\n", | ||
906 | __func__, h_used, h_used->size, h_used->caller); | ||
907 | out: | ||
908 | spin_unlock(&dap_lock); | ||
909 | } | ||
910 | |||
911 | /* Maintain a small stack of kdb_flags to allow recursion without disturbing | ||
912 | * the global kdb state. | ||
913 | */ | ||
914 | |||
915 | static int kdb_flags_stack[4], kdb_flags_index; | ||
916 | |||
917 | void kdb_save_flags(void) | ||
918 | { | ||
919 | BUG_ON(kdb_flags_index >= ARRAY_SIZE(kdb_flags_stack)); | ||
920 | kdb_flags_stack[kdb_flags_index++] = kdb_flags; | ||
921 | } | ||
922 | |||
923 | void kdb_restore_flags(void) | ||
924 | { | ||
925 | BUG_ON(kdb_flags_index <= 0); | ||
926 | kdb_flags = kdb_flags_stack[--kdb_flags_index]; | ||
927 | } | ||