]>
Commit | Line | Data |
---|---|---|
e8d31c20 JW |
1 | /* |
2 | * kgdbts is a test suite for kgdb for the sole purpose of validating | |
3 | * that key pieces of the kgdb internals are working properly such as | |
4 | * HW/SW breakpoints, single stepping, and NMI. | |
5 | * | |
6 | * Created by: Jason Wessel <jason.wessel@windriver.com> | |
7 | * | |
8 | * Copyright (c) 2008 Wind River Systems, Inc. | |
9 | * | |
10 | * This program is free software; you can redistribute it and/or modify | |
11 | * it under the terms of the GNU General Public License version 2 as | |
12 | * published by the Free Software Foundation. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, | |
15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. | |
17 | * See the GNU General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA | |
22 | */ | |
23 | /* Information about the kgdb test suite. | |
24 | * ------------------------------------- | |
25 | * | |
26 | * The kgdb test suite is designed as a KGDB I/O module which | |
27 | * simulates the communications that a debugger would have with kgdb. | |
28 | * The tests are broken up in to a line by line and referenced here as | |
29 | * a "get" which is kgdb requesting input and "put" which is kgdb | |
30 | * sending a response. | |
31 | * | |
32 | * The kgdb suite can be invoked from the kernel command line | |
33 | * arguments system or executed dynamically at run time. The test | |
34 | * suite uses the variable "kgdbts" to obtain the information about | |
35 | * which tests to run and to configure the verbosity level. The | |
36 | * following are the various characters you can use with the kgdbts= | |
37 | * line: | |
38 | * | |
39 | * When using the "kgdbts=" you only choose one of the following core | |
40 | * test types: | |
41 | * A = Run all the core tests silently | |
42 | * V1 = Run all the core tests with minimal output | |
43 | * V2 = Run all the core tests in debug mode | |
44 | * | |
45 | * You can also specify optional tests: | |
46 | * N## = Go to sleep with interrupts of for ## seconds | |
47 | * to test the HW NMI watchdog | |
48 | * F## = Break at do_fork for ## iterations | |
49 | * S## = Break at sys_open for ## iterations | |
7cfcd985 | 50 | * I## = Run the single step test ## iterations |
e8d31c20 JW |
51 | * |
52 | * NOTE: that the do_fork and sys_open tests are mutually exclusive. | |
53 | * | |
54 | * To invoke the kgdb test suite from boot you use a kernel start | |
55 | * argument as follows: | |
56 | * kgdbts=V1 kgdbwait | |
57 | * Or if you wanted to perform the NMI test for 6 seconds and do_fork | |
58 | * test for 100 forks, you could use: | |
59 | * kgdbts=V1N6F100 kgdbwait | |
60 | * | |
61 | * The test suite can also be invoked at run time with: | |
62 | * echo kgdbts=V1N6F100 > /sys/module/kgdbts/parameters/kgdbts | |
63 | * Or as another example: | |
64 | * echo kgdbts=V2 > /sys/module/kgdbts/parameters/kgdbts | |
65 | * | |
66 | * When developing a new kgdb arch specific implementation or | |
67 | * using these tests for the purpose of regression testing, | |
68 | * several invocations are required. | |
69 | * | |
70 | * 1) Boot with the test suite enabled by using the kernel arguments | |
71 | * "kgdbts=V1F100 kgdbwait" | |
72 | * ## If kgdb arch specific implementation has NMI use | |
73 | * "kgdbts=V1N6F100 | |
74 | * | |
75 | * 2) After the system boot run the basic test. | |
76 | * echo kgdbts=V1 > /sys/module/kgdbts/parameters/kgdbts | |
77 | * | |
78 | * 3) Run the concurrency tests. It is best to use n+1 | |
79 | * while loops where n is the number of cpus you have | |
80 | * in your system. The example below uses only two | |
81 | * loops. | |
82 | * | |
83 | * ## This tests break points on sys_open | |
84 | * while [ 1 ] ; do find / > /dev/null 2>&1 ; done & | |
85 | * while [ 1 ] ; do find / > /dev/null 2>&1 ; done & | |
86 | * echo kgdbts=V1S10000 > /sys/module/kgdbts/parameters/kgdbts | |
87 | * fg # and hit control-c | |
88 | * fg # and hit control-c | |
89 | * ## This tests break points on do_fork | |
90 | * while [ 1 ] ; do date > /dev/null ; done & | |
91 | * while [ 1 ] ; do date > /dev/null ; done & | |
92 | * echo kgdbts=V1F1000 > /sys/module/kgdbts/parameters/kgdbts | |
93 | * fg # and hit control-c | |
94 | * | |
95 | */ | |
96 | ||
97 | #include <linux/kernel.h> | |
98 | #include <linux/kgdb.h> | |
99 | #include <linux/ctype.h> | |
100 | #include <linux/uaccess.h> | |
101 | #include <linux/syscalls.h> | |
102 | #include <linux/nmi.h> | |
103 | #include <linux/delay.h> | |
104 | #include <linux/kthread.h> | |
eb12a679 | 105 | #include <linux/module.h> |
e8d31c20 JW |
106 | |
107 | #define v1printk(a...) do { \ | |
108 | if (verbose) \ | |
109 | printk(KERN_INFO a); \ | |
110 | } while (0) | |
111 | #define v2printk(a...) do { \ | |
112 | if (verbose > 1) \ | |
113 | printk(KERN_INFO a); \ | |
114 | touch_nmi_watchdog(); \ | |
115 | } while (0) | |
974460c5 JW |
116 | #define eprintk(a...) do { \ |
117 | printk(KERN_ERR a); \ | |
118 | WARN_ON(1); \ | |
119 | } while (0) | |
e8d31c20 JW |
120 | #define MAX_CONFIG_LEN 40 |
121 | ||
e8d31c20 JW |
122 | static struct kgdb_io kgdbts_io_ops; |
123 | static char get_buf[BUFMAX]; | |
124 | static int get_buf_cnt; | |
125 | static char put_buf[BUFMAX]; | |
126 | static int put_buf_cnt; | |
127 | static char scratch_buf[BUFMAX]; | |
128 | static int verbose; | |
129 | static int repeat_test; | |
130 | static int test_complete; | |
131 | static int send_ack; | |
132 | static int final_ack; | |
b33cb815 JW |
133 | static int force_hwbrks; |
134 | static int hwbreaks_ok; | |
e8d31c20 JW |
135 | static int hw_break_val; |
136 | static int hw_break_val2; | |
4d7ffa49 | 137 | #if defined(CONFIG_ARM) || defined(CONFIG_MIPS) || defined(CONFIG_SPARC) |
e8d31c20 JW |
138 | static int arch_needs_sstep_emulation = 1; |
139 | #else | |
140 | static int arch_needs_sstep_emulation; | |
141 | #endif | |
142 | static unsigned long sstep_addr; | |
143 | static int sstep_state; | |
144 | ||
145 | /* Storage for the registers, in GDB format. */ | |
146 | static unsigned long kgdbts_gdb_regs[(NUMREGBYTES + | |
147 | sizeof(unsigned long) - 1) / | |
148 | sizeof(unsigned long)]; | |
149 | static struct pt_regs kgdbts_regs; | |
150 | ||
151 | /* -1 = init not run yet, 0 = unconfigured, 1 = configured. */ | |
152 | static int configured = -1; | |
153 | ||
974460c5 JW |
154 | #ifdef CONFIG_KGDB_TESTS_BOOT_STRING |
155 | static char config[MAX_CONFIG_LEN] = CONFIG_KGDB_TESTS_BOOT_STRING; | |
156 | #else | |
e8d31c20 | 157 | static char config[MAX_CONFIG_LEN]; |
974460c5 | 158 | #endif |
e8d31c20 JW |
159 | static struct kparam_string kps = { |
160 | .string = config, | |
161 | .maxlen = MAX_CONFIG_LEN, | |
162 | }; | |
163 | ||
164 | static void fill_get_buf(char *buf); | |
165 | ||
166 | struct test_struct { | |
167 | char *get; | |
168 | char *put; | |
169 | void (*get_handler)(char *); | |
170 | int (*put_handler)(char *, char *); | |
171 | }; | |
172 | ||
173 | struct test_state { | |
174 | char *name; | |
175 | struct test_struct *tst; | |
176 | int idx; | |
177 | int (*run_test) (int, int); | |
178 | int (*validate_put) (char *); | |
179 | }; | |
180 | ||
181 | static struct test_state ts; | |
182 | ||
183 | static int kgdbts_unreg_thread(void *ptr) | |
184 | { | |
185 | /* Wait until the tests are complete and then ungresiter the I/O | |
186 | * driver. | |
187 | */ | |
188 | while (!final_ack) | |
189 | msleep_interruptible(1500); | |
190 | ||
191 | if (configured) | |
192 | kgdb_unregister_io_module(&kgdbts_io_ops); | |
193 | configured = 0; | |
194 | ||
195 | return 0; | |
196 | } | |
197 | ||
198 | /* This is noinline such that it can be used for a single location to | |
199 | * place a breakpoint | |
200 | */ | |
201 | static noinline void kgdbts_break_test(void) | |
202 | { | |
203 | v2printk("kgdbts: breakpoint complete\n"); | |
204 | } | |
205 | ||
206 | /* Lookup symbol info in the kernel */ | |
207 | static unsigned long lookup_addr(char *arg) | |
208 | { | |
209 | unsigned long addr = 0; | |
210 | ||
211 | if (!strcmp(arg, "kgdbts_break_test")) | |
212 | addr = (unsigned long)kgdbts_break_test; | |
213 | else if (!strcmp(arg, "sys_open")) | |
214 | addr = (unsigned long)sys_open; | |
215 | else if (!strcmp(arg, "do_fork")) | |
216 | addr = (unsigned long)do_fork; | |
217 | else if (!strcmp(arg, "hw_break_val")) | |
218 | addr = (unsigned long)&hw_break_val; | |
219 | return addr; | |
220 | } | |
221 | ||
222 | static void break_helper(char *bp_type, char *arg, unsigned long vaddr) | |
223 | { | |
224 | unsigned long addr; | |
225 | ||
226 | if (arg) | |
227 | addr = lookup_addr(arg); | |
228 | else | |
229 | addr = vaddr; | |
230 | ||
231 | sprintf(scratch_buf, "%s,%lx,%i", bp_type, addr, | |
232 | BREAK_INSTR_SIZE); | |
233 | fill_get_buf(scratch_buf); | |
234 | } | |
235 | ||
236 | static void sw_break(char *arg) | |
237 | { | |
b33cb815 | 238 | break_helper(force_hwbrks ? "Z1" : "Z0", arg, 0); |
e8d31c20 JW |
239 | } |
240 | ||
241 | static void sw_rem_break(char *arg) | |
242 | { | |
b33cb815 | 243 | break_helper(force_hwbrks ? "z1" : "z0", arg, 0); |
e8d31c20 JW |
244 | } |
245 | ||
246 | static void hw_break(char *arg) | |
247 | { | |
248 | break_helper("Z1", arg, 0); | |
249 | } | |
250 | ||
251 | static void hw_rem_break(char *arg) | |
252 | { | |
253 | break_helper("z1", arg, 0); | |
254 | } | |
255 | ||
256 | static void hw_write_break(char *arg) | |
257 | { | |
258 | break_helper("Z2", arg, 0); | |
259 | } | |
260 | ||
261 | static void hw_rem_write_break(char *arg) | |
262 | { | |
263 | break_helper("z2", arg, 0); | |
264 | } | |
265 | ||
266 | static void hw_access_break(char *arg) | |
267 | { | |
268 | break_helper("Z4", arg, 0); | |
269 | } | |
270 | ||
271 | static void hw_rem_access_break(char *arg) | |
272 | { | |
273 | break_helper("z4", arg, 0); | |
274 | } | |
275 | ||
276 | static void hw_break_val_access(void) | |
277 | { | |
278 | hw_break_val2 = hw_break_val; | |
279 | } | |
280 | ||
281 | static void hw_break_val_write(void) | |
282 | { | |
283 | hw_break_val++; | |
284 | } | |
285 | ||
286 | static int check_and_rewind_pc(char *put_str, char *arg) | |
287 | { | |
288 | unsigned long addr = lookup_addr(arg); | |
63ab25eb | 289 | unsigned long ip; |
e8d31c20 JW |
290 | int offset = 0; |
291 | ||
292 | kgdb_hex2mem(&put_str[1], (char *)kgdbts_gdb_regs, | |
293 | NUMREGBYTES); | |
294 | gdb_regs_to_pt_regs(kgdbts_gdb_regs, &kgdbts_regs); | |
63ab25eb MF |
295 | ip = instruction_pointer(&kgdbts_regs); |
296 | v2printk("Stopped at IP: %lx\n", ip); | |
297 | #ifdef GDB_ADJUSTS_BREAK_OFFSET | |
298 | /* On some arches, a breakpoint stop requires it to be decremented */ | |
299 | if (addr + BREAK_INSTR_SIZE == ip) | |
300 | offset = -BREAK_INSTR_SIZE; | |
e8d31c20 | 301 | #endif |
63ab25eb | 302 | if (strcmp(arg, "silent") && ip + offset != addr) { |
974460c5 | 303 | eprintk("kgdbts: BP mismatch %lx expected %lx\n", |
63ab25eb | 304 | ip + offset, addr); |
e8d31c20 JW |
305 | return 1; |
306 | } | |
63ab25eb | 307 | /* Readjust the instruction pointer if needed */ |
603d04b2 MF |
308 | ip += offset; |
309 | #ifdef GDB_ADJUSTS_BREAK_OFFSET | |
310 | instruction_pointer_set(&kgdbts_regs, ip); | |
311 | #endif | |
e8d31c20 JW |
312 | return 0; |
313 | } | |
314 | ||
315 | static int check_single_step(char *put_str, char *arg) | |
316 | { | |
317 | unsigned long addr = lookup_addr(arg); | |
318 | /* | |
319 | * From an arch indepent point of view the instruction pointer | |
320 | * should be on a different instruction | |
321 | */ | |
322 | kgdb_hex2mem(&put_str[1], (char *)kgdbts_gdb_regs, | |
323 | NUMREGBYTES); | |
324 | gdb_regs_to_pt_regs(kgdbts_gdb_regs, &kgdbts_regs); | |
325 | v2printk("Singlestep stopped at IP: %lx\n", | |
326 | instruction_pointer(&kgdbts_regs)); | |
327 | if (instruction_pointer(&kgdbts_regs) == addr) { | |
974460c5 | 328 | eprintk("kgdbts: SingleStep failed at %lx\n", |
e8d31c20 JW |
329 | instruction_pointer(&kgdbts_regs)); |
330 | return 1; | |
331 | } | |
332 | ||
333 | return 0; | |
334 | } | |
335 | ||
336 | static void write_regs(char *arg) | |
337 | { | |
338 | memset(scratch_buf, 0, sizeof(scratch_buf)); | |
339 | scratch_buf[0] = 'G'; | |
340 | pt_regs_to_gdb_regs(kgdbts_gdb_regs, &kgdbts_regs); | |
341 | kgdb_mem2hex((char *)kgdbts_gdb_regs, &scratch_buf[1], NUMREGBYTES); | |
342 | fill_get_buf(scratch_buf); | |
343 | } | |
344 | ||
345 | static void skip_back_repeat_test(char *arg) | |
346 | { | |
347 | int go_back = simple_strtol(arg, NULL, 10); | |
348 | ||
349 | repeat_test--; | |
350 | if (repeat_test <= 0) | |
351 | ts.idx++; | |
352 | else | |
353 | ts.idx -= go_back; | |
354 | fill_get_buf(ts.tst[ts.idx].get); | |
355 | } | |
356 | ||
357 | static int got_break(char *put_str, char *arg) | |
358 | { | |
359 | test_complete = 1; | |
360 | if (!strncmp(put_str+1, arg, 2)) { | |
361 | if (!strncmp(arg, "T0", 2)) | |
362 | test_complete = 2; | |
363 | return 0; | |
364 | } | |
365 | return 1; | |
366 | } | |
367 | ||
368 | static void emul_sstep_get(char *arg) | |
369 | { | |
370 | if (!arch_needs_sstep_emulation) { | |
371 | fill_get_buf(arg); | |
372 | return; | |
373 | } | |
374 | switch (sstep_state) { | |
375 | case 0: | |
376 | v2printk("Emulate single step\n"); | |
377 | /* Start by looking at the current PC */ | |
378 | fill_get_buf("g"); | |
379 | break; | |
380 | case 1: | |
381 | /* set breakpoint */ | |
001fddf5 | 382 | break_helper("Z0", NULL, sstep_addr); |
e8d31c20 JW |
383 | break; |
384 | case 2: | |
385 | /* Continue */ | |
386 | fill_get_buf("c"); | |
387 | break; | |
388 | case 3: | |
389 | /* Clear breakpoint */ | |
001fddf5 | 390 | break_helper("z0", NULL, sstep_addr); |
e8d31c20 JW |
391 | break; |
392 | default: | |
974460c5 | 393 | eprintk("kgdbts: ERROR failed sstep get emulation\n"); |
e8d31c20 JW |
394 | } |
395 | sstep_state++; | |
396 | } | |
397 | ||
398 | static int emul_sstep_put(char *put_str, char *arg) | |
399 | { | |
400 | if (!arch_needs_sstep_emulation) { | |
401 | if (!strncmp(put_str+1, arg, 2)) | |
402 | return 0; | |
403 | return 1; | |
404 | } | |
405 | switch (sstep_state) { | |
406 | case 1: | |
407 | /* validate the "g" packet to get the IP */ | |
408 | kgdb_hex2mem(&put_str[1], (char *)kgdbts_gdb_regs, | |
409 | NUMREGBYTES); | |
410 | gdb_regs_to_pt_regs(kgdbts_gdb_regs, &kgdbts_regs); | |
411 | v2printk("Stopped at IP: %lx\n", | |
412 | instruction_pointer(&kgdbts_regs)); | |
413 | /* Want to stop at IP + break instruction size by default */ | |
414 | sstep_addr = instruction_pointer(&kgdbts_regs) + | |
415 | BREAK_INSTR_SIZE; | |
416 | break; | |
417 | case 2: | |
418 | if (strncmp(put_str, "$OK", 3)) { | |
974460c5 | 419 | eprintk("kgdbts: failed sstep break set\n"); |
e8d31c20 JW |
420 | return 1; |
421 | } | |
422 | break; | |
423 | case 3: | |
424 | if (strncmp(put_str, "$T0", 3)) { | |
974460c5 | 425 | eprintk("kgdbts: failed continue sstep\n"); |
e8d31c20 JW |
426 | return 1; |
427 | } | |
428 | break; | |
429 | case 4: | |
430 | if (strncmp(put_str, "$OK", 3)) { | |
974460c5 | 431 | eprintk("kgdbts: failed sstep break unset\n"); |
e8d31c20 JW |
432 | return 1; |
433 | } | |
434 | /* Single step is complete so continue on! */ | |
435 | sstep_state = 0; | |
436 | return 0; | |
437 | default: | |
974460c5 | 438 | eprintk("kgdbts: ERROR failed sstep put emulation\n"); |
e8d31c20 JW |
439 | } |
440 | ||
441 | /* Continue on the same test line until emulation is complete */ | |
442 | ts.idx--; | |
443 | return 0; | |
444 | } | |
445 | ||
446 | static int final_ack_set(char *put_str, char *arg) | |
447 | { | |
448 | if (strncmp(put_str+1, arg, 2)) | |
449 | return 1; | |
450 | final_ack = 1; | |
451 | return 0; | |
452 | } | |
453 | /* | |
454 | * Test to plant a breakpoint and detach, which should clear out the | |
455 | * breakpoint and restore the original instruction. | |
456 | */ | |
457 | static struct test_struct plant_and_detach_test[] = { | |
458 | { "?", "S0*" }, /* Clear break points */ | |
459 | { "kgdbts_break_test", "OK", sw_break, }, /* set sw breakpoint */ | |
460 | { "D", "OK" }, /* Detach */ | |
461 | { "", "" }, | |
462 | }; | |
463 | ||
464 | /* | |
465 | * Simple test to write in a software breakpoint, check for the | |
466 | * correct stop location and detach. | |
467 | */ | |
468 | static struct test_struct sw_breakpoint_test[] = { | |
469 | { "?", "S0*" }, /* Clear break points */ | |
470 | { "kgdbts_break_test", "OK", sw_break, }, /* set sw breakpoint */ | |
471 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 472 | { "g", "kgdbts_break_test", NULL, check_and_rewind_pc }, |
e8d31c20 JW |
473 | { "write", "OK", write_regs }, |
474 | { "kgdbts_break_test", "OK", sw_rem_break }, /*remove breakpoint */ | |
475 | { "D", "OK" }, /* Detach */ | |
001fddf5 | 476 | { "D", "OK", NULL, got_break }, /* On success we made it here */ |
e8d31c20 JW |
477 | { "", "" }, |
478 | }; | |
479 | ||
480 | /* | |
481 | * Test a known bad memory read location to test the fault handler and | |
482 | * read bytes 1-8 at the bad address | |
483 | */ | |
484 | static struct test_struct bad_read_test[] = { | |
485 | { "?", "S0*" }, /* Clear break points */ | |
486 | { "m0,1", "E*" }, /* read 1 byte at address 1 */ | |
487 | { "m0,2", "E*" }, /* read 1 byte at address 2 */ | |
488 | { "m0,3", "E*" }, /* read 1 byte at address 3 */ | |
489 | { "m0,4", "E*" }, /* read 1 byte at address 4 */ | |
490 | { "m0,5", "E*" }, /* read 1 byte at address 5 */ | |
491 | { "m0,6", "E*" }, /* read 1 byte at address 6 */ | |
492 | { "m0,7", "E*" }, /* read 1 byte at address 7 */ | |
493 | { "m0,8", "E*" }, /* read 1 byte at address 8 */ | |
494 | { "D", "OK" }, /* Detach which removes all breakpoints and continues */ | |
495 | { "", "" }, | |
496 | }; | |
497 | ||
498 | /* | |
499 | * Test for hitting a breakpoint, remove it, single step, plant it | |
500 | * again and detach. | |
501 | */ | |
502 | static struct test_struct singlestep_break_test[] = { | |
503 | { "?", "S0*" }, /* Clear break points */ | |
504 | { "kgdbts_break_test", "OK", sw_break, }, /* set sw breakpoint */ | |
505 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 506 | { "g", "kgdbts_break_test", NULL, check_and_rewind_pc }, |
e8d31c20 JW |
507 | { "write", "OK", write_regs }, /* Write registers */ |
508 | { "kgdbts_break_test", "OK", sw_rem_break }, /*remove breakpoint */ | |
509 | { "s", "T0*", emul_sstep_get, emul_sstep_put }, /* Single step */ | |
001fddf5 | 510 | { "g", "kgdbts_break_test", NULL, check_single_step }, |
e8d31c20 JW |
511 | { "kgdbts_break_test", "OK", sw_break, }, /* set sw breakpoint */ |
512 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 513 | { "g", "kgdbts_break_test", NULL, check_and_rewind_pc }, |
e8d31c20 JW |
514 | { "write", "OK", write_regs }, /* Write registers */ |
515 | { "D", "OK" }, /* Remove all breakpoints and continues */ | |
516 | { "", "" }, | |
517 | }; | |
518 | ||
519 | /* | |
520 | * Test for hitting a breakpoint at do_fork for what ever the number | |
521 | * of iterations required by the variable repeat_test. | |
522 | */ | |
523 | static struct test_struct do_fork_test[] = { | |
524 | { "?", "S0*" }, /* Clear break points */ | |
525 | { "do_fork", "OK", sw_break, }, /* set sw breakpoint */ | |
526 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 527 | { "g", "do_fork", NULL, check_and_rewind_pc }, /* check location */ |
e8d31c20 JW |
528 | { "write", "OK", write_regs }, /* Write registers */ |
529 | { "do_fork", "OK", sw_rem_break }, /*remove breakpoint */ | |
530 | { "s", "T0*", emul_sstep_get, emul_sstep_put }, /* Single step */ | |
001fddf5 | 531 | { "g", "do_fork", NULL, check_single_step }, |
e8d31c20 JW |
532 | { "do_fork", "OK", sw_break, }, /* set sw breakpoint */ |
533 | { "7", "T0*", skip_back_repeat_test }, /* Loop based on repeat_test */ | |
001fddf5 | 534 | { "D", "OK", NULL, final_ack_set }, /* detach and unregister I/O */ |
e8d31c20 JW |
535 | { "", "" }, |
536 | }; | |
537 | ||
538 | /* Test for hitting a breakpoint at sys_open for what ever the number | |
539 | * of iterations required by the variable repeat_test. | |
540 | */ | |
541 | static struct test_struct sys_open_test[] = { | |
542 | { "?", "S0*" }, /* Clear break points */ | |
543 | { "sys_open", "OK", sw_break, }, /* set sw breakpoint */ | |
544 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 545 | { "g", "sys_open", NULL, check_and_rewind_pc }, /* check location */ |
e8d31c20 JW |
546 | { "write", "OK", write_regs }, /* Write registers */ |
547 | { "sys_open", "OK", sw_rem_break }, /*remove breakpoint */ | |
548 | { "s", "T0*", emul_sstep_get, emul_sstep_put }, /* Single step */ | |
001fddf5 | 549 | { "g", "sys_open", NULL, check_single_step }, |
e8d31c20 JW |
550 | { "sys_open", "OK", sw_break, }, /* set sw breakpoint */ |
551 | { "7", "T0*", skip_back_repeat_test }, /* Loop based on repeat_test */ | |
001fddf5 | 552 | { "D", "OK", NULL, final_ack_set }, /* detach and unregister I/O */ |
e8d31c20 JW |
553 | { "", "" }, |
554 | }; | |
555 | ||
556 | /* | |
557 | * Test for hitting a simple hw breakpoint | |
558 | */ | |
559 | static struct test_struct hw_breakpoint_test[] = { | |
560 | { "?", "S0*" }, /* Clear break points */ | |
561 | { "kgdbts_break_test", "OK", hw_break, }, /* set hw breakpoint */ | |
562 | { "c", "T0*", }, /* Continue */ | |
001fddf5 | 563 | { "g", "kgdbts_break_test", NULL, check_and_rewind_pc }, |
e8d31c20 JW |
564 | { "write", "OK", write_regs }, |
565 | { "kgdbts_break_test", "OK", hw_rem_break }, /*remove breakpoint */ | |
566 | { "D", "OK" }, /* Detach */ | |
001fddf5 | 567 | { "D", "OK", NULL, got_break }, /* On success we made it here */ |
e8d31c20 JW |
568 | { "", "" }, |
569 | }; | |
570 | ||
571 | /* | |
572 | * Test for hitting a hw write breakpoint | |
573 | */ | |
574 | static struct test_struct hw_write_break_test[] = { | |
575 | { "?", "S0*" }, /* Clear break points */ | |
576 | { "hw_break_val", "OK", hw_write_break, }, /* set hw breakpoint */ | |
001fddf5 HH |
577 | { "c", "T0*", NULL, got_break }, /* Continue */ |
578 | { "g", "silent", NULL, check_and_rewind_pc }, | |
e8d31c20 JW |
579 | { "write", "OK", write_regs }, |
580 | { "hw_break_val", "OK", hw_rem_write_break }, /*remove breakpoint */ | |
581 | { "D", "OK" }, /* Detach */ | |
001fddf5 | 582 | { "D", "OK", NULL, got_break }, /* On success we made it here */ |
e8d31c20 JW |
583 | { "", "" }, |
584 | }; | |
585 | ||
586 | /* | |
587 | * Test for hitting a hw access breakpoint | |
588 | */ | |
589 | static struct test_struct hw_access_break_test[] = { | |
590 | { "?", "S0*" }, /* Clear break points */ | |
591 | { "hw_break_val", "OK", hw_access_break, }, /* set hw breakpoint */ | |
001fddf5 HH |
592 | { "c", "T0*", NULL, got_break }, /* Continue */ |
593 | { "g", "silent", NULL, check_and_rewind_pc }, | |
e8d31c20 JW |
594 | { "write", "OK", write_regs }, |
595 | { "hw_break_val", "OK", hw_rem_access_break }, /*remove breakpoint */ | |
596 | { "D", "OK" }, /* Detach */ | |
001fddf5 | 597 | { "D", "OK", NULL, got_break }, /* On success we made it here */ |
e8d31c20 JW |
598 | { "", "" }, |
599 | }; | |
600 | ||
601 | /* | |
602 | * Test for hitting a hw access breakpoint | |
603 | */ | |
604 | static struct test_struct nmi_sleep_test[] = { | |
605 | { "?", "S0*" }, /* Clear break points */ | |
001fddf5 | 606 | { "c", "T0*", NULL, got_break }, /* Continue */ |
e8d31c20 | 607 | { "D", "OK" }, /* Detach */ |
001fddf5 | 608 | { "D", "OK", NULL, got_break }, /* On success we made it here */ |
e8d31c20 JW |
609 | { "", "" }, |
610 | }; | |
611 | ||
612 | static void fill_get_buf(char *buf) | |
613 | { | |
614 | unsigned char checksum = 0; | |
615 | int count = 0; | |
616 | char ch; | |
617 | ||
618 | strcpy(get_buf, "$"); | |
619 | strcat(get_buf, buf); | |
620 | while ((ch = buf[count])) { | |
621 | checksum += ch; | |
622 | count++; | |
623 | } | |
624 | strcat(get_buf, "#"); | |
827e609b HH |
625 | get_buf[count + 2] = hex_asc_hi(checksum); |
626 | get_buf[count + 3] = hex_asc_lo(checksum); | |
e8d31c20 JW |
627 | get_buf[count + 4] = '\0'; |
628 | v2printk("get%i: %s\n", ts.idx, get_buf); | |
629 | } | |
630 | ||
631 | static int validate_simple_test(char *put_str) | |
632 | { | |
633 | char *chk_str; | |
634 | ||
635 | if (ts.tst[ts.idx].put_handler) | |
636 | return ts.tst[ts.idx].put_handler(put_str, | |
637 | ts.tst[ts.idx].put); | |
638 | ||
639 | chk_str = ts.tst[ts.idx].put; | |
640 | if (*put_str == '$') | |
641 | put_str++; | |
642 | ||
643 | while (*chk_str != '\0' && *put_str != '\0') { | |
644 | /* If someone does a * to match the rest of the string, allow | |
25985edc | 645 | * it, or stop if the received string is complete. |
e8d31c20 JW |
646 | */ |
647 | if (*put_str == '#' || *chk_str == '*') | |
648 | return 0; | |
649 | if (*put_str != *chk_str) | |
650 | return 1; | |
651 | ||
652 | chk_str++; | |
653 | put_str++; | |
654 | } | |
655 | if (*chk_str == '\0' && (*put_str == '\0' || *put_str == '#')) | |
656 | return 0; | |
657 | ||
658 | return 1; | |
659 | } | |
660 | ||
661 | static int run_simple_test(int is_get_char, int chr) | |
662 | { | |
663 | int ret = 0; | |
664 | if (is_get_char) { | |
665 | /* Send an ACK on the get if a prior put completed and set the | |
666 | * send ack variable | |
667 | */ | |
668 | if (send_ack) { | |
669 | send_ack = 0; | |
670 | return '+'; | |
671 | } | |
672 | /* On the first get char, fill the transmit buffer and then | |
673 | * take from the get_string. | |
674 | */ | |
675 | if (get_buf_cnt == 0) { | |
676 | if (ts.tst[ts.idx].get_handler) | |
677 | ts.tst[ts.idx].get_handler(ts.tst[ts.idx].get); | |
678 | else | |
679 | fill_get_buf(ts.tst[ts.idx].get); | |
680 | } | |
681 | ||
682 | if (get_buf[get_buf_cnt] == '\0') { | |
974460c5 | 683 | eprintk("kgdbts: ERROR GET: EOB on '%s' at %i\n", |
e8d31c20 JW |
684 | ts.name, ts.idx); |
685 | get_buf_cnt = 0; | |
686 | fill_get_buf("D"); | |
687 | } | |
688 | ret = get_buf[get_buf_cnt]; | |
689 | get_buf_cnt++; | |
690 | return ret; | |
691 | } | |
692 | ||
693 | /* This callback is a put char which is when kgdb sends data to | |
694 | * this I/O module. | |
695 | */ | |
696 | if (ts.tst[ts.idx].get[0] == '\0' && | |
697 | ts.tst[ts.idx].put[0] == '\0') { | |
974460c5 | 698 | eprintk("kgdbts: ERROR: beyond end of test on" |
e8d31c20 JW |
699 | " '%s' line %i\n", ts.name, ts.idx); |
700 | return 0; | |
701 | } | |
702 | ||
703 | if (put_buf_cnt >= BUFMAX) { | |
974460c5 | 704 | eprintk("kgdbts: ERROR: put buffer overflow on" |
e8d31c20 JW |
705 | " '%s' line %i\n", ts.name, ts.idx); |
706 | put_buf_cnt = 0; | |
707 | return 0; | |
708 | } | |
709 | /* Ignore everything until the first valid packet start '$' */ | |
710 | if (put_buf_cnt == 0 && chr != '$') | |
711 | return 0; | |
712 | ||
713 | put_buf[put_buf_cnt] = chr; | |
714 | put_buf_cnt++; | |
715 | ||
716 | /* End of packet == #XX so look for the '#' */ | |
717 | if (put_buf_cnt > 3 && put_buf[put_buf_cnt - 3] == '#') { | |
b4f1b67b RK |
718 | if (put_buf_cnt >= BUFMAX) { |
719 | eprintk("kgdbts: ERROR: put buffer overflow on" | |
720 | " '%s' line %i\n", ts.name, ts.idx); | |
721 | put_buf_cnt = 0; | |
722 | return 0; | |
723 | } | |
e8d31c20 JW |
724 | put_buf[put_buf_cnt] = '\0'; |
725 | v2printk("put%i: %s\n", ts.idx, put_buf); | |
726 | /* Trigger check here */ | |
727 | if (ts.validate_put && ts.validate_put(put_buf)) { | |
974460c5 | 728 | eprintk("kgdbts: ERROR PUT: end of test " |
e8d31c20 JW |
729 | "buffer on '%s' line %i expected %s got %s\n", |
730 | ts.name, ts.idx, ts.tst[ts.idx].put, put_buf); | |
731 | } | |
732 | ts.idx++; | |
733 | put_buf_cnt = 0; | |
734 | get_buf_cnt = 0; | |
735 | send_ack = 1; | |
736 | } | |
737 | return 0; | |
738 | } | |
739 | ||
740 | static void init_simple_test(void) | |
741 | { | |
742 | memset(&ts, 0, sizeof(ts)); | |
743 | ts.run_test = run_simple_test; | |
744 | ts.validate_put = validate_simple_test; | |
745 | } | |
746 | ||
747 | static void run_plant_and_detach_test(int is_early) | |
748 | { | |
749 | char before[BREAK_INSTR_SIZE]; | |
750 | char after[BREAK_INSTR_SIZE]; | |
751 | ||
752 | probe_kernel_read(before, (char *)kgdbts_break_test, | |
753 | BREAK_INSTR_SIZE); | |
754 | init_simple_test(); | |
755 | ts.tst = plant_and_detach_test; | |
756 | ts.name = "plant_and_detach_test"; | |
757 | /* Activate test with initial breakpoint */ | |
758 | if (!is_early) | |
759 | kgdb_breakpoint(); | |
760 | probe_kernel_read(after, (char *)kgdbts_break_test, | |
761 | BREAK_INSTR_SIZE); | |
762 | if (memcmp(before, after, BREAK_INSTR_SIZE)) { | |
763 | printk(KERN_CRIT "kgdbts: ERROR kgdb corrupted memory\n"); | |
764 | panic("kgdb memory corruption"); | |
765 | } | |
766 | ||
767 | /* complete the detach test */ | |
768 | if (!is_early) | |
769 | kgdbts_break_test(); | |
770 | } | |
771 | ||
772 | static void run_breakpoint_test(int is_hw_breakpoint) | |
773 | { | |
774 | test_complete = 0; | |
775 | init_simple_test(); | |
776 | if (is_hw_breakpoint) { | |
777 | ts.tst = hw_breakpoint_test; | |
778 | ts.name = "hw_breakpoint_test"; | |
779 | } else { | |
780 | ts.tst = sw_breakpoint_test; | |
781 | ts.name = "sw_breakpoint_test"; | |
782 | } | |
783 | /* Activate test with initial breakpoint */ | |
784 | kgdb_breakpoint(); | |
785 | /* run code with the break point in it */ | |
786 | kgdbts_break_test(); | |
787 | kgdb_breakpoint(); | |
788 | ||
789 | if (test_complete) | |
790 | return; | |
791 | ||
974460c5 | 792 | eprintk("kgdbts: ERROR %s test failed\n", ts.name); |
b33cb815 JW |
793 | if (is_hw_breakpoint) |
794 | hwbreaks_ok = 0; | |
e8d31c20 JW |
795 | } |
796 | ||
797 | static void run_hw_break_test(int is_write_test) | |
798 | { | |
799 | test_complete = 0; | |
800 | init_simple_test(); | |
801 | if (is_write_test) { | |
802 | ts.tst = hw_write_break_test; | |
803 | ts.name = "hw_write_break_test"; | |
804 | } else { | |
805 | ts.tst = hw_access_break_test; | |
806 | ts.name = "hw_access_break_test"; | |
807 | } | |
808 | /* Activate test with initial breakpoint */ | |
809 | kgdb_breakpoint(); | |
810 | hw_break_val_access(); | |
811 | if (is_write_test) { | |
b33cb815 | 812 | if (test_complete == 2) { |
974460c5 | 813 | eprintk("kgdbts: ERROR %s broke on access\n", |
e8d31c20 | 814 | ts.name); |
b33cb815 JW |
815 | hwbreaks_ok = 0; |
816 | } | |
e8d31c20 JW |
817 | hw_break_val_write(); |
818 | } | |
819 | kgdb_breakpoint(); | |
820 | ||
821 | if (test_complete == 1) | |
822 | return; | |
823 | ||
974460c5 | 824 | eprintk("kgdbts: ERROR %s test failed\n", ts.name); |
b33cb815 | 825 | hwbreaks_ok = 0; |
e8d31c20 JW |
826 | } |
827 | ||
828 | static void run_nmi_sleep_test(int nmi_sleep) | |
829 | { | |
830 | unsigned long flags; | |
831 | ||
832 | init_simple_test(); | |
833 | ts.tst = nmi_sleep_test; | |
834 | ts.name = "nmi_sleep_test"; | |
835 | /* Activate test with initial breakpoint */ | |
836 | kgdb_breakpoint(); | |
837 | local_irq_save(flags); | |
838 | mdelay(nmi_sleep*1000); | |
839 | touch_nmi_watchdog(); | |
840 | local_irq_restore(flags); | |
841 | if (test_complete != 2) | |
974460c5 | 842 | eprintk("kgdbts: ERROR nmi_test did not hit nmi\n"); |
e8d31c20 JW |
843 | kgdb_breakpoint(); |
844 | if (test_complete == 1) | |
845 | return; | |
846 | ||
974460c5 | 847 | eprintk("kgdbts: ERROR %s test failed\n", ts.name); |
e8d31c20 JW |
848 | } |
849 | ||
850 | static void run_bad_read_test(void) | |
851 | { | |
852 | init_simple_test(); | |
853 | ts.tst = bad_read_test; | |
854 | ts.name = "bad_read_test"; | |
855 | /* Activate test with initial breakpoint */ | |
856 | kgdb_breakpoint(); | |
857 | } | |
858 | ||
859 | static void run_do_fork_test(void) | |
860 | { | |
861 | init_simple_test(); | |
862 | ts.tst = do_fork_test; | |
863 | ts.name = "do_fork_test"; | |
864 | /* Activate test with initial breakpoint */ | |
865 | kgdb_breakpoint(); | |
866 | } | |
867 | ||
868 | static void run_sys_open_test(void) | |
869 | { | |
870 | init_simple_test(); | |
871 | ts.tst = sys_open_test; | |
872 | ts.name = "sys_open_test"; | |
873 | /* Activate test with initial breakpoint */ | |
874 | kgdb_breakpoint(); | |
875 | } | |
876 | ||
877 | static void run_singlestep_break_test(void) | |
878 | { | |
879 | init_simple_test(); | |
880 | ts.tst = singlestep_break_test; | |
881 | ts.name = "singlestep_breakpoint_test"; | |
882 | /* Activate test with initial breakpoint */ | |
883 | kgdb_breakpoint(); | |
884 | kgdbts_break_test(); | |
885 | kgdbts_break_test(); | |
886 | } | |
887 | ||
888 | static void kgdbts_run_tests(void) | |
889 | { | |
890 | char *ptr; | |
891 | int fork_test = 0; | |
001fddf5 | 892 | int do_sys_open_test = 0; |
7cfcd985 | 893 | int sstep_test = 1000; |
e8d31c20 | 894 | int nmi_sleep = 0; |
7cfcd985 | 895 | int i; |
e8d31c20 | 896 | |
59d309f9 | 897 | ptr = strchr(config, 'F'); |
e8d31c20 | 898 | if (ptr) |
001fddf5 | 899 | fork_test = simple_strtol(ptr + 1, NULL, 10); |
59d309f9 | 900 | ptr = strchr(config, 'S'); |
e8d31c20 | 901 | if (ptr) |
001fddf5 | 902 | do_sys_open_test = simple_strtol(ptr + 1, NULL, 10); |
59d309f9 | 903 | ptr = strchr(config, 'N'); |
e8d31c20 JW |
904 | if (ptr) |
905 | nmi_sleep = simple_strtol(ptr+1, NULL, 10); | |
59d309f9 | 906 | ptr = strchr(config, 'I'); |
7cfcd985 JW |
907 | if (ptr) |
908 | sstep_test = simple_strtol(ptr+1, NULL, 10); | |
e8d31c20 JW |
909 | |
910 | /* required internal KGDB tests */ | |
911 | v1printk("kgdbts:RUN plant and detach test\n"); | |
912 | run_plant_and_detach_test(0); | |
913 | v1printk("kgdbts:RUN sw breakpoint test\n"); | |
914 | run_breakpoint_test(0); | |
915 | v1printk("kgdbts:RUN bad memory access test\n"); | |
916 | run_bad_read_test(); | |
7cfcd985 JW |
917 | v1printk("kgdbts:RUN singlestep test %i iterations\n", sstep_test); |
918 | for (i = 0; i < sstep_test; i++) { | |
919 | run_singlestep_break_test(); | |
920 | if (i % 100 == 0) | |
921 | v1printk("kgdbts:RUN singlestep [%i/%i]\n", | |
922 | i, sstep_test); | |
923 | } | |
e8d31c20 JW |
924 | |
925 | /* ===Optional tests=== */ | |
926 | ||
927 | /* All HW break point tests */ | |
928 | if (arch_kgdb_ops.flags & KGDB_HW_BREAKPOINT) { | |
b33cb815 | 929 | hwbreaks_ok = 1; |
e8d31c20 JW |
930 | v1printk("kgdbts:RUN hw breakpoint test\n"); |
931 | run_breakpoint_test(1); | |
932 | v1printk("kgdbts:RUN hw write breakpoint test\n"); | |
933 | run_hw_break_test(1); | |
934 | v1printk("kgdbts:RUN access write breakpoint test\n"); | |
935 | run_hw_break_test(0); | |
936 | } | |
937 | ||
938 | if (nmi_sleep) { | |
939 | v1printk("kgdbts:RUN NMI sleep %i seconds test\n", nmi_sleep); | |
940 | run_nmi_sleep_test(nmi_sleep); | |
941 | } | |
942 | ||
b33cb815 JW |
943 | #ifdef CONFIG_DEBUG_RODATA |
944 | /* Until there is an api to write to read-only text segments, use | |
945 | * HW breakpoints for the remainder of any tests, else print a | |
946 | * failure message if hw breakpoints do not work. | |
947 | */ | |
948 | if (!(arch_kgdb_ops.flags & KGDB_HW_BREAKPOINT && hwbreaks_ok)) { | |
949 | eprintk("kgdbts: HW breakpoints do not work," | |
950 | "skipping remaining tests\n"); | |
951 | return; | |
952 | } | |
953 | force_hwbrks = 1; | |
954 | #endif /* CONFIG_DEBUG_RODATA */ | |
955 | ||
e8d31c20 JW |
956 | /* If the do_fork test is run it will be the last test that is |
957 | * executed because a kernel thread will be spawned at the very | |
958 | * end to unregister the debug hooks. | |
959 | */ | |
960 | if (fork_test) { | |
961 | repeat_test = fork_test; | |
962 | printk(KERN_INFO "kgdbts:RUN do_fork for %i breakpoints\n", | |
963 | repeat_test); | |
001fddf5 | 964 | kthread_run(kgdbts_unreg_thread, NULL, "kgdbts_unreg"); |
e8d31c20 JW |
965 | run_do_fork_test(); |
966 | return; | |
967 | } | |
968 | ||
969 | /* If the sys_open test is run it will be the last test that is | |
970 | * executed because a kernel thread will be spawned at the very | |
971 | * end to unregister the debug hooks. | |
972 | */ | |
001fddf5 HH |
973 | if (do_sys_open_test) { |
974 | repeat_test = do_sys_open_test; | |
e8d31c20 JW |
975 | printk(KERN_INFO "kgdbts:RUN sys_open for %i breakpoints\n", |
976 | repeat_test); | |
001fddf5 | 977 | kthread_run(kgdbts_unreg_thread, NULL, "kgdbts_unreg"); |
e8d31c20 JW |
978 | run_sys_open_test(); |
979 | return; | |
980 | } | |
981 | /* Shutdown and unregister */ | |
982 | kgdb_unregister_io_module(&kgdbts_io_ops); | |
983 | configured = 0; | |
984 | } | |
985 | ||
986 | static int kgdbts_option_setup(char *opt) | |
987 | { | |
adb4b83c | 988 | if (strlen(opt) >= MAX_CONFIG_LEN) { |
e8d31c20 JW |
989 | printk(KERN_ERR "kgdbts: config string too long\n"); |
990 | return -ENOSPC; | |
991 | } | |
992 | strcpy(config, opt); | |
993 | ||
994 | verbose = 0; | |
995 | if (strstr(config, "V1")) | |
996 | verbose = 1; | |
997 | if (strstr(config, "V2")) | |
998 | verbose = 2; | |
999 | ||
1000 | return 0; | |
1001 | } | |
1002 | ||
1003 | __setup("kgdbts=", kgdbts_option_setup); | |
1004 | ||
1005 | static int configure_kgdbts(void) | |
1006 | { | |
1007 | int err = 0; | |
1008 | ||
1009 | if (!strlen(config) || isspace(config[0])) | |
1010 | goto noconfig; | |
1011 | err = kgdbts_option_setup(config); | |
1012 | if (err) | |
1013 | goto noconfig; | |
1014 | ||
1015 | final_ack = 0; | |
1016 | run_plant_and_detach_test(1); | |
1017 | ||
1018 | err = kgdb_register_io_module(&kgdbts_io_ops); | |
1019 | if (err) { | |
1020 | configured = 0; | |
1021 | return err; | |
1022 | } | |
1023 | configured = 1; | |
1024 | kgdbts_run_tests(); | |
1025 | ||
1026 | return err; | |
1027 | ||
1028 | noconfig: | |
1029 | config[0] = 0; | |
1030 | configured = 0; | |
1031 | ||
1032 | return err; | |
1033 | } | |
1034 | ||
1035 | static int __init init_kgdbts(void) | |
1036 | { | |
1037 | /* Already configured? */ | |
1038 | if (configured == 1) | |
1039 | return 0; | |
1040 | ||
1041 | return configure_kgdbts(); | |
1042 | } | |
1043 | ||
e8d31c20 JW |
1044 | static int kgdbts_get_char(void) |
1045 | { | |
1046 | int val = 0; | |
1047 | ||
1048 | if (ts.run_test) | |
1049 | val = ts.run_test(1, 0); | |
1050 | ||
1051 | return val; | |
1052 | } | |
1053 | ||
1054 | static void kgdbts_put_char(u8 chr) | |
1055 | { | |
1056 | if (ts.run_test) | |
1057 | ts.run_test(0, chr); | |
1058 | } | |
1059 | ||
1060 | static int param_set_kgdbts_var(const char *kmessage, struct kernel_param *kp) | |
1061 | { | |
1062 | int len = strlen(kmessage); | |
1063 | ||
1064 | if (len >= MAX_CONFIG_LEN) { | |
1065 | printk(KERN_ERR "kgdbts: config string too long\n"); | |
1066 | return -ENOSPC; | |
1067 | } | |
1068 | ||
1069 | /* Only copy in the string if the init function has not run yet */ | |
1070 | if (configured < 0) { | |
1071 | strcpy(config, kmessage); | |
1072 | return 0; | |
1073 | } | |
1074 | ||
4dacd5c0 DD |
1075 | if (configured == 1) { |
1076 | printk(KERN_ERR "kgdbts: ERROR: Already configured and running.\n"); | |
e8d31c20 JW |
1077 | return -EBUSY; |
1078 | } | |
1079 | ||
1080 | strcpy(config, kmessage); | |
1081 | /* Chop out \n char as a result of echo */ | |
1082 | if (config[len - 1] == '\n') | |
1083 | config[len - 1] = '\0'; | |
1084 | ||
e8d31c20 JW |
1085 | /* Go and configure with the new params. */ |
1086 | return configure_kgdbts(); | |
1087 | } | |
1088 | ||
1089 | static void kgdbts_pre_exp_handler(void) | |
1090 | { | |
1091 | /* Increment the module count when the debugger is active */ | |
1092 | if (!kgdb_connected) | |
1093 | try_module_get(THIS_MODULE); | |
1094 | } | |
1095 | ||
1096 | static void kgdbts_post_exp_handler(void) | |
1097 | { | |
1098 | /* decrement the module count when the debugger detaches */ | |
1099 | if (!kgdb_connected) | |
1100 | module_put(THIS_MODULE); | |
1101 | } | |
1102 | ||
1103 | static struct kgdb_io kgdbts_io_ops = { | |
1104 | .name = "kgdbts", | |
1105 | .read_char = kgdbts_get_char, | |
1106 | .write_char = kgdbts_put_char, | |
1107 | .pre_exception = kgdbts_pre_exp_handler, | |
1108 | .post_exception = kgdbts_post_exp_handler, | |
1109 | }; | |
1110 | ||
1111 | module_init(init_kgdbts); | |
e8d31c20 JW |
1112 | module_param_call(kgdbts, param_set_kgdbts_var, param_get_string, &kps, 0644); |
1113 | MODULE_PARM_DESC(kgdbts, "<A|V1|V2>[F#|S#][N#]"); | |
1114 | MODULE_DESCRIPTION("KGDB Test Suite"); | |
1115 | MODULE_LICENSE("GPL"); | |
1116 | MODULE_AUTHOR("Wind River Systems, Inc."); | |
1117 |