?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
Linux 2.6.28-rc5
[cris-mirror.git] / arch / powerpc / xmon / xmon.c
blob076368c8b8a95e09f7c5f7cdd1cbf69a012d883c
1 /*
2 * Routines providing a simple monitor for use on the PowerMac.
3 *
4 * Copyright (C) 1996-2005 Paul Mackerras.
5 * Copyright (C) 2001 PPC64 Team, IBM Corp
6 * Copyrignt (C) 2006 Michael Ellerman, IBM Corp
7 *
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License
10 * as published by the Free Software Foundation; either version
11 * 2 of the License, or (at your option) any later version.
12 */
13 #include <linux/errno.h>
14 #include <linux/sched.h>
15 #include <linux/smp.h>
16 #include <linux/mm.h>
17 #include <linux/reboot.h>
18 #include <linux/delay.h>
19 #include <linux/kallsyms.h>
20 #include <linux/cpumask.h>
21 #include <linux/module.h>
22 #include <linux/sysrq.h>
23 #include <linux/interrupt.h>
24 #include <linux/irq.h>
25 #include <linux/bug.h>
26
27 #include <asm/ptrace.h>
28 #include <asm/string.h>
29 #include <asm/prom.h>
30 #include <asm/machdep.h>
31 #include <asm/xmon.h>
32 #include <asm/processor.h>
33 #include <asm/pgtable.h>
34 #include <asm/mmu.h>
35 #include <asm/mmu_context.h>
36 #include <asm/cputable.h>
37 #include <asm/rtas.h>
38 #include <asm/sstep.h>
39 #include <asm/irq_regs.h>
40 #include <asm/spu.h>
41 #include <asm/spu_priv1.h>
42 #include <asm/firmware.h>
43 #include <asm/setjmp.h>
44
45 #ifdef CONFIG_PPC64
46 #include <asm/hvcall.h>
47 #include <asm/paca.h>
48 #endif
49
50 #include "nonstdio.h"
51 #include "dis-asm.h"
52
53 #define scanhex xmon_scanhex
54 #define skipbl xmon_skipbl
55
56 #ifdef CONFIG_SMP
57 static cpumask_t cpus_in_xmon = CPU_MASK_NONE;
58 static unsigned long xmon_taken = 1;
59 static int xmon_owner;
60 static int xmon_gate;
61 #endif /* CONFIG_SMP */
62
63 static unsigned long in_xmon = 0;
64
65 static unsigned long adrs;
66 static int size = 1;
67 #define MAX_DUMP (128 * 1024)
68 static unsigned long ndump = 64;
69 static unsigned long nidump = 16;
70 static unsigned long ncsum = 4096;
71 static int termch;
72 static char tmpstr[128];
73
74 static long bus_error_jmp[JMP_BUF_LEN];
75 static int catch_memory_errors;
76 static long *xmon_fault_jmp[NR_CPUS];
77
78 /* Breakpoint stuff */
79 struct bpt {
80 unsigned long address;
81 unsigned int instr[2];
82 atomic_t ref_count;
83 int enabled;
84 unsigned long pad;
85 };
86
87 /* Bits in bpt.enabled */
88 #define BP_IABR_TE 1 /* IABR translation enabled */
89 #define BP_IABR 2
90 #define BP_TRAP 8
91 #define BP_DABR 0x10
92
93 #define NBPTS 256
94 static struct bpt bpts[NBPTS];
95 static struct bpt dabr;
96 static struct bpt *iabr;
97 static unsigned bpinstr = 0x7fe00008; /* trap */
98
99 #define BP_NUM(bp) ((bp) - bpts + 1)
100
101 /* Prototypes */
102 static int cmds(struct pt_regs *);
103 static int mread(unsigned long, void *, int);
104 static int mwrite(unsigned long, void *, int);
105 static int handle_fault(struct pt_regs *);
106 static void byterev(unsigned char *, int);
107 static void memex(void);
108 static int bsesc(void);
109 static void dump(void);
110 static void prdump(unsigned long, long);
111 static int ppc_inst_dump(unsigned long, long, int);
112 static void backtrace(struct pt_regs *);
113 static void excprint(struct pt_regs *);
114 static void prregs(struct pt_regs *);
115 static void memops(int);
116 static void memlocate(void);
117 static void memzcan(void);
118 static void memdiffs(unsigned char *, unsigned char *, unsigned, unsigned);
119 int skipbl(void);
120 int scanhex(unsigned long *valp);
121 static void scannl(void);
122 static int hexdigit(int);
123 void getstring(char *, int);
124 static void flush_input(void);
125 static int inchar(void);
126 static void take_input(char *);
127 static unsigned long read_spr(int);
128 static void write_spr(int, unsigned long);
129 static void super_regs(void);
130 static void remove_bpts(void);
131 static void insert_bpts(void);
132 static void remove_cpu_bpts(void);
133 static void insert_cpu_bpts(void);
134 static struct bpt *at_breakpoint(unsigned long pc);
135 static struct bpt *in_breakpoint_table(unsigned long pc, unsigned long *offp);
136 static int do_step(struct pt_regs *);
137 static void bpt_cmds(void);
138 static void cacheflush(void);
139 static int cpu_cmd(void);
140 static void csum(void);
141 static void bootcmds(void);
142 static void proccall(void);
143 void dump_segments(void);
144 static void symbol_lookup(void);
145 static void xmon_show_stack(unsigned long sp, unsigned long lr,
146 unsigned long pc);
147 static void xmon_print_symbol(unsigned long address, const char *mid,
148 const char *after);
149 static const char *getvecname(unsigned long vec);
150
151 static int do_spu_cmd(void);
152
153 #ifdef CONFIG_44x
154 static void dump_tlb_44x(void);
155 #endif
156
157 static int xmon_no_auto_backtrace;
158
159 extern void xmon_enter(void);
160 extern void xmon_leave(void);
161
162 extern void xmon_save_regs(struct pt_regs *);
163
164 #ifdef CONFIG_PPC64
165 #define REG "%.16lx"
166 #define REGS_PER_LINE 4
167 #define LAST_VOLATILE 13
168 #else
169 #define REG "%.8lx"
170 #define REGS_PER_LINE 8
171 #define LAST_VOLATILE 12
172 #endif
173
174 #define GETWORD(v) (((v)[0] << 24) + ((v)[1] << 16) + ((v)[2] << 8) + (v)[3])
175
176 #define isxdigit(c) (('0' <= (c) && (c) <= '9') \
177 || ('a' <= (c) && (c) <= 'f') \
178 || ('A' <= (c) && (c) <= 'F'))
179 #define isalnum(c) (('0' <= (c) && (c) <= '9') \
180 || ('a' <= (c) && (c) <= 'z') \
181 || ('A' <= (c) && (c) <= 'Z'))
182 #define isspace(c) (c == ' ' || c == '\t' || c == 10 || c == 13 || c == 0)
183
184 static char *help_string = "\
185 Commands:\n\
186 b show breakpoints\n\
187 bd set data breakpoint\n\
188 bi set instruction breakpoint\n\
189 bc clear breakpoint\n"
190 #ifdef CONFIG_SMP
191 "\
192 c print cpus stopped in xmon\n\
193 c# try to switch to cpu number h (in hex)\n"
194 #endif
195 "\
196 C checksum\n\
197 d dump bytes\n\
198 di dump instructions\n\
199 df dump float values\n\
200 dd dump double values\n\
201 dr dump stream of raw bytes\n\
202 e print exception information\n\
203 f flush cache\n\
204 la lookup symbol+offset of specified address\n\
205 ls lookup address of specified symbol\n\
206 m examine/change memory\n\
207 mm move a block of memory\n\
208 ms set a block of memory\n\
209 md compare two blocks of memory\n\
210 ml locate a block of memory\n\
211 mz zero a block of memory\n\
212 mi show information about memory allocation\n\
213 p call a procedure\n\
214 r print registers\n\
215 s single step\n"
216 #ifdef CONFIG_SPU_BASE
217 " ss stop execution on all spus\n\
218 sr restore execution on stopped spus\n\
219 sf # dump spu fields for spu # (in hex)\n\
220 sd # dump spu local store for spu # (in hex)\n\
221 sdi # disassemble spu local store for spu # (in hex)\n"
222 #endif
223 " S print special registers\n\
224 t print backtrace\n\
225 x exit monitor and recover\n\
226 X exit monitor and dont recover\n"
227 #ifdef CONFIG_PPC64
228 " u dump segment table or SLB\n"
229 #endif
230 #ifdef CONFIG_PPC_STD_MMU_32
231 " u dump segment registers\n"
232 #endif
233 #ifdef CONFIG_44x
234 " u dump TLB\n"
235 #endif
236 " ? help\n"
237 " zr reboot\n\
238 zh halt\n"
239 ;
240
241 static struct pt_regs *xmon_regs;
242
243 static inline void sync(void)
244 {
245 asm volatile("sync; isync");
246 }
247
248 static inline void store_inst(void *p)
249 {
250 asm volatile ("dcbst 0,%0; sync; icbi 0,%0; isync" : : "r" (p));
251 }
252
253 static inline void cflush(void *p)
254 {
255 asm volatile ("dcbf 0,%0; icbi 0,%0" : : "r" (p));
256 }
257
258 static inline void cinval(void *p)
259 {
260 asm volatile ("dcbi 0,%0; icbi 0,%0" : : "r" (p));
261 }
262
263 /*
264 * Disable surveillance (the service processor watchdog function)
265 * while we are in xmon.
266 * XXX we should re-enable it when we leave. :)
267 */
268 #define SURVEILLANCE_TOKEN 9000
269
270 static inline void disable_surveillance(void)
271 {
272 #ifdef CONFIG_PPC_PSERIES
273 /* Since this can't be a module, args should end up below 4GB. */
274 static struct rtas_args args;
275
276 /*
277 * At this point we have got all the cpus we can into
278 * xmon, so there is hopefully no other cpu calling RTAS
279 * at the moment, even though we don't take rtas.lock.
280 * If we did try to take rtas.lock there would be a
281 * real possibility of deadlock.
282 */
283 args.token = rtas_token("set-indicator");
284 if (args.token == RTAS_UNKNOWN_SERVICE)
285 return;
286 args.nargs = 3;
287 args.nret = 1;
288 args.rets = &args.args[3];
289 args.args[0] = SURVEILLANCE_TOKEN;
290 args.args[1] = 0;
291 args.args[2] = 0;
292 enter_rtas(__pa(&args));
293 #endif /* CONFIG_PPC_PSERIES */
294 }
295
296 #ifdef CONFIG_SMP
297 static int xmon_speaker;
298
299 static void get_output_lock(void)
300 {
301 int me = smp_processor_id() + 0x100;
302 int last_speaker = 0, prev;
303 long timeout;
304
305 if (xmon_speaker == me)
306 return;
307 for (;;) {
308 if (xmon_speaker == 0) {
309 last_speaker = cmpxchg(&xmon_speaker, 0, me);
310 if (last_speaker == 0)
311 return;
312 }
313 timeout = 10000000;
314 while (xmon_speaker == last_speaker) {
315 if (--timeout > 0)
316 continue;
317 /* hostile takeover */
318 prev = cmpxchg(&xmon_speaker, last_speaker, me);
319 if (prev == last_speaker)
320 return;
321 break;
322 }
323 }
324 }
325
326 static void release_output_lock(void)
327 {
328 xmon_speaker = 0;
329 }
330
331 int cpus_are_in_xmon(void)
332 {
333 return !cpus_empty(cpus_in_xmon);
334 }
335 #endif
336
337 static int xmon_core(struct pt_regs *regs, int fromipi)
338 {
339 int cmd = 0;
340 struct bpt *bp;
341 long recurse_jmp[JMP_BUF_LEN];
342 unsigned long offset;
343 unsigned long flags;
344 #ifdef CONFIG_SMP
345 int cpu;
346 int secondary;
347 unsigned long timeout;
348 #endif
349
350 local_irq_save(flags);
351
352 bp = in_breakpoint_table(regs->nip, &offset);
353 if (bp != NULL) {
354 regs->nip = bp->address + offset;
355 atomic_dec(&bp->ref_count);
356 }
357
358 remove_cpu_bpts();
359
360 #ifdef CONFIG_SMP
361 cpu = smp_processor_id();
362 if (cpu_isset(cpu, cpus_in_xmon)) {
363 get_output_lock();
364 excprint(regs);
365 printf("cpu 0x%x: Exception %lx %s in xmon, "
366 "returning to main loop\n",
367 cpu, regs->trap, getvecname(TRAP(regs)));
368 release_output_lock();
369 longjmp(xmon_fault_jmp[cpu], 1);
370 }
371
372 if (setjmp(recurse_jmp) != 0) {
373 if (!in_xmon || !xmon_gate) {
374 get_output_lock();
375 printf("xmon: WARNING: bad recursive fault "
376 "on cpu 0x%x\n", cpu);
377 release_output_lock();
378 goto waiting;
379 }
380 secondary = !(xmon_taken && cpu == xmon_owner);
381 goto cmdloop;
382 }
383
384 xmon_fault_jmp[cpu] = recurse_jmp;
385 cpu_set(cpu, cpus_in_xmon);
386
387 bp = NULL;
388 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) == (MSR_IR|MSR_SF))
389 bp = at_breakpoint(regs->nip);
390 if (bp || (regs->msr & MSR_RI) == 0)
391 fromipi = 0;
392
393 if (!fromipi) {
394 get_output_lock();
395 excprint(regs);
396 if (bp) {
397 printf("cpu 0x%x stopped at breakpoint 0x%x (",
398 cpu, BP_NUM(bp));
399 xmon_print_symbol(regs->nip, " ", ")\n");
400 }
401 if ((regs->msr & MSR_RI) == 0)
402 printf("WARNING: exception is not recoverable, "
403 "can't continue\n");
404 release_output_lock();
405 }
406
407 waiting:
408 secondary = 1;
409 while (secondary && !xmon_gate) {
410 if (in_xmon == 0) {
411 if (fromipi)
412 goto leave;
413 secondary = test_and_set_bit(0, &in_xmon);
414 }
415 barrier();
416 }
417
418 if (!secondary && !xmon_gate) {
419 /* we are the first cpu to come in */
420 /* interrupt other cpu(s) */
421 int ncpus = num_online_cpus();
422
423 xmon_owner = cpu;
424 mb();
425 if (ncpus > 1) {
426 smp_send_debugger_break(MSG_ALL_BUT_SELF);
427 /* wait for other cpus to come in */
428 for (timeout = 100000000; timeout != 0; --timeout) {
429 if (cpus_weight(cpus_in_xmon) >= ncpus)
430 break;
431 barrier();
432 }
433 }
434 remove_bpts();
435 disable_surveillance();
436 /* for breakpoint or single step, print the current instr. */
437 if (bp || TRAP(regs) == 0xd00)
438 ppc_inst_dump(regs->nip, 1, 0);
439 printf("enter ? for help\n");
440 mb();
441 xmon_gate = 1;
442 barrier();
443 }
444
445 cmdloop:
446 while (in_xmon) {
447 if (secondary) {
448 if (cpu == xmon_owner) {
449 if (!test_and_set_bit(0, &xmon_taken)) {
450 secondary = 0;
451 continue;
452 }
453 /* missed it */
454 while (cpu == xmon_owner)
455 barrier();
456 }
457 barrier();
458 } else {
459 cmd = cmds(regs);
460 if (cmd != 0) {
461 /* exiting xmon */
462 insert_bpts();
463 xmon_gate = 0;
464 wmb();
465 in_xmon = 0;
466 break;
467 }
468 /* have switched to some other cpu */
469 secondary = 1;
470 }
471 }
472 leave:
473 cpu_clear(cpu, cpus_in_xmon);
474 xmon_fault_jmp[cpu] = NULL;
475 #else
476 /* UP is simple... */
477 if (in_xmon) {
478 printf("Exception %lx %s in xmon, returning to main loop\n",
479 regs->trap, getvecname(TRAP(regs)));
480 longjmp(xmon_fault_jmp[0], 1);
481 }
482 if (setjmp(recurse_jmp) == 0) {
483 xmon_fault_jmp[0] = recurse_jmp;
484 in_xmon = 1;
485
486 excprint(regs);
487 bp = at_breakpoint(regs->nip);
488 if (bp) {
489 printf("Stopped at breakpoint %x (", BP_NUM(bp));
490 xmon_print_symbol(regs->nip, " ", ")\n");
491 }
492 if ((regs->msr & MSR_RI) == 0)
493 printf("WARNING: exception is not recoverable, "
494 "can't continue\n");
495 remove_bpts();
496 disable_surveillance();
497 /* for breakpoint or single step, print the current instr. */
498 if (bp || TRAP(regs) == 0xd00)
499 ppc_inst_dump(regs->nip, 1, 0);
500 printf("enter ? for help\n");
501 }
502
503 cmd = cmds(regs);
504
505 insert_bpts();
506 in_xmon = 0;
507 #endif
508
509 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) == (MSR_IR|MSR_SF)) {
510 bp = at_breakpoint(regs->nip);
511 if (bp != NULL) {
512 int stepped = emulate_step(regs, bp->instr[0]);
513 if (stepped == 0) {
514 regs->nip = (unsigned long) &bp->instr[0];
515 atomic_inc(&bp->ref_count);
516 } else if (stepped < 0) {
517 printf("Couldn't single-step %s instruction\n",
518 (IS_RFID(bp->instr[0])? "rfid": "mtmsrd"));
519 }
520 }
521 }
522
523 insert_cpu_bpts();
524
525 local_irq_restore(flags);
526
527 return cmd != 'X' && cmd != EOF;
528 }
529
530 int xmon(struct pt_regs *excp)
531 {
532 struct pt_regs regs;
533
534 if (excp == NULL) {
535 xmon_save_regs(&regs);
536 excp = &regs;
537 }
538
539 return xmon_core(excp, 0);
540 }
541 EXPORT_SYMBOL(xmon);
542
543 irqreturn_t xmon_irq(int irq, void *d)
544 {
545 unsigned long flags;
546 local_irq_save(flags);
547 printf("Keyboard interrupt\n");
548 xmon(get_irq_regs());
549 local_irq_restore(flags);
550 return IRQ_HANDLED;
551 }
552
553 static int xmon_bpt(struct pt_regs *regs)
554 {
555 struct bpt *bp;
556 unsigned long offset;
557
558 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) != (MSR_IR|MSR_SF))
559 return 0;
560
561 /* Are we at the trap at bp->instr[1] for some bp? */
562 bp = in_breakpoint_table(regs->nip, &offset);
563 if (bp != NULL && offset == 4) {
564 regs->nip = bp->address + 4;
565 atomic_dec(&bp->ref_count);
566 return 1;
567 }
568
569 /* Are we at a breakpoint? */
570 bp = at_breakpoint(regs->nip);
571 if (!bp)
572 return 0;
573
574 xmon_core(regs, 0);
575
576 return 1;
577 }
578
579 static int xmon_sstep(struct pt_regs *regs)
580 {
581 if (user_mode(regs))
582 return 0;
583 xmon_core(regs, 0);
584 return 1;
585 }
586
587 static int xmon_dabr_match(struct pt_regs *regs)
588 {
589 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) != (MSR_IR|MSR_SF))
590 return 0;
591 if (dabr.enabled == 0)
592 return 0;
593 xmon_core(regs, 0);
594 return 1;
595 }
596
597 static int xmon_iabr_match(struct pt_regs *regs)
598 {
599 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) != (MSR_IR|MSR_SF))
600 return 0;
601 if (iabr == NULL)
602 return 0;
603 xmon_core(regs, 0);
604 return 1;
605 }
606
607 static int xmon_ipi(struct pt_regs *regs)
608 {
609 #ifdef CONFIG_SMP
610 if (in_xmon && !cpu_isset(smp_processor_id(), cpus_in_xmon))
611 xmon_core(regs, 1);
612 #endif
613 return 0;
614 }
615
616 static int xmon_fault_handler(struct pt_regs *regs)
617 {
618 struct bpt *bp;
619 unsigned long offset;
620
621 if (in_xmon && catch_memory_errors)
622 handle_fault(regs); /* doesn't return */
623
624 if ((regs->msr & (MSR_IR|MSR_PR|MSR_SF)) == (MSR_IR|MSR_SF)) {
625 bp = in_breakpoint_table(regs->nip, &offset);
626 if (bp != NULL) {
627 regs->nip = bp->address + offset;
628 atomic_dec(&bp->ref_count);
629 }
630 }
631
632 return 0;
633 }
634
635 static struct bpt *at_breakpoint(unsigned long pc)
636 {
637 int i;
638 struct bpt *bp;
639
640 bp = bpts;
641 for (i = 0; i < NBPTS; ++i, ++bp)
642 if (bp->enabled && pc == bp->address)
643 return bp;
644 return NULL;
645 }
646
647 static struct bpt *in_breakpoint_table(unsigned long nip, unsigned long *offp)
648 {
649 unsigned long off;
650
651 off = nip - (unsigned long) bpts;
652 if (off >= sizeof(bpts))
653 return NULL;
654 off %= sizeof(struct bpt);
655 if (off != offsetof(struct bpt, instr[0])
656 && off != offsetof(struct bpt, instr[1]))
657 return NULL;
658 *offp = off - offsetof(struct bpt, instr[0]);
659 return (struct bpt *) (nip - off);
660 }
661
662 static struct bpt *new_breakpoint(unsigned long a)
663 {
664 struct bpt *bp;
665
666 a &= ~3UL;
667 bp = at_breakpoint(a);
668 if (bp)
669 return bp;
670
671 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
672 if (!bp->enabled && atomic_read(&bp->ref_count) == 0) {
673 bp->address = a;
674 bp->instr[1] = bpinstr;
675 store_inst(&bp->instr[1]);
676 return bp;
677 }
678 }
679
680 printf("Sorry, no free breakpoints. Please clear one first.\n");
681 return NULL;
682 }
683
684 static void insert_bpts(void)
685 {
686 int i;
687 struct bpt *bp;
688
689 bp = bpts;
690 for (i = 0; i < NBPTS; ++i, ++bp) {
691 if ((bp->enabled & (BP_TRAP|BP_IABR)) == 0)
692 continue;
693 if (mread(bp->address, &bp->instr[0], 4) != 4) {
694 printf("Couldn't read instruction at %lx, "
695 "disabling breakpoint there\n", bp->address);
696 bp->enabled = 0;
697 continue;
698 }
699 if (IS_MTMSRD(bp->instr[0]) || IS_RFID(bp->instr[0])) {
700 printf("Breakpoint at %lx is on an mtmsrd or rfid "
701 "instruction, disabling it\n", bp->address);
702 bp->enabled = 0;
703 continue;
704 }
705 store_inst(&bp->instr[0]);
706 if (bp->enabled & BP_IABR)
707 continue;
708 if (mwrite(bp->address, &bpinstr, 4) != 4) {
709 printf("Couldn't write instruction at %lx, "
710 "disabling breakpoint there\n", bp->address);
711 bp->enabled &= ~BP_TRAP;
712 continue;
713 }
714 store_inst((void *)bp->address);
715 }
716 }
717
718 static void insert_cpu_bpts(void)
719 {
720 if (dabr.enabled)
721 set_dabr(dabr.address | (dabr.enabled & 7));
722 if (iabr && cpu_has_feature(CPU_FTR_IABR))
723 mtspr(SPRN_IABR, iabr->address
724 | (iabr->enabled & (BP_IABR|BP_IABR_TE)));
725 }
726
727 static void remove_bpts(void)
728 {
729 int i;
730 struct bpt *bp;
731 unsigned instr;
732
733 bp = bpts;
734 for (i = 0; i < NBPTS; ++i, ++bp) {
735 if ((bp->enabled & (BP_TRAP|BP_IABR)) != BP_TRAP)
736 continue;
737 if (mread(bp->address, &instr, 4) == 4
738 && instr == bpinstr
739 && mwrite(bp->address, &bp->instr, 4) != 4)
740 printf("Couldn't remove breakpoint at %lx\n",
741 bp->address);
742 else
743 store_inst((void *)bp->address);
744 }
745 }
746
747 static void remove_cpu_bpts(void)
748 {
749 set_dabr(0);
750 if (cpu_has_feature(CPU_FTR_IABR))
751 mtspr(SPRN_IABR, 0);
752 }
753
754 /* Command interpreting routine */
755 static char *last_cmd;
756
757 static int
758 cmds(struct pt_regs *excp)
759 {
760 int cmd = 0;
761
762 last_cmd = NULL;
763 xmon_regs = excp;
764
765 if (!xmon_no_auto_backtrace) {
766 xmon_no_auto_backtrace = 1;
767 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
768 }
769
770 for(;;) {
771 #ifdef CONFIG_SMP
772 printf("%x:", smp_processor_id());
773 #endif /* CONFIG_SMP */
774 printf("mon> ");
775 flush_input();
776 termch = 0;
777 cmd = skipbl();
778 if( cmd == '\n' ) {
779 if (last_cmd == NULL)
780 continue;
781 take_input(last_cmd);
782 last_cmd = NULL;
783 cmd = inchar();
784 }
785 switch (cmd) {
786 case 'm':
787 cmd = inchar();
788 switch (cmd) {
789 case 'm':
790 case 's':
791 case 'd':
792 memops(cmd);
793 break;
794 case 'l':
795 memlocate();
796 break;
797 case 'z':
798 memzcan();
799 break;
800 case 'i':
801 show_mem();
802 break;
803 default:
804 termch = cmd;
805 memex();
806 }
807 break;
808 case 'd':
809 dump();
810 break;
811 case 'l':
812 symbol_lookup();
813 break;
814 case 'r':
815 prregs(excp); /* print regs */
816 break;
817 case 'e':
818 excprint(excp);
819 break;
820 case 'S':
821 super_regs();
822 break;
823 case 't':
824 backtrace(excp);
825 break;
826 case 'f':
827 cacheflush();
828 break;
829 case 's':
830 if (do_spu_cmd() == 0)
831 break;
832 if (do_step(excp))
833 return cmd;
834 break;
835 case 'x':
836 case 'X':
837 return cmd;
838 case EOF:
839 printf(" <no input ...>\n");
840 mdelay(2000);
841 return cmd;
842 case '?':
843 xmon_puts(help_string);
844 break;
845 case 'b':
846 bpt_cmds();
847 break;
848 case 'C':
849 csum();
850 break;
851 case 'c':
852 if (cpu_cmd())
853 return 0;
854 break;
855 case 'z':
856 bootcmds();
857 break;
858 case 'p':
859 proccall();
860 break;
861 #ifdef CONFIG_PPC_STD_MMU
862 case 'u':
863 dump_segments();
864 break;
865 #endif
866 #ifdef CONFIG_4xx
867 case 'u':
868 dump_tlb_44x();
869 break;
870 #endif
871 default:
872 printf("Unrecognized command: ");
873 do {
874 if (' ' < cmd && cmd <= '~')
875 putchar(cmd);
876 else
877 printf("\\x%x", cmd);
878 cmd = inchar();
879 } while (cmd != '\n');
880 printf(" (type ? for help)\n");
881 break;
882 }
883 }
884 }
885
886 /*
887 * Step a single instruction.
888 * Some instructions we emulate, others we execute with MSR_SE set.
889 */
890 static int do_step(struct pt_regs *regs)
891 {
892 unsigned int instr;
893 int stepped;
894
895 /* check we are in 64-bit kernel mode, translation enabled */
896 if ((regs->msr & (MSR_SF|MSR_PR|MSR_IR)) == (MSR_SF|MSR_IR)) {
897 if (mread(regs->nip, &instr, 4) == 4) {
898 stepped = emulate_step(regs, instr);
899 if (stepped < 0) {
900 printf("Couldn't single-step %s instruction\n",
901 (IS_RFID(instr)? "rfid": "mtmsrd"));
902 return 0;
903 }
904 if (stepped > 0) {
905 regs->trap = 0xd00 | (regs->trap & 1);
906 printf("stepped to ");
907 xmon_print_symbol(regs->nip, " ", "\n");
908 ppc_inst_dump(regs->nip, 1, 0);
909 return 0;
910 }
911 }
912 }
913 regs->msr |= MSR_SE;
914 return 1;
915 }
916
917 static void bootcmds(void)
918 {
919 int cmd;
920
921 cmd = inchar();
922 if (cmd == 'r')
923 ppc_md.restart(NULL);
924 else if (cmd == 'h')
925 ppc_md.halt();
926 else if (cmd == 'p')
927 ppc_md.power_off();
928 }
929
930 static int cpu_cmd(void)
931 {
932 #ifdef CONFIG_SMP
933 unsigned long cpu;
934 int timeout;
935 int count;
936
937 if (!scanhex(&cpu)) {
938 /* print cpus waiting or in xmon */
939 printf("cpus stopped:");
940 count = 0;
941 for (cpu = 0; cpu < NR_CPUS; ++cpu) {
942 if (cpu_isset(cpu, cpus_in_xmon)) {
943 if (count == 0)
944 printf(" %x", cpu);
945 ++count;
946 } else {
947 if (count > 1)
948 printf("-%x", cpu - 1);
949 count = 0;
950 }
951 }
952 if (count > 1)
953 printf("-%x", NR_CPUS - 1);
954 printf("\n");
955 return 0;
956 }
957 /* try to switch to cpu specified */
958 if (!cpu_isset(cpu, cpus_in_xmon)) {
959 printf("cpu 0x%x isn't in xmon\n", cpu);
960 return 0;
961 }
962 xmon_taken = 0;
963 mb();
964 xmon_owner = cpu;
965 timeout = 10000000;
966 while (!xmon_taken) {
967 if (--timeout == 0) {
968 if (test_and_set_bit(0, &xmon_taken))
969 break;
970 /* take control back */
971 mb();
972 xmon_owner = smp_processor_id();
973 printf("cpu %u didn't take control\n", cpu);
974 return 0;
975 }
976 barrier();
977 }
978 return 1;
979 #else
980 return 0;
981 #endif /* CONFIG_SMP */
982 }
983
984 static unsigned short fcstab[256] = {
985 0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
986 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
987 0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
988 0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
989 0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
990 0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
991 0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
992 0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
993 0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
994 0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
995 0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
996 0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
997 0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
998 0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
999 0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
1000 0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
1001 0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
1002 0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
1003 0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
1004 0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
1005 0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
1006 0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
1007 0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
1008 0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
1009 0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
1010 0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
1011 0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
1012 0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
1013 0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
1014 0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
1015 0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
1016 0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
1017 };
1018
1019 #define FCS(fcs, c) (((fcs) >> 8) ^ fcstab[((fcs) ^ (c)) & 0xff])
1020
1021 static void
1022 csum(void)
1023 {
1024 unsigned int i;
1025 unsigned short fcs;
1026 unsigned char v;
1027
1028 if (!scanhex(&adrs))
1029 return;
1030 if (!scanhex(&ncsum))
1031 return;
1032 fcs = 0xffff;
1033 for (i = 0; i < ncsum; ++i) {
1034 if (mread(adrs+i, &v, 1) == 0) {
1035 printf("csum stopped at %x\n", adrs+i);
1036 break;
1037 }
1038 fcs = FCS(fcs, v);
1039 }
1040 printf("%x\n", fcs);
1041 }
1042
1043 /*
1044 * Check if this is a suitable place to put a breakpoint.
1045 */
1046 static long check_bp_loc(unsigned long addr)
1047 {
1048 unsigned int instr;
1049
1050 addr &= ~3;
1051 if (!is_kernel_addr(addr)) {
1052 printf("Breakpoints may only be placed at kernel addresses\n");
1053 return 0;
1054 }
1055 if (!mread(addr, &instr, sizeof(instr))) {
1056 printf("Can't read instruction at address %lx\n", addr);
1057 return 0;
1058 }
1059 if (IS_MTMSRD(instr) || IS_RFID(instr)) {
1060 printf("Breakpoints may not be placed on mtmsrd or rfid "
1061 "instructions\n");
1062 return 0;
1063 }
1064 return 1;
1065 }
1066
1067 static char *breakpoint_help_string =
1068 "Breakpoint command usage:\n"
1069 "b show breakpoints\n"
1070 "b <addr> [cnt] set breakpoint at given instr addr\n"
1071 "bc clear all breakpoints\n"
1072 "bc <n/addr> clear breakpoint number n or at addr\n"
1073 "bi <addr> [cnt] set hardware instr breakpoint (POWER3/RS64 only)\n"
1074 "bd <addr> [cnt] set hardware data breakpoint\n"
1075 "";
1076
1077 static void
1078 bpt_cmds(void)
1079 {
1080 int cmd;
1081 unsigned long a;
1082 int mode, i;
1083 struct bpt *bp;
1084 const char badaddr[] = "Only kernel addresses are permitted "
1085 "for breakpoints\n";
1086
1087 cmd = inchar();
1088 switch (cmd) {
1089 #ifndef CONFIG_8xx
1090 case 'd': /* bd - hardware data breakpoint */
1091 mode = 7;
1092 cmd = inchar();
1093 if (cmd == 'r')
1094 mode = 5;
1095 else if (cmd == 'w')
1096 mode = 6;
1097 else
1098 termch = cmd;
1099 dabr.address = 0;
1100 dabr.enabled = 0;
1101 if (scanhex(&dabr.address)) {
1102 if (!is_kernel_addr(dabr.address)) {
1103 printf(badaddr);
1104 break;
1105 }
1106 dabr.address &= ~7;
1107 dabr.enabled = mode | BP_DABR;
1108 }
1109 break;
1110
1111 case 'i': /* bi - hardware instr breakpoint */
1112 if (!cpu_has_feature(CPU_FTR_IABR)) {
1113 printf("Hardware instruction breakpoint "
1114 "not supported on this cpu\n");
1115 break;
1116 }
1117 if (iabr) {
1118 iabr->enabled &= ~(BP_IABR | BP_IABR_TE);
1119 iabr = NULL;
1120 }
1121 if (!scanhex(&a))
1122 break;
1123 if (!check_bp_loc(a))
1124 break;
1125 bp = new_breakpoint(a);
1126 if (bp != NULL) {
1127 bp->enabled |= BP_IABR | BP_IABR_TE;
1128 iabr = bp;
1129 }
1130 break;
1131 #endif
1132
1133 case 'c':
1134 if (!scanhex(&a)) {
1135 /* clear all breakpoints */
1136 for (i = 0; i < NBPTS; ++i)
1137 bpts[i].enabled = 0;
1138 iabr = NULL;
1139 dabr.enabled = 0;
1140 printf("All breakpoints cleared\n");
1141 break;
1142 }
1143
1144 if (a <= NBPTS && a >= 1) {
1145 /* assume a breakpoint number */
1146 bp = &bpts[a-1]; /* bp nums are 1 based */
1147 } else {
1148 /* assume a breakpoint address */
1149 bp = at_breakpoint(a);
1150 if (bp == NULL) {
1151 printf("No breakpoint at %x\n", a);
1152 break;
1153 }
1154 }
1155
1156 printf("Cleared breakpoint %x (", BP_NUM(bp));
1157 xmon_print_symbol(bp->address, " ", ")\n");
1158 bp->enabled = 0;
1159 break;
1160
1161 default:
1162 termch = cmd;
1163 cmd = skipbl();
1164 if (cmd == '?') {
1165 printf(breakpoint_help_string);
1166 break;
1167 }
1168 termch = cmd;
1169 if (!scanhex(&a)) {
1170 /* print all breakpoints */
1171 printf(" type address\n");
1172 if (dabr.enabled) {
1173 printf(" data "REG" [", dabr.address);
1174 if (dabr.enabled & 1)
1175 printf("r");
1176 if (dabr.enabled & 2)
1177 printf("w");
1178 printf("]\n");
1179 }
1180 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
1181 if (!bp->enabled)
1182 continue;
1183 printf("%2x %s ", BP_NUM(bp),
1184 (bp->enabled & BP_IABR)? "inst": "trap");
1185 xmon_print_symbol(bp->address, " ", "\n");
1186 }
1187 break;
1188 }
1189
1190 if (!check_bp_loc(a))
1191 break;
1192 bp = new_breakpoint(a);
1193 if (bp != NULL)
1194 bp->enabled |= BP_TRAP;
1195 break;
1196 }
1197 }
1198
1199 /* Very cheap human name for vector lookup. */
1200 static
1201 const char *getvecname(unsigned long vec)
1202 {
1203 char *ret;
1204
1205 switch (vec) {
1206 case 0x100: ret = "(System Reset)"; break;
1207 case 0x200: ret = "(Machine Check)"; break;
1208 case 0x300: ret = "(Data Access)"; break;
1209 case 0x380: ret = "(Data SLB Access)"; break;
1210 case 0x400: ret = "(Instruction Access)"; break;
1211 case 0x480: ret = "(Instruction SLB Access)"; break;
1212 case 0x500: ret = "(Hardware Interrupt)"; break;
1213 case 0x600: ret = "(Alignment)"; break;
1214 case 0x700: ret = "(Program Check)"; break;
1215 case 0x800: ret = "(FPU Unavailable)"; break;
1216 case 0x900: ret = "(Decrementer)"; break;
1217 case 0xc00: ret = "(System Call)"; break;
1218 case 0xd00: ret = "(Single Step)"; break;
1219 case 0xf00: ret = "(Performance Monitor)"; break;
1220 case 0xf20: ret = "(Altivec Unavailable)"; break;
1221 case 0x1300: ret = "(Instruction Breakpoint)"; break;
1222 default: ret = "";
1223 }
1224 return ret;
1225 }
1226
1227 static void get_function_bounds(unsigned long pc, unsigned long *startp,
1228 unsigned long *endp)
1229 {
1230 unsigned long size, offset;
1231 const char *name;
1232
1233 *startp = *endp = 0;
1234 if (pc == 0)
1235 return;
1236 if (setjmp(bus_error_jmp) == 0) {
1237 catch_memory_errors = 1;
1238 sync();
1239 name = kallsyms_lookup(pc, &size, &offset, NULL, tmpstr);
1240 if (name != NULL) {
1241 *startp = pc - offset;
1242 *endp = pc - offset + size;
1243 }
1244 sync();
1245 }
1246 catch_memory_errors = 0;
1247 }
1248
1249 static int xmon_depth_to_print = 64;
1250
1251 #define LRSAVE_OFFSET (STACK_FRAME_LR_SAVE * sizeof(unsigned long))
1252 #define MARKER_OFFSET (STACK_FRAME_MARKER * sizeof(unsigned long))
1253
1254 #ifdef __powerpc64__
1255 #define REGS_OFFSET 0x70
1256 #else
1257 #define REGS_OFFSET 16
1258 #endif
1259
1260 static void xmon_show_stack(unsigned long sp, unsigned long lr,
1261 unsigned long pc)
1262 {
1263 unsigned long ip;
1264 unsigned long newsp;
1265 unsigned long marker;
1266 int count = 0;
1267 struct pt_regs regs;
1268
1269 do {
1270 if (sp < PAGE_OFFSET) {
1271 if (sp != 0)
1272 printf("SP (%lx) is in userspace\n", sp);
1273 break;
1274 }
1275
1276 if (!mread(sp + LRSAVE_OFFSET, &ip, sizeof(unsigned long))
1277 || !mread(sp, &newsp, sizeof(unsigned long))) {
1278 printf("Couldn't read stack frame at %lx\n", sp);
1279 break;
1280 }
1281
1282 /*
1283 * For the first stack frame, try to work out if
1284 * LR and/or the saved LR value in the bottommost
1285 * stack frame are valid.
1286 */
1287 if ((pc | lr) != 0) {
1288 unsigned long fnstart, fnend;
1289 unsigned long nextip;
1290 int printip = 1;
1291
1292 get_function_bounds(pc, &fnstart, &fnend);
1293 nextip = 0;
1294 if (newsp > sp)
1295 mread(newsp + LRSAVE_OFFSET, &nextip,
1296 sizeof(unsigned long));
1297 if (lr == ip) {
1298 if (lr < PAGE_OFFSET
1299 || (fnstart <= lr && lr < fnend))
1300 printip = 0;
1301 } else if (lr == nextip) {
1302 printip = 0;
1303 } else if (lr >= PAGE_OFFSET
1304 && !(fnstart <= lr && lr < fnend)) {
1305 printf("[link register ] ");
1306 xmon_print_symbol(lr, " ", "\n");
1307 }
1308 if (printip) {
1309 printf("["REG"] ", sp);
1310 xmon_print_symbol(ip, " ", " (unreliable)\n");
1311 }
1312 pc = lr = 0;
1313
1314 } else {
1315 printf("["REG"] ", sp);
1316 xmon_print_symbol(ip, " ", "\n");
1317 }
1318
1319 /* Look for "regshere" marker to see if this is
1320 an exception frame. */
1321 if (mread(sp + MARKER_OFFSET, &marker, sizeof(unsigned long))
1322 && marker == STACK_FRAME_REGS_MARKER) {
1323 if (mread(sp + REGS_OFFSET, &regs, sizeof(regs))
1324 != sizeof(regs)) {
1325 printf("Couldn't read registers at %lx\n",
1326 sp + REGS_OFFSET);
1327 break;
1328 }
1329 printf("--- Exception: %lx %s at ", regs.trap,
1330 getvecname(TRAP(&regs)));
1331 pc = regs.nip;
1332 lr = regs.link;
1333 xmon_print_symbol(pc, " ", "\n");
1334 }
1335
1336 if (newsp == 0)
1337 break;
1338
1339 sp = newsp;
1340 } while (count++ < xmon_depth_to_print);
1341 }
1342
1343 static void backtrace(struct pt_regs *excp)
1344 {
1345 unsigned long sp;
1346
1347 if (scanhex(&sp))
1348 xmon_show_stack(sp, 0, 0);
1349 else
1350 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
1351 scannl();
1352 }
1353
1354 static void print_bug_trap(struct pt_regs *regs)
1355 {
1356 #ifdef CONFIG_BUG
1357 const struct bug_entry *bug;
1358 unsigned long addr;
1359
1360 if (regs->msr & MSR_PR)
1361 return; /* not in kernel */
1362 addr = regs->nip; /* address of trap instruction */
1363 if (addr < PAGE_OFFSET)
1364 return;
1365 bug = find_bug(regs->nip);
1366 if (bug == NULL)
1367 return;
1368 if (is_warning_bug(bug))
1369 return;
1370
1371 #ifdef CONFIG_DEBUG_BUGVERBOSE
1372 printf("kernel BUG at %s:%u!\n",
1373 bug->file, bug->line);
1374 #else
1375 printf("kernel BUG at %p!\n", (void *)bug->bug_addr);
1376 #endif
1377 #endif /* CONFIG_BUG */
1378 }
1379
1380 static void excprint(struct pt_regs *fp)
1381 {
1382 unsigned long trap;
1383
1384 #ifdef CONFIG_SMP
1385 printf("cpu 0x%x: ", smp_processor_id());
1386 #endif /* CONFIG_SMP */
1387
1388 trap = TRAP(fp);
1389 printf("Vector: %lx %s at [%lx]\n", fp->trap, getvecname(trap), fp);
1390 printf(" pc: ");
1391 xmon_print_symbol(fp->nip, ": ", "\n");
1392
1393 printf(" lr: ", fp->link);
1394 xmon_print_symbol(fp->link, ": ", "\n");
1395
1396 printf(" sp: %lx\n", fp->gpr[1]);
1397 printf(" msr: %lx\n", fp->msr);
1398
1399 if (trap == 0x300 || trap == 0x380 || trap == 0x600) {
1400 printf(" dar: %lx\n", fp->dar);
1401 if (trap != 0x380)
1402 printf(" dsisr: %lx\n", fp->dsisr);
1403 }
1404
1405 printf(" current = 0x%lx\n", current);
1406 #ifdef CONFIG_PPC64
1407 printf(" paca = 0x%lx\n", get_paca());
1408 #endif
1409 if (current) {
1410 printf(" pid = %ld, comm = %s\n",
1411 current->pid, current->comm);
1412 }
1413
1414 if (trap == 0x700)
1415 print_bug_trap(fp);
1416 }
1417
1418 static void prregs(struct pt_regs *fp)
1419 {
1420 int n, trap;
1421 unsigned long base;
1422 struct pt_regs regs;
1423
1424 if (scanhex(&base)) {
1425 if (setjmp(bus_error_jmp) == 0) {
1426 catch_memory_errors = 1;
1427 sync();
1428 regs = *(struct pt_regs *)base;
1429 sync();
1430 __delay(200);
1431 } else {
1432 catch_memory_errors = 0;
1433 printf("*** Error reading registers from "REG"\n",
1434 base);
1435 return;
1436 }
1437 catch_memory_errors = 0;
1438 fp = &regs;
1439 }
1440
1441 #ifdef CONFIG_PPC64
1442 if (FULL_REGS(fp)) {
1443 for (n = 0; n < 16; ++n)
1444 printf("R%.2ld = "REG" R%.2ld = "REG"\n",
1445 n, fp->gpr[n], n+16, fp->gpr[n+16]);
1446 } else {
1447 for (n = 0; n < 7; ++n)
1448 printf("R%.2ld = "REG" R%.2ld = "REG"\n",
1449 n, fp->gpr[n], n+7, fp->gpr[n+7]);
1450 }
1451 #else
1452 for (n = 0; n < 32; ++n) {
1453 printf("R%.2d = %.8x%s", n, fp->gpr[n],
1454 (n & 3) == 3? "\n": " ");
1455 if (n == 12 && !FULL_REGS(fp)) {
1456 printf("\n");
1457 break;
1458 }
1459 }
1460 #endif
1461 printf("pc = ");
1462 xmon_print_symbol(fp->nip, " ", "\n");
1463 printf("lr = ");
1464 xmon_print_symbol(fp->link, " ", "\n");
1465 printf("msr = "REG" cr = %.8lx\n", fp->msr, fp->ccr);
1466 printf("ctr = "REG" xer = "REG" trap = %4lx\n",
1467 fp->ctr, fp->xer, fp->trap);
1468 trap = TRAP(fp);
1469 if (trap == 0x300 || trap == 0x380 || trap == 0x600)
1470 printf("dar = "REG" dsisr = %.8lx\n", fp->dar, fp->dsisr);
1471 }
1472
1473 static void cacheflush(void)
1474 {
1475 int cmd;
1476 unsigned long nflush;
1477
1478 cmd = inchar();
1479 if (cmd != 'i')
1480 termch = cmd;
1481 scanhex((void *)&adrs);
1482 if (termch != '\n')
1483 termch = 0;
1484 nflush = 1;
1485 scanhex(&nflush);
1486 nflush = (nflush + L1_CACHE_BYTES - 1) / L1_CACHE_BYTES;
1487 if (setjmp(bus_error_jmp) == 0) {
1488 catch_memory_errors = 1;
1489 sync();
1490
1491 if (cmd != 'i') {
1492 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1493 cflush((void *) adrs);
1494 } else {
1495 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1496 cinval((void *) adrs);
1497 }
1498 sync();
1499 /* wait a little while to see if we get a machine check */
1500 __delay(200);
1501 }
1502 catch_memory_errors = 0;
1503 }
1504
1505 static unsigned long
1506 read_spr(int n)
1507 {
1508 unsigned int instrs[2];
1509 unsigned long (*code)(void);
1510 unsigned long ret = -1UL;
1511 #ifdef CONFIG_PPC64
1512 unsigned long opd[3];
1513
1514 opd[0] = (unsigned long)instrs;
1515 opd[1] = 0;
1516 opd[2] = 0;
1517 code = (unsigned long (*)(void)) opd;
1518 #else
1519 code = (unsigned long (*)(void)) instrs;
1520 #endif
1521
1522 /* mfspr r3,n; blr */
1523 instrs[0] = 0x7c6002a6 + ((n & 0x1F) << 16) + ((n & 0x3e0) << 6);
1524 instrs[1] = 0x4e800020;
1525 store_inst(instrs);
1526 store_inst(instrs+1);
1527
1528 if (setjmp(bus_error_jmp) == 0) {
1529 catch_memory_errors = 1;
1530 sync();
1531
1532 ret = code();
1533
1534 sync();
1535 /* wait a little while to see if we get a machine check */
1536 __delay(200);
1537 n = size;
1538 }
1539
1540 return ret;
1541 }
1542
1543 static void
1544 write_spr(int n, unsigned long val)
1545 {
1546 unsigned int instrs[2];
1547 unsigned long (*code)(unsigned long);
1548 #ifdef CONFIG_PPC64
1549 unsigned long opd[3];
1550
1551 opd[0] = (unsigned long)instrs;
1552 opd[1] = 0;
1553 opd[2] = 0;
1554 code = (unsigned long (*)(unsigned long)) opd;
1555 #else
1556 code = (unsigned long (*)(unsigned long)) instrs;
1557 #endif
1558
1559 instrs[0] = 0x7c6003a6 + ((n & 0x1F) << 16) + ((n & 0x3e0) << 6);
1560 instrs[1] = 0x4e800020;
1561 store_inst(instrs);
1562 store_inst(instrs+1);
1563
1564 if (setjmp(bus_error_jmp) == 0) {
1565 catch_memory_errors = 1;
1566 sync();
1567
1568 code(val);
1569
1570 sync();
1571 /* wait a little while to see if we get a machine check */
1572 __delay(200);
1573 n = size;
1574 }
1575 }
1576
1577 static unsigned long regno;
1578 extern char exc_prolog;
1579 extern char dec_exc;
1580
1581 static void super_regs(void)
1582 {
1583 int cmd;
1584 unsigned long val;
1585
1586 cmd = skipbl();
1587 if (cmd == '\n') {
1588 unsigned long sp, toc;
1589 asm("mr %0,1" : "=r" (sp) :);
1590 asm("mr %0,2" : "=r" (toc) :);
1591
1592 printf("msr = "REG" sprg0= "REG"\n",
1593 mfmsr(), mfspr(SPRN_SPRG0));
1594 printf("pvr = "REG" sprg1= "REG"\n",
1595 mfspr(SPRN_PVR), mfspr(SPRN_SPRG1));
1596 printf("dec = "REG" sprg2= "REG"\n",
1597 mfspr(SPRN_DEC), mfspr(SPRN_SPRG2));
1598 printf("sp = "REG" sprg3= "REG"\n", sp, mfspr(SPRN_SPRG3));
1599 printf("toc = "REG" dar = "REG"\n", toc, mfspr(SPRN_DAR));
1600 #ifdef CONFIG_PPC_ISERIES
1601 if (firmware_has_feature(FW_FEATURE_ISERIES)) {
1602 struct paca_struct *ptrPaca;
1603 struct lppaca *ptrLpPaca;
1604
1605 /* Dump out relevant Paca data areas. */
1606 printf("Paca: \n");
1607 ptrPaca = get_paca();
1608
1609 printf(" Local Processor Control Area (LpPaca): \n");
1610 ptrLpPaca = ptrPaca->lppaca_ptr;
1611 printf(" Saved Srr0=%.16lx Saved Srr1=%.16lx \n",
1612 ptrLpPaca->saved_srr0, ptrLpPaca->saved_srr1);
1613 printf(" Saved Gpr3=%.16lx Saved Gpr4=%.16lx \n",
1614 ptrLpPaca->saved_gpr3, ptrLpPaca->saved_gpr4);
1615 printf(" Saved Gpr5=%.16lx \n", ptrLpPaca->saved_gpr5);
1616 }
1617 #endif
1618
1619 return;
1620 }
1621
1622 scanhex(&regno);
1623 switch (cmd) {
1624 case 'w':
1625 val = read_spr(regno);
1626 scanhex(&val);
1627 write_spr(regno, val);
1628 /* fall through */
1629 case 'r':
1630 printf("spr %lx = %lx\n", regno, read_spr(regno));
1631 break;
1632 }
1633 scannl();
1634 }
1635
1636 /*
1637 * Stuff for reading and writing memory safely
1638 */
1639 static int
1640 mread(unsigned long adrs, void *buf, int size)
1641 {
1642 volatile int n;
1643 char *p, *q;
1644
1645 n = 0;
1646 if (setjmp(bus_error_jmp) == 0) {
1647 catch_memory_errors = 1;
1648 sync();
1649 p = (char *)adrs;
1650 q = (char *)buf;
1651 switch (size) {
1652 case 2:
1653 *(u16 *)q = *(u16 *)p;
1654 break;
1655 case 4:
1656 *(u32 *)q = *(u32 *)p;
1657 break;
1658 case 8:
1659 *(u64 *)q = *(u64 *)p;
1660 break;
1661 default:
1662 for( ; n < size; ++n) {
1663 *q++ = *p++;
1664 sync();
1665 }
1666 }
1667 sync();
1668 /* wait a little while to see if we get a machine check */
1669 __delay(200);
1670 n = size;
1671 }
1672 catch_memory_errors = 0;
1673 return n;
1674 }
1675
1676 static int
1677 mwrite(unsigned long adrs, void *buf, int size)
1678 {
1679 volatile int n;
1680 char *p, *q;
1681
1682 n = 0;
1683 if (setjmp(bus_error_jmp) == 0) {
1684 catch_memory_errors = 1;
1685 sync();
1686 p = (char *) adrs;
1687 q = (char *) buf;
1688 switch (size) {
1689 case 2:
1690 *(u16 *)p = *(u16 *)q;
1691 break;
1692 case 4:
1693 *(u32 *)p = *(u32 *)q;
1694 break;
1695 case 8:
1696 *(u64 *)p = *(u64 *)q;
1697 break;
1698 default:
1699 for ( ; n < size; ++n) {
1700 *p++ = *q++;
1701 sync();
1702 }
1703 }
1704 sync();
1705 /* wait a little while to see if we get a machine check */
1706 __delay(200);
1707 n = size;
1708 } else {
1709 printf("*** Error writing address %x\n", adrs + n);
1710 }
1711 catch_memory_errors = 0;
1712 return n;
1713 }
1714
1715 static int fault_type;
1716 static int fault_except;
1717 static char *fault_chars[] = { "--", "**", "##" };
1718
1719 static int handle_fault(struct pt_regs *regs)
1720 {
1721 fault_except = TRAP(regs);
1722 switch (TRAP(regs)) {
1723 case 0x200:
1724 fault_type = 0;
1725 break;
1726 case 0x300:
1727 case 0x380:
1728 fault_type = 1;
1729 break;
1730 default:
1731 fault_type = 2;
1732 }
1733
1734 longjmp(bus_error_jmp, 1);
1735
1736 return 0;
1737 }
1738
1739 #define SWAP(a, b, t) ((t) = (a), (a) = (b), (b) = (t))
1740
1741 static void
1742 byterev(unsigned char *val, int size)
1743 {
1744 int t;
1745
1746 switch (size) {
1747 case 2:
1748 SWAP(val[0], val[1], t);
1749 break;
1750 case 4:
1751 SWAP(val[0], val[3], t);
1752 SWAP(val[1], val[2], t);
1753 break;
1754 case 8: /* is there really any use for this? */
1755 SWAP(val[0], val[7], t);
1756 SWAP(val[1], val[6], t);
1757 SWAP(val[2], val[5], t);
1758 SWAP(val[3], val[4], t);
1759 break;
1760 }
1761 }
1762
1763 static int brev;
1764 static int mnoread;
1765
1766 static char *memex_help_string =
1767 "Memory examine command usage:\n"
1768 "m [addr] [flags] examine/change memory\n"
1769 " addr is optional. will start where left off.\n"
1770 " flags may include chars from this set:\n"
1771 " b modify by bytes (default)\n"
1772 " w modify by words (2 byte)\n"
1773 " l modify by longs (4 byte)\n"
1774 " d modify by doubleword (8 byte)\n"
1775 " r toggle reverse byte order mode\n"
1776 " n do not read memory (for i/o spaces)\n"
1777 " . ok to read (default)\n"
1778 "NOTE: flags are saved as defaults\n"
1779 "";
1780
1781 static char *memex_subcmd_help_string =
1782 "Memory examine subcommands:\n"
1783 " hexval write this val to current location\n"
1784 " 'string' write chars from string to this location\n"
1785 " ' increment address\n"
1786 " ^ decrement address\n"
1787 " / increment addr by 0x10. //=0x100, ///=0x1000, etc\n"
1788 " \\ decrement addr by 0x10. \\\\=0x100, \\\\\\=0x1000, etc\n"
1789 " ` clear no-read flag\n"
1790 " ; stay at this addr\n"
1791 " v change to byte mode\n"
1792 " w change to word (2 byte) mode\n"
1793 " l change to long (4 byte) mode\n"
1794 " u change to doubleword (8 byte) mode\n"
1795 " m addr change current addr\n"
1796 " n toggle no-read flag\n"
1797 " r toggle byte reverse flag\n"
1798 " < count back up count bytes\n"
1799 " > count skip forward count bytes\n"
1800 " x exit this mode\n"
1801 "";
1802
1803 static void
1804 memex(void)
1805 {
1806 int cmd, inc, i, nslash;
1807 unsigned long n;
1808 unsigned char val[16];
1809
1810 scanhex((void *)&adrs);
1811 cmd = skipbl();
1812 if (cmd == '?') {
1813 printf(memex_help_string);
1814 return;
1815 } else {
1816 termch = cmd;
1817 }
1818 last_cmd = "m\n";
1819 while ((cmd = skipbl()) != '\n') {
1820 switch( cmd ){
1821 case 'b': size = 1; break;
1822 case 'w': size = 2; break;
1823 case 'l': size = 4; break;
1824 case 'd': size = 8; break;
1825 case 'r': brev = !brev; break;
1826 case 'n': mnoread = 1; break;
1827 case '.': mnoread = 0; break;
1828 }
1829 }
1830 if( size <= 0 )
1831 size = 1;
1832 else if( size > 8 )
1833 size = 8;
1834 for(;;){
1835 if (!mnoread)
1836 n = mread(adrs, val, size);
1837 printf(REG"%c", adrs, brev? 'r': ' ');
1838 if (!mnoread) {
1839 if (brev)
1840 byterev(val, size);
1841 putchar(' ');
1842 for (i = 0; i < n; ++i)
1843 printf("%.2x", val[i]);
1844 for (; i < size; ++i)
1845 printf("%s", fault_chars[fault_type]);
1846 }
1847 putchar(' ');
1848 inc = size;
1849 nslash = 0;
1850 for(;;){
1851 if( scanhex(&n) ){
1852 for (i = 0; i < size; ++i)
1853 val[i] = n >> (i * 8);
1854 if (!brev)
1855 byterev(val, size);
1856 mwrite(adrs, val, size);
1857 inc = size;
1858 }
1859 cmd = skipbl();
1860 if (cmd == '\n')
1861 break;
1862 inc = 0;
1863 switch (cmd) {
1864 case '\'':
1865 for(;;){
1866 n = inchar();
1867 if( n == '\\' )
1868 n = bsesc();
1869 else if( n == '\'' )
1870 break;
1871 for (i = 0; i < size; ++i)
1872 val[i] = n >> (i * 8);
1873 if (!brev)
1874 byterev(val, size);
1875 mwrite(adrs, val, size);
1876 adrs += size;
1877 }
1878 adrs -= size;
1879 inc = size;
1880 break;
1881 case ',':
1882 adrs += size;
1883 break;
1884 case '.':
1885 mnoread = 0;
1886 break;
1887 case ';':
1888 break;
1889 case 'x':
1890 case EOF:
1891 scannl();
1892 return;
1893 case 'b':
1894 case 'v':
1895 size = 1;
1896 break;
1897 case 'w':
1898 size = 2;
1899 break;
1900 case 'l':
1901 size = 4;
1902 break;
1903 case 'u':
1904 size = 8;
1905 break;
1906 case '^':
1907 adrs -= size;
1908 break;
1909 break;
1910 case '/':
1911 if (nslash > 0)
1912 adrs -= 1 << nslash;
1913 else
1914 nslash = 0;
1915 nslash += 4;
1916 adrs += 1 << nslash;
1917 break;
1918 case '\\':
1919 if (nslash < 0)
1920 adrs += 1 << -nslash;
1921 else
1922 nslash = 0;
1923 nslash -= 4;
1924 adrs -= 1 << -nslash;
1925 break;
1926 case 'm':
1927 scanhex((void *)&adrs);
1928 break;
1929 case 'n':
1930 mnoread = 1;
1931 break;
1932 case 'r':
1933 brev = !brev;
1934 break;
1935 case '<':
1936 n = size;
1937 scanhex(&n);
1938 adrs -= n;
1939 break;
1940 case '>':
1941 n = size;
1942 scanhex(&n);
1943 adrs += n;
1944 break;
1945 case '?':
1946 printf(memex_subcmd_help_string);
1947 break;
1948 }
1949 }
1950 adrs += inc;
1951 }
1952 }
1953
1954 static int
1955 bsesc(void)
1956 {
1957 int c;
1958
1959 c = inchar();
1960 switch( c ){
1961 case 'n': c = '\n'; break;
1962 case 'r': c = '\r'; break;
1963 case 'b': c = '\b'; break;
1964 case 't': c = '\t'; break;
1965 }
1966 return c;
1967 }
1968
1969 static void xmon_rawdump (unsigned long adrs, long ndump)
1970 {
1971 long n, m, r, nr;
1972 unsigned char temp[16];
1973
1974 for (n = ndump; n > 0;) {
1975 r = n < 16? n: 16;
1976 nr = mread(adrs, temp, r);
1977 adrs += nr;
1978 for (m = 0; m < r; ++m) {
1979 if (m < nr)
1980 printf("%.2x", temp[m]);
1981 else
1982 printf("%s", fault_chars[fault_type]);
1983 }
1984 n -= r;
1985 if (nr < r)
1986 break;
1987 }
1988 printf("\n");
1989 }
1990
1991 #define isxdigit(c) (('0' <= (c) && (c) <= '9') \
1992 || ('a' <= (c) && (c) <= 'f') \
1993 || ('A' <= (c) && (c) <= 'F'))
1994 static void
1995 dump(void)
1996 {
1997 int c;
1998
1999 c = inchar();
2000 if ((isxdigit(c) && c != 'f' && c != 'd') || c == '\n')
2001 termch = c;
2002 scanhex((void *)&adrs);
2003 if (termch != '\n')
2004 termch = 0;
2005 if (c == 'i') {
2006 scanhex(&nidump);
2007 if (nidump == 0)
2008 nidump = 16;
2009 else if (nidump > MAX_DUMP)
2010 nidump = MAX_DUMP;
2011 adrs += ppc_inst_dump(adrs, nidump, 1);
2012 last_cmd = "di\n";
2013 } else if (c == 'r') {
2014 scanhex(&ndump);
2015 if (ndump == 0)
2016 ndump = 64;
2017 xmon_rawdump(adrs, ndump);
2018 adrs += ndump;
2019 last_cmd = "dr\n";
2020 } else {
2021 scanhex(&ndump);
2022 if (ndump == 0)
2023 ndump = 64;
2024 else if (ndump > MAX_DUMP)
2025 ndump = MAX_DUMP;
2026 prdump(adrs, ndump);
2027 adrs += ndump;
2028 last_cmd = "d\n";
2029 }
2030 }
2031
2032 static void
2033 prdump(unsigned long adrs, long ndump)
2034 {
2035 long n, m, c, r, nr;
2036 unsigned char temp[16];
2037
2038 for (n = ndump; n > 0;) {
2039 printf(REG, adrs);
2040 putchar(' ');
2041 r = n < 16? n: 16;
2042 nr = mread(adrs, temp, r);
2043 adrs += nr;
2044 for (m = 0; m < r; ++m) {
2045 if ((m & (sizeof(long) - 1)) == 0 && m > 0)
2046 putchar(' ');
2047 if (m < nr)
2048 printf("%.2x", temp[m]);
2049 else
2050 printf("%s", fault_chars[fault_type]);
2051 }
2052 for (; m < 16; ++m) {
2053 if ((m & (sizeof(long) - 1)) == 0)
2054 putchar(' ');
2055 printf(" ");
2056 }
2057 printf(" |");
2058 for (m = 0; m < r; ++m) {
2059 if (m < nr) {
2060 c = temp[m];
2061 putchar(' ' <= c && c <= '~'? c: '.');
2062 } else
2063 putchar(' ');
2064 }
2065 n -= r;
2066 for (; m < 16; ++m)
2067 putchar(' ');
2068 printf("|\n");
2069 if (nr < r)
2070 break;
2071 }
2072 }
2073
2074 typedef int (*instruction_dump_func)(unsigned long inst, unsigned long addr);
2075
2076 static int
2077 generic_inst_dump(unsigned long adr, long count, int praddr,
2078 instruction_dump_func dump_func)
2079 {
2080 int nr, dotted;
2081 unsigned long first_adr;
2082 unsigned long inst, last_inst = 0;
2083 unsigned char val[4];
2084
2085 dotted = 0;
2086 for (first_adr = adr; count > 0; --count, adr += 4) {
2087 nr = mread(adr, val, 4);
2088 if (nr == 0) {
2089 if (praddr) {
2090 const char *x = fault_chars[fault_type];
2091 printf(REG" %s%s%s%s\n", adr, x, x, x, x);
2092 }
2093 break;
2094 }
2095 inst = GETWORD(val);
2096 if (adr > first_adr && inst == last_inst) {
2097 if (!dotted) {
2098 printf(" ...\n");
2099 dotted = 1;
2100 }
2101 continue;
2102 }
2103 dotted = 0;
2104 last_inst = inst;
2105 if (praddr)
2106 printf(REG" %.8x", adr, inst);
2107 printf("\t");
2108 dump_func(inst, adr);
2109 printf("\n");
2110 }
2111 return adr - first_adr;
2112 }
2113
2114 static int
2115 ppc_inst_dump(unsigned long adr, long count, int praddr)
2116 {
2117 return generic_inst_dump(adr, count, praddr, print_insn_powerpc);
2118 }
2119
2120 void
2121 print_address(unsigned long addr)
2122 {
2123 xmon_print_symbol(addr, "\t# ", "");
2124 }
2125
2126
2127 /*
2128 * Memory operations - move, set, print differences
2129 */
2130 static unsigned long mdest; /* destination address */
2131 static unsigned long msrc; /* source address */
2132 static unsigned long mval; /* byte value to set memory to */
2133 static unsigned long mcount; /* # bytes to affect */
2134 static unsigned long mdiffs; /* max # differences to print */
2135
2136 static void
2137 memops(int cmd)
2138 {
2139 scanhex((void *)&mdest);
2140 if( termch != '\n' )
2141 termch = 0;
2142 scanhex((void *)(cmd == 's'? &mval: &msrc));
2143 if( termch != '\n' )
2144 termch = 0;
2145 scanhex((void *)&mcount);
2146 switch( cmd ){
2147 case 'm':
2148 memmove((void *)mdest, (void *)msrc, mcount);
2149 break;
2150 case 's':
2151 memset((void *)mdest, mval, mcount);
2152 break;
2153 case 'd':
2154 if( termch != '\n' )
2155 termch = 0;
2156 scanhex((void *)&mdiffs);
2157 memdiffs((unsigned char *)mdest, (unsigned char *)msrc, mcount, mdiffs);
2158 break;
2159 }
2160 }
2161
2162 static void
2163 memdiffs(unsigned char *p1, unsigned char *p2, unsigned nb, unsigned maxpr)
2164 {
2165 unsigned n, prt;
2166
2167 prt = 0;
2168 for( n = nb; n > 0; --n )
2169 if( *p1++ != *p2++ )
2170 if( ++prt <= maxpr )
2171 printf("%.16x %.2x # %.16x %.2x\n", p1 - 1,
2172 p1[-1], p2 - 1, p2[-1]);
2173 if( prt > maxpr )
2174 printf("Total of %d differences\n", prt);
2175 }
2176
2177 static unsigned mend;
2178 static unsigned mask;
2179
2180 static void
2181 memlocate(void)
2182 {
2183 unsigned a, n;
2184 unsigned char val[4];
2185
2186 last_cmd = "ml";
2187 scanhex((void *)&mdest);
2188 if (termch != '\n') {
2189 termch = 0;
2190 scanhex((void *)&mend);
2191 if (termch != '\n') {
2192 termch = 0;
2193 scanhex((void *)&mval);
2194 mask = ~0;
2195 if (termch != '\n') termch = 0;
2196 scanhex((void *)&mask);
2197 }
2198 }
2199 n = 0;
2200 for (a = mdest; a < mend; a += 4) {
2201 if (mread(a, val, 4) == 4
2202 && ((GETWORD(val) ^ mval) & mask) == 0) {
2203 printf("%.16x: %.16x\n", a, GETWORD(val));
2204 if (++n >= 10)
2205 break;
2206 }
2207 }
2208 }
2209
2210 static unsigned long mskip = 0x1000;
2211 static unsigned long mlim = 0xffffffff;
2212
2213 static void
2214 memzcan(void)
2215 {
2216 unsigned char v;
2217 unsigned a;
2218 int ok, ook;
2219
2220 scanhex(&mdest);
2221 if (termch != '\n') termch = 0;
2222 scanhex(&mskip);
2223 if (termch != '\n') termch = 0;
2224 scanhex(&mlim);
2225 ook = 0;
2226 for (a = mdest; a < mlim; a += mskip) {
2227 ok = mread(a, &v, 1);
2228 if (ok && !ook) {
2229 printf("%.8x .. ", a);
2230 } else if (!ok && ook)
2231 printf("%.8x\n", a - mskip);
2232 ook = ok;
2233 if (a + mskip < a)
2234 break;
2235 }
2236 if (ook)
2237 printf("%.8x\n", a - mskip);
2238 }
2239
2240 static void proccall(void)
2241 {
2242 unsigned long args[8];
2243 unsigned long ret;
2244 int i;
2245 typedef unsigned long (*callfunc_t)(unsigned long, unsigned long,
2246 unsigned long, unsigned long, unsigned long,
2247 unsigned long, unsigned long, unsigned long);
2248 callfunc_t func;
2249
2250 if (!scanhex(&adrs))
2251 return;
2252 if (termch != '\n')
2253 termch = 0;
2254 for (i = 0; i < 8; ++i)
2255 args[i] = 0;
2256 for (i = 0; i < 8; ++i) {
2257 if (!scanhex(&args[i]) || termch == '\n')
2258 break;
2259 termch = 0;
2260 }
2261 func = (callfunc_t) adrs;
2262 ret = 0;
2263 if (setjmp(bus_error_jmp) == 0) {
2264 catch_memory_errors = 1;
2265 sync();
2266 ret = func(args[0], args[1], args[2], args[3],
2267 args[4], args[5], args[6], args[7]);
2268 sync();
2269 printf("return value is %x\n", ret);
2270 } else {
2271 printf("*** %x exception occurred\n", fault_except);
2272 }
2273 catch_memory_errors = 0;
2274 }
2275
2276 /* Input scanning routines */
2277 int
2278 skipbl(void)
2279 {
2280 int c;
2281
2282 if( termch != 0 ){
2283 c = termch;
2284 termch = 0;
2285 } else
2286 c = inchar();
2287 while( c == ' ' || c == '\t' )
2288 c = inchar();
2289 return c;
2290 }
2291
2292 #define N_PTREGS 44
2293 static char *regnames[N_PTREGS] = {
2294 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
2295 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
2296 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
2297 "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
2298 "pc", "msr", "or3", "ctr", "lr", "xer", "ccr",
2299 #ifdef CONFIG_PPC64
2300 "softe",
2301 #else
2302 "mq",
2303 #endif
2304 "trap", "dar", "dsisr", "res"
2305 };
2306
2307 int
2308 scanhex(unsigned long *vp)
2309 {
2310 int c, d;
2311 unsigned long v;
2312
2313 c = skipbl();
2314 if (c == '%') {
2315 /* parse register name */
2316 char regname[8];
2317 int i;
2318
2319 for (i = 0; i < sizeof(regname) - 1; ++i) {
2320 c = inchar();
2321 if (!isalnum(c)) {
2322 termch = c;
2323 break;
2324 }
2325 regname[i] = c;
2326 }
2327 regname[i] = 0;
2328 for (i = 0; i < N_PTREGS; ++i) {
2329 if (strcmp(regnames[i], regname) == 0) {
2330 if (xmon_regs == NULL) {
2331 printf("regs not available\n");
2332 return 0;
2333 }
2334 *vp = ((unsigned long *)xmon_regs)[i];
2335 return 1;
2336 }
2337 }
2338 printf("invalid register name '%%%s'\n", regname);
2339 return 0;
2340 }
2341
2342 /* skip leading "0x" if any */
2343
2344 if (c == '0') {
2345 c = inchar();
2346 if (c == 'x') {
2347 c = inchar();
2348 } else {
2349 d = hexdigit(c);
2350 if (d == EOF) {
2351 termch = c;
2352 *vp = 0;
2353 return 1;
2354 }
2355 }
2356 } else if (c == '$') {
2357 int i;
2358 for (i=0; i<63; i++) {
2359 c = inchar();
2360 if (isspace(c)) {
2361 termch = c;
2362 break;
2363 }
2364 tmpstr[i] = c;
2365 }
2366 tmpstr[i++] = 0;
2367 *vp = 0;
2368 if (setjmp(bus_error_jmp) == 0) {
2369 catch_memory_errors = 1;
2370 sync();
2371 *vp = kallsyms_lookup_name(tmpstr);
2372 sync();
2373 }
2374 catch_memory_errors = 0;
2375 if (!(*vp)) {
2376 printf("unknown symbol '%s'\n", tmpstr);
2377 return 0;
2378 }
2379 return 1;
2380 }
2381
2382 d = hexdigit(c);
2383 if (d == EOF) {
2384 termch = c;
2385 return 0;
2386 }
2387 v = 0;
2388 do {
2389 v = (v << 4) + d;
2390 c = inchar();
2391 d = hexdigit(c);
2392 } while (d != EOF);
2393 termch = c;
2394 *vp = v;
2395 return 1;
2396 }
2397
2398 static void
2399 scannl(void)
2400 {
2401 int c;
2402
2403 c = termch;
2404 termch = 0;
2405 while( c != '\n' )
2406 c = inchar();
2407 }
2408
2409 static int hexdigit(int c)
2410 {
2411 if( '0' <= c && c <= '9' )
2412 return c - '0';
2413 if( 'A' <= c && c <= 'F' )
2414 return c - ('A' - 10);
2415 if( 'a' <= c && c <= 'f' )
2416 return c - ('a' - 10);
2417 return EOF;
2418 }
2419
2420 void
2421 getstring(char *s, int size)
2422 {
2423 int c;
2424
2425 c = skipbl();
2426 do {
2427 if( size > 1 ){
2428 *s++ = c;
2429 --size;
2430 }
2431 c = inchar();
2432 } while( c != ' ' && c != '\t' && c != '\n' );
2433 termch = c;
2434 *s = 0;
2435 }
2436
2437 static char line[256];
2438 static char *lineptr;
2439
2440 static void
2441 flush_input(void)
2442 {
2443 lineptr = NULL;
2444 }
2445
2446 static int
2447 inchar(void)
2448 {
2449 if (lineptr == NULL || *lineptr == 0) {
2450 if (xmon_gets(line, sizeof(line)) == NULL) {
2451 lineptr = NULL;
2452 return EOF;
2453 }
2454 lineptr = line;
2455 }
2456 return *lineptr++;
2457 }
2458
2459 static void
2460 take_input(char *str)
2461 {
2462 lineptr = str;
2463 }
2464
2465
2466 static void
2467 symbol_lookup(void)
2468 {
2469 int type = inchar();
2470 unsigned long addr;
2471 static char tmp[64];
2472
2473 switch (type) {
2474 case 'a':
2475 if (scanhex(&addr))
2476 xmon_print_symbol(addr, ": ", "\n");
2477 termch = 0;
2478 break;
2479 case 's':
2480 getstring(tmp, 64);
2481 if (setjmp(bus_error_jmp) == 0) {
2482 catch_memory_errors = 1;
2483 sync();
2484 addr = kallsyms_lookup_name(tmp);
2485 if (addr)
2486 printf("%s: %lx\n", tmp, addr);
2487 else
2488 printf("Symbol '%s' not found.\n", tmp);
2489 sync();
2490 }
2491 catch_memory_errors = 0;
2492 termch = 0;
2493 break;
2494 }
2495 }
2496
2497
2498 /* Print an address in numeric and symbolic form (if possible) */
2499 static void xmon_print_symbol(unsigned long address, const char *mid,
2500 const char *after)
2501 {
2502 char *modname;
2503 const char *name = NULL;
2504 unsigned long offset, size;
2505
2506 printf(REG, address);
2507 if (setjmp(bus_error_jmp) == 0) {
2508 catch_memory_errors = 1;
2509 sync();
2510 name = kallsyms_lookup(address, &size, &offset, &modname,
2511 tmpstr);
2512 sync();
2513 /* wait a little while to see if we get a machine check */
2514 __delay(200);
2515 }
2516
2517 catch_memory_errors = 0;
2518
2519 if (name) {
2520 printf("%s%s+%#lx/%#lx", mid, name, offset, size);
2521 if (modname)
2522 printf(" [%s]", modname);
2523 }
2524 printf("%s", after);
2525 }
2526
2527 #ifdef CONFIG_PPC64
2528 static void dump_slb(void)
2529 {
2530 int i;
2531 unsigned long esid,vsid,valid;
2532 unsigned long llp;
2533
2534 printf("SLB contents of cpu %x\n", smp_processor_id());
2535
2536 for (i = 0; i < mmu_slb_size; i++) {
2537 asm volatile("slbmfee %0,%1" : "=r" (esid) : "r" (i));
2538 asm volatile("slbmfev %0,%1" : "=r" (vsid) : "r" (i));
2539 valid = (esid & SLB_ESID_V);
2540 if (valid | esid | vsid) {
2541 printf("%02d %016lx %016lx", i, esid, vsid);
2542 if (valid) {
2543 llp = vsid & SLB_VSID_LLP;
2544 if (vsid & SLB_VSID_B_1T) {
2545 printf(" 1T ESID=%9lx VSID=%13lx LLP:%3lx \n",
2546 GET_ESID_1T(esid),
2547 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT_1T,
2548 llp);
2549 } else {
2550 printf(" 256M ESID=%9lx VSID=%13lx LLP:%3lx \n",
2551 GET_ESID(esid),
2552 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT,
2553 llp);
2554 }
2555 } else
2556 printf("\n");
2557 }
2558 }
2559 }
2560
2561 static void dump_stab(void)
2562 {
2563 int i;
2564 unsigned long *tmp = (unsigned long *)get_paca()->stab_addr;
2565
2566 printf("Segment table contents of cpu %x\n", smp_processor_id());
2567
2568 for (i = 0; i < PAGE_SIZE/16; i++) {
2569 unsigned long a, b;
2570
2571 a = *tmp++;
2572 b = *tmp++;
2573
2574 if (a || b) {
2575 printf("%03d %016lx ", i, a);
2576 printf("%016lx\n", b);
2577 }
2578 }
2579 }
2580
2581 void dump_segments(void)
2582 {
2583 if (cpu_has_feature(CPU_FTR_SLB))
2584 dump_slb();
2585 else
2586 dump_stab();
2587 }
2588 #endif
2589
2590 #ifdef CONFIG_PPC_STD_MMU_32
2591 void dump_segments(void)
2592 {
2593 int i;
2594
2595 printf("sr0-15 =");
2596 for (i = 0; i < 16; ++i)
2597 printf(" %x", mfsrin(i));
2598 printf("\n");
2599 }
2600 #endif
2601
2602 #ifdef CONFIG_44x
2603 static void dump_tlb_44x(void)
2604 {
2605 int i;
2606
2607 for (i = 0; i < PPC44x_TLB_SIZE; i++) {
2608 unsigned long w0,w1,w2;
2609 asm volatile("tlbre %0,%1,0" : "=r" (w0) : "r" (i));
2610 asm volatile("tlbre %0,%1,1" : "=r" (w1) : "r" (i));
2611 asm volatile("tlbre %0,%1,2" : "=r" (w2) : "r" (i));
2612 printf("[%02x] %08x %08x %08x ", i, w0, w1, w2);
2613 if (w0 & PPC44x_TLB_VALID) {
2614 printf("V %08x -> %01x%08x %c%c%c%c%c",
2615 w0 & PPC44x_TLB_EPN_MASK,
2616 w1 & PPC44x_TLB_ERPN_MASK,
2617 w1 & PPC44x_TLB_RPN_MASK,
2618 (w2 & PPC44x_TLB_W) ? 'W' : 'w',
2619 (w2 & PPC44x_TLB_I) ? 'I' : 'i',
2620 (w2 & PPC44x_TLB_M) ? 'M' : 'm',
2621 (w2 & PPC44x_TLB_G) ? 'G' : 'g',
2622 (w2 & PPC44x_TLB_E) ? 'E' : 'e');
2623 }
2624 printf("\n");
2625 }
2626 }
2627 #endif /* CONFIG_44x */
2628
2629 static void xmon_init(int enable)
2630 {
2631 #ifdef CONFIG_PPC_ISERIES
2632 if (firmware_has_feature(FW_FEATURE_ISERIES))
2633 return;
2634 #endif
2635 if (enable) {
2636 __debugger = xmon;
2637 __debugger_ipi = xmon_ipi;
2638 __debugger_bpt = xmon_bpt;
2639 __debugger_sstep = xmon_sstep;
2640 __debugger_iabr_match = xmon_iabr_match;
2641 __debugger_dabr_match = xmon_dabr_match;
2642 __debugger_fault_handler = xmon_fault_handler;
2643 } else {
2644 __debugger = NULL;
2645 __debugger_ipi = NULL;
2646 __debugger_bpt = NULL;
2647 __debugger_sstep = NULL;
2648 __debugger_iabr_match = NULL;
2649 __debugger_dabr_match = NULL;
2650 __debugger_fault_handler = NULL;
2651 }
2652 xmon_map_scc();
2653 }
2654
2655 #ifdef CONFIG_MAGIC_SYSRQ
2656 static void sysrq_handle_xmon(int key, struct tty_struct *tty)
2657 {
2658 /* ensure xmon is enabled */
2659 xmon_init(1);
2660 debugger(get_irq_regs());
2661 }
2662
2663 static struct sysrq_key_op sysrq_xmon_op =
2664 {
2665 .handler = sysrq_handle_xmon,
2666 .help_msg = "Xmon",
2667 .action_msg = "Entering xmon",
2668 };
2669
2670 static int __init setup_xmon_sysrq(void)
2671 {
2672 #ifdef CONFIG_PPC_ISERIES
2673 if (firmware_has_feature(FW_FEATURE_ISERIES))
2674 return 0;
2675 #endif
2676 register_sysrq_key('x', &sysrq_xmon_op);
2677 return 0;
2678 }
2679 __initcall(setup_xmon_sysrq);
2680 #endif /* CONFIG_MAGIC_SYSRQ */
2681
2682 static int __initdata xmon_early, xmon_off;
2683
2684 static int __init early_parse_xmon(char *p)
2685 {
2686 if (!p || strncmp(p, "early", 5) == 0) {
2687 /* just "xmon" is equivalent to "xmon=early" */
2688 xmon_init(1);
2689 xmon_early = 1;
2690 } else if (strncmp(p, "on", 2) == 0)
2691 xmon_init(1);
2692 else if (strncmp(p, "off", 3) == 0)
2693 xmon_off = 1;
2694 else if (strncmp(p, "nobt", 4) == 0)
2695 xmon_no_auto_backtrace = 1;
2696 else
2697 return 1;
2698
2699 return 0;
2700 }
2701 early_param("xmon", early_parse_xmon);
2702
2703 void __init xmon_setup(void)
2704 {
2705 #ifdef CONFIG_XMON_DEFAULT
2706 if (!xmon_off)
2707 xmon_init(1);
2708 #endif
2709 if (xmon_early)
2710 debugger(NULL);
2711 }
2712
2713 #ifdef CONFIG_SPU_BASE
2714
2715 struct spu_info {
2716 struct spu *spu;
2717 u64 saved_mfc_sr1_RW;
2718 u32 saved_spu_runcntl_RW;
2719 unsigned long dump_addr;
2720 u8 stopped_ok;
2721 };
2722
2723 #define XMON_NUM_SPUS 16 /* Enough for current hardware */
2724
2725 static struct spu_info spu_info[XMON_NUM_SPUS];
2726
2727 void xmon_register_spus(struct list_head *list)
2728 {
2729 struct spu *spu;
2730
2731 list_for_each_entry(spu, list, full_list) {
2732 if (spu->number >= XMON_NUM_SPUS) {
2733 WARN_ON(1);
2734 continue;
2735 }
2736
2737 spu_info[spu->number].spu = spu;
2738 spu_info[spu->number].stopped_ok = 0;
2739 spu_info[spu->number].dump_addr = (unsigned long)
2740 spu_info[spu->number].spu->local_store;
2741 }
2742 }
2743
2744 static void stop_spus(void)
2745 {
2746 struct spu *spu;
2747 int i;
2748 u64 tmp;
2749
2750 for (i = 0; i < XMON_NUM_SPUS; i++) {
2751 if (!spu_info[i].spu)
2752 continue;
2753
2754 if (setjmp(bus_error_jmp) == 0) {
2755 catch_memory_errors = 1;
2756 sync();
2757
2758 spu = spu_info[i].spu;
2759
2760 spu_info[i].saved_spu_runcntl_RW =
2761 in_be32(&spu->problem->spu_runcntl_RW);
2762
2763 tmp = spu_mfc_sr1_get(spu);
2764 spu_info[i].saved_mfc_sr1_RW = tmp;
2765
2766 tmp &= ~MFC_STATE1_MASTER_RUN_CONTROL_MASK;
2767 spu_mfc_sr1_set(spu, tmp);
2768
2769 sync();
2770 __delay(200);
2771
2772 spu_info[i].stopped_ok = 1;
2773
2774 printf("Stopped spu %.2d (was %s)\n", i,
2775 spu_info[i].saved_spu_runcntl_RW ?
2776 "running" : "stopped");
2777 } else {
2778 catch_memory_errors = 0;
2779 printf("*** Error stopping spu %.2d\n", i);
2780 }
2781 catch_memory_errors = 0;
2782 }
2783 }
2784
2785 static void restart_spus(void)
2786 {
2787 struct spu *spu;
2788 int i;
2789
2790 for (i = 0; i < XMON_NUM_SPUS; i++) {
2791 if (!spu_info[i].spu)
2792 continue;
2793
2794 if (!spu_info[i].stopped_ok) {
2795 printf("*** Error, spu %d was not successfully stopped"
2796 ", not restarting\n", i);
2797 continue;
2798 }
2799
2800 if (setjmp(bus_error_jmp) == 0) {
2801 catch_memory_errors = 1;
2802 sync();
2803
2804 spu = spu_info[i].spu;
2805 spu_mfc_sr1_set(spu, spu_info[i].saved_mfc_sr1_RW);
2806 out_be32(&spu->problem->spu_runcntl_RW,
2807 spu_info[i].saved_spu_runcntl_RW);
2808
2809 sync();
2810 __delay(200);
2811
2812 printf("Restarted spu %.2d\n", i);
2813 } else {
2814 catch_memory_errors = 0;
2815 printf("*** Error restarting spu %.2d\n", i);
2816 }
2817 catch_memory_errors = 0;
2818 }
2819 }
2820
2821 #define DUMP_WIDTH 23
2822 #define DUMP_VALUE(format, field, value) \
2823 do { \
2824 if (setjmp(bus_error_jmp) == 0) { \
2825 catch_memory_errors = 1; \
2826 sync(); \
2827 printf(" %-*s = "format"\n", DUMP_WIDTH, \
2828 #field, value); \
2829 sync(); \
2830 __delay(200); \
2831 } else { \
2832 catch_memory_errors = 0; \
2833 printf(" %-*s = *** Error reading field.\n", \
2834 DUMP_WIDTH, #field); \
2835 } \
2836 catch_memory_errors = 0; \
2837 } while (0)
2838
2839 #define DUMP_FIELD(obj, format, field) \
2840 DUMP_VALUE(format, field, obj->field)
2841
2842 static void dump_spu_fields(struct spu *spu)
2843 {
2844 printf("Dumping spu fields at address %p:\n", spu);
2845
2846 DUMP_FIELD(spu, "0x%x", number);
2847 DUMP_FIELD(spu, "%s", name);
2848 DUMP_FIELD(spu, "0x%lx", local_store_phys);
2849 DUMP_FIELD(spu, "0x%p", local_store);
2850 DUMP_FIELD(spu, "0x%lx", ls_size);
2851 DUMP_FIELD(spu, "0x%x", node);
2852 DUMP_FIELD(spu, "0x%lx", flags);
2853 DUMP_FIELD(spu, "%d", class_0_pending);
2854 DUMP_FIELD(spu, "0x%lx", class_0_dar);
2855 DUMP_FIELD(spu, "0x%lx", class_1_dar);
2856 DUMP_FIELD(spu, "0x%lx", class_1_dsisr);
2857 DUMP_FIELD(spu, "0x%lx", irqs[0]);
2858 DUMP_FIELD(spu, "0x%lx", irqs[1]);
2859 DUMP_FIELD(spu, "0x%lx", irqs[2]);
2860 DUMP_FIELD(spu, "0x%x", slb_replace);
2861 DUMP_FIELD(spu, "%d", pid);
2862 DUMP_FIELD(spu, "0x%p", mm);
2863 DUMP_FIELD(spu, "0x%p", ctx);
2864 DUMP_FIELD(spu, "0x%p", rq);
2865 DUMP_FIELD(spu, "0x%p", timestamp);
2866 DUMP_FIELD(spu, "0x%lx", problem_phys);
2867 DUMP_FIELD(spu, "0x%p", problem);
2868 DUMP_VALUE("0x%x", problem->spu_runcntl_RW,
2869 in_be32(&spu->problem->spu_runcntl_RW));
2870 DUMP_VALUE("0x%x", problem->spu_status_R,
2871 in_be32(&spu->problem->spu_status_R));
2872 DUMP_VALUE("0x%x", problem->spu_npc_RW,
2873 in_be32(&spu->problem->spu_npc_RW));
2874 DUMP_FIELD(spu, "0x%p", priv2);
2875 DUMP_FIELD(spu, "0x%p", pdata);
2876 }
2877
2878 int
2879 spu_inst_dump(unsigned long adr, long count, int praddr)
2880 {
2881 return generic_inst_dump(adr, count, praddr, print_insn_spu);
2882 }
2883
2884 static void dump_spu_ls(unsigned long num, int subcmd)
2885 {
2886 unsigned long offset, addr, ls_addr;
2887
2888 if (setjmp(bus_error_jmp) == 0) {
2889 catch_memory_errors = 1;
2890 sync();
2891 ls_addr = (unsigned long)spu_info[num].spu->local_store;
2892 sync();
2893 __delay(200);
2894 } else {
2895 catch_memory_errors = 0;
2896 printf("*** Error: accessing spu info for spu %d\n", num);
2897 return;
2898 }
2899 catch_memory_errors = 0;
2900
2901 if (scanhex(&offset))
2902 addr = ls_addr + offset;
2903 else
2904 addr = spu_info[num].dump_addr;
2905
2906 if (addr >= ls_addr + LS_SIZE) {
2907 printf("*** Error: address outside of local store\n");
2908 return;
2909 }
2910
2911 switch (subcmd) {
2912 case 'i':
2913 addr += spu_inst_dump(addr, 16, 1);
2914 last_cmd = "sdi\n";
2915 break;
2916 default:
2917 prdump(addr, 64);
2918 addr += 64;
2919 last_cmd = "sd\n";
2920 break;
2921 }
2922
2923 spu_info[num].dump_addr = addr;
2924 }
2925
2926 static int do_spu_cmd(void)
2927 {
2928 static unsigned long num = 0;
2929 int cmd, subcmd = 0;
2930
2931 cmd = inchar();
2932 switch (cmd) {
2933 case 's':
2934 stop_spus();
2935 break;
2936 case 'r':
2937 restart_spus();
2938 break;
2939 case 'd':
2940 subcmd = inchar();
2941 if (isxdigit(subcmd) || subcmd == '\n')
2942 termch = subcmd;
2943 case 'f':
2944 scanhex(&num);
2945 if (num >= XMON_NUM_SPUS || !spu_info[num].spu) {
2946 printf("*** Error: invalid spu number\n");
2947 return 0;
2948 }
2949
2950 switch (cmd) {
2951 case 'f':
2952 dump_spu_fields(spu_info[num].spu);
2953 break;
2954 default:
2955 dump_spu_ls(num, subcmd);
2956 break;
2957 }
2958
2959 break;
2960 default:
2961 return -1;
2962 }
2963
2964 return 0;
2965 }
2966 #else /* ! CONFIG_SPU_BASE */
2967 static int do_spu_cmd(void)
2968 {
2969 return -1;
2970 }
2971 #endif
CRIS linux kernel tree