Loading...
1// SPDX-License-Identifier: GPL-2.0-or-later
2/*
3 * Routines providing a simple monitor for use on the PowerMac.
4 *
5 * Copyright (C) 1996-2005 Paul Mackerras.
6 * Copyright (C) 2001 PPC64 Team, IBM Corp
7 * Copyrignt (C) 2006 Michael Ellerman, IBM Corp
8 */
9
10#include <linux/kernel.h>
11#include <linux/errno.h>
12#include <linux/sched/signal.h>
13#include <linux/smp.h>
14#include <linux/mm.h>
15#include <linux/reboot.h>
16#include <linux/delay.h>
17#include <linux/kallsyms.h>
18#include <linux/kmsg_dump.h>
19#include <linux/cpumask.h>
20#include <linux/export.h>
21#include <linux/sysrq.h>
22#include <linux/interrupt.h>
23#include <linux/irq.h>
24#include <linux/bug.h>
25#include <linux/nmi.h>
26#include <linux/ctype.h>
27#include <linux/highmem.h>
28#include <linux/security.h>
29#include <linux/debugfs.h>
30
31#include <asm/ptrace.h>
32#include <asm/smp.h>
33#include <asm/string.h>
34#include <asm/machdep.h>
35#include <asm/xmon.h>
36#include <asm/processor.h>
37#include <asm/mmu.h>
38#include <asm/mmu_context.h>
39#include <asm/plpar_wrappers.h>
40#include <asm/cputable.h>
41#include <asm/rtas.h>
42#include <asm/sstep.h>
43#include <asm/irq_regs.h>
44#include <asm/spu.h>
45#include <asm/spu_priv1.h>
46#include <asm/setjmp.h>
47#include <asm/reg.h>
48#include <asm/debug.h>
49#include <asm/hw_breakpoint.h>
50#include <asm/xive.h>
51#include <asm/opal.h>
52#include <asm/firmware.h>
53#include <asm/code-patching.h>
54#include <asm/sections.h>
55#include <asm/inst.h>
56#include <asm/interrupt.h>
57
58#ifdef CONFIG_PPC64
59#include <asm/hvcall.h>
60#include <asm/paca.h>
61#include <asm/lppaca.h>
62#endif
63
64#include "nonstdio.h"
65#include "dis-asm.h"
66#include "xmon_bpts.h"
67
68#ifdef CONFIG_SMP
69static cpumask_t cpus_in_xmon = CPU_MASK_NONE;
70static unsigned long xmon_taken = 1;
71static int xmon_owner;
72static int xmon_gate;
73static int xmon_batch;
74static unsigned long xmon_batch_start_cpu;
75static cpumask_t xmon_batch_cpus = CPU_MASK_NONE;
76#else
77#define xmon_owner 0
78#endif /* CONFIG_SMP */
79
80static unsigned long in_xmon __read_mostly = 0;
81static int xmon_on = IS_ENABLED(CONFIG_XMON_DEFAULT);
82static bool xmon_is_ro = IS_ENABLED(CONFIG_XMON_DEFAULT_RO_MODE);
83
84static unsigned long adrs;
85static int size = 1;
86#define MAX_DUMP (64 * 1024)
87static unsigned long ndump = 64;
88#define MAX_IDUMP (MAX_DUMP >> 2)
89static unsigned long nidump = 16;
90static unsigned long ncsum = 4096;
91static int termch;
92static char tmpstr[KSYM_NAME_LEN];
93static int tracing_enabled;
94
95static long bus_error_jmp[JMP_BUF_LEN];
96static int catch_memory_errors;
97static int catch_spr_faults;
98static long *xmon_fault_jmp[NR_CPUS];
99
100/* Breakpoint stuff */
101struct bpt {
102 unsigned long address;
103 u32 *instr;
104 atomic_t ref_count;
105 int enabled;
106 unsigned long pad;
107};
108
109/* Bits in bpt.enabled */
110#define BP_CIABR 1
111#define BP_TRAP 2
112#define BP_DABR 4
113
114static struct bpt bpts[NBPTS];
115static struct bpt dabr[HBP_NUM_MAX];
116static struct bpt *iabr;
117static unsigned int bpinstr = PPC_RAW_TRAP();
118
119#define BP_NUM(bp) ((bp) - bpts + 1)
120
121/* Prototypes */
122static int cmds(struct pt_regs *);
123static int mread(unsigned long, void *, int);
124static int mwrite(unsigned long, void *, int);
125static int mread_instr(unsigned long, ppc_inst_t *);
126static int handle_fault(struct pt_regs *);
127static void byterev(unsigned char *, int);
128static void memex(void);
129static int bsesc(void);
130static void dump(void);
131static void show_pte(unsigned long);
132static void prdump(unsigned long, long);
133static int ppc_inst_dump(unsigned long, long, int);
134static void dump_log_buf(void);
135
136#ifdef CONFIG_SMP
137static int xmon_switch_cpu(unsigned long);
138static int xmon_batch_next_cpu(void);
139static int batch_cmds(struct pt_regs *);
140#endif
141
142#ifdef CONFIG_PPC_POWERNV
143static void dump_opal_msglog(void);
144#else
145static inline void dump_opal_msglog(void)
146{
147 printf("Machine is not running OPAL firmware.\n");
148}
149#endif
150
151static void backtrace(struct pt_regs *);
152static void excprint(struct pt_regs *);
153static void prregs(struct pt_regs *);
154static void memops(int);
155static void memlocate(void);
156static void memzcan(void);
157static void memdiffs(unsigned char *, unsigned char *, unsigned, unsigned);
158int skipbl(void);
159int scanhex(unsigned long *valp);
160static void scannl(void);
161static int hexdigit(int);
162void getstring(char *, int);
163static void flush_input(void);
164static int inchar(void);
165static void take_input(char *);
166static int read_spr(int, unsigned long *);
167static void write_spr(int, unsigned long);
168static void super_regs(void);
169static void remove_bpts(void);
170static void insert_bpts(void);
171static void remove_cpu_bpts(void);
172static void insert_cpu_bpts(void);
173static struct bpt *at_breakpoint(unsigned long pc);
174static struct bpt *in_breakpoint_table(unsigned long pc, unsigned long *offp);
175static int do_step(struct pt_regs *);
176static void bpt_cmds(void);
177static void cacheflush(void);
178static int cpu_cmd(void);
179static void csum(void);
180static void bootcmds(void);
181static void proccall(void);
182static void show_tasks(void);
183void dump_segments(void);
184static void symbol_lookup(void);
185static void xmon_show_stack(unsigned long sp, unsigned long lr,
186 unsigned long pc);
187static void xmon_print_symbol(unsigned long address, const char *mid,
188 const char *after);
189static const char *getvecname(unsigned long vec);
190
191static int do_spu_cmd(void);
192
193#ifdef CONFIG_44x
194static void dump_tlb_44x(void);
195#endif
196#ifdef CONFIG_PPC_BOOK3E_64
197static void dump_tlb_book3e(void);
198#endif
199
200static void clear_all_bpt(void);
201
202#ifdef CONFIG_PPC64
203#define REG "%.16lx"
204#else
205#define REG "%.8lx"
206#endif
207
208#ifdef __LITTLE_ENDIAN__
209#define GETWORD(v) (((v)[3] << 24) + ((v)[2] << 16) + ((v)[1] << 8) + (v)[0])
210#else
211#define GETWORD(v) (((v)[0] << 24) + ((v)[1] << 16) + ((v)[2] << 8) + (v)[3])
212#endif
213
214static const char *xmon_ro_msg = "Operation disabled: xmon in read-only mode\n";
215
216static char *help_string = "\
217Commands:\n\
218 b show breakpoints\n\
219 bd set data breakpoint\n\
220 bi set instruction breakpoint\n\
221 bc clear breakpoint\n"
222#ifdef CONFIG_SMP
223 "\
224 c print cpus stopped in xmon\n\
225 c# try to switch to cpu number h (in hex)\n\
226 c# $ run command '$' (one of 'r','S' or 't') on all cpus in xmon\n"
227#endif
228 "\
229 C checksum\n\
230 d dump bytes\n\
231 d1 dump 1 byte values\n\
232 d2 dump 2 byte values\n\
233 d4 dump 4 byte values\n\
234 d8 dump 8 byte values\n\
235 di dump instructions\n\
236 df dump float values\n\
237 dd dump double values\n\
238 dl dump the kernel log buffer\n"
239#ifdef CONFIG_PPC_POWERNV
240 "\
241 do dump the OPAL message log\n"
242#endif
243#ifdef CONFIG_PPC64
244 "\
245 dp[#] dump paca for current cpu, or cpu #\n\
246 dpa dump paca for all possible cpus\n"
247#endif
248 "\
249 dr dump stream of raw bytes\n\
250 dv dump virtual address translation \n\
251 dt dump the tracing buffers (uses printk)\n\
252 dtc dump the tracing buffers for current CPU (uses printk)\n\
253"
254#ifdef CONFIG_PPC_POWERNV
255" dx# dump xive on CPU #\n\
256 dxi# dump xive irq state #\n\
257 dxa dump xive on all CPUs\n"
258#endif
259" e print exception information\n\
260 f flush cache\n\
261 la lookup symbol+offset of specified address\n\
262 ls lookup address of specified symbol\n\
263 lp s [#] lookup address of percpu symbol s for current cpu, or cpu #\n\
264 m examine/change memory\n\
265 mm move a block of memory\n\
266 ms set a block of memory\n\
267 md compare two blocks of memory\n\
268 ml locate a block of memory\n\
269 mz zero a block of memory\n\
270 mi show information about memory allocation\n\
271 p call a procedure\n\
272 P list processes/tasks\n\
273 r print registers\n\
274 s single step\n"
275#ifdef CONFIG_SPU_BASE
276" ss stop execution on all spus\n\
277 sr restore execution on stopped spus\n\
278 sf # dump spu fields for spu # (in hex)\n\
279 sd # dump spu local store for spu # (in hex)\n\
280 sdi # disassemble spu local store for spu # (in hex)\n"
281#endif
282" S print special registers\n\
283 Sa print all SPRs\n\
284 Sr # read SPR #\n\
285 Sw #v write v to SPR #\n\
286 t print backtrace\n\
287 x exit monitor and recover\n\
288 X exit monitor and don't recover\n"
289#if defined(CONFIG_PPC_BOOK3S_64)
290" u dump segment table or SLB\n"
291#elif defined(CONFIG_PPC_BOOK3S_32)
292" u dump segment registers\n"
293#elif defined(CONFIG_44x) || defined(CONFIG_PPC_BOOK3E_64)
294" u dump TLB\n"
295#endif
296" U show uptime information\n"
297" ? help\n"
298" # n limit output to n lines per page (for dp, dpa, dl)\n"
299" zr reboot\n"
300" zh halt\n"
301;
302
303#ifdef CONFIG_SECURITY
304static bool xmon_is_locked_down(void)
305{
306 static bool lockdown;
307
308 if (!lockdown) {
309 lockdown = !!security_locked_down(LOCKDOWN_XMON_RW);
310 if (lockdown) {
311 printf("xmon: Disabled due to kernel lockdown\n");
312 xmon_is_ro = true;
313 }
314 }
315
316 if (!xmon_is_ro) {
317 xmon_is_ro = !!security_locked_down(LOCKDOWN_XMON_WR);
318 if (xmon_is_ro)
319 printf("xmon: Read-only due to kernel lockdown\n");
320 }
321
322 return lockdown;
323}
324#else /* CONFIG_SECURITY */
325static inline bool xmon_is_locked_down(void)
326{
327 return false;
328}
329#endif
330
331static struct pt_regs *xmon_regs;
332
333static inline void sync(void)
334{
335 asm volatile("sync; isync");
336}
337
338static inline void cflush(void *p)
339{
340 asm volatile ("dcbf 0,%0; icbi 0,%0" : : "r" (p));
341}
342
343static inline void cinval(void *p)
344{
345 asm volatile ("dcbi 0,%0; icbi 0,%0" : : "r" (p));
346}
347
348/**
349 * write_ciabr() - write the CIABR SPR
350 * @ciabr: The value to write.
351 *
352 * This function writes a value to the CIARB register either directly
353 * through mtspr instruction if the kernel is in HV privilege mode or
354 * call a hypervisor function to achieve the same in case the kernel
355 * is in supervisor privilege mode.
356 */
357static void write_ciabr(unsigned long ciabr)
358{
359 if (!cpu_has_feature(CPU_FTR_ARCH_207S))
360 return;
361
362 if (cpu_has_feature(CPU_FTR_HVMODE)) {
363 mtspr(SPRN_CIABR, ciabr);
364 return;
365 }
366 plpar_set_ciabr(ciabr);
367}
368
369/**
370 * set_ciabr() - set the CIABR
371 * @addr: The value to set.
372 *
373 * This function sets the correct privilege value into the HW
374 * breakpoint address before writing it up in the CIABR register.
375 */
376static void set_ciabr(unsigned long addr)
377{
378 addr &= ~CIABR_PRIV;
379
380 if (cpu_has_feature(CPU_FTR_HVMODE))
381 addr |= CIABR_PRIV_HYPER;
382 else
383 addr |= CIABR_PRIV_SUPER;
384 write_ciabr(addr);
385}
386
387/*
388 * Disable surveillance (the service processor watchdog function)
389 * while we are in xmon.
390 * XXX we should re-enable it when we leave. :)
391 */
392#define SURVEILLANCE_TOKEN 9000
393
394static inline void disable_surveillance(void)
395{
396#ifdef CONFIG_PPC_PSERIES
397 /* Since this can't be a module, args should end up below 4GB. */
398 static struct rtas_args args;
399 const s32 token = rtas_function_token(RTAS_FN_SET_INDICATOR);
400
401 /*
402 * At this point we have got all the cpus we can into
403 * xmon, so there is hopefully no other cpu calling RTAS
404 * at the moment, even though we don't take rtas.lock.
405 * If we did try to take rtas.lock there would be a
406 * real possibility of deadlock.
407 */
408 if (token == RTAS_UNKNOWN_SERVICE)
409 return;
410
411 rtas_call_unlocked(&args, token, 3, 1, NULL,
412 SURVEILLANCE_TOKEN, 0, 0);
413
414#endif /* CONFIG_PPC_PSERIES */
415}
416
417#ifdef CONFIG_SMP
418static int xmon_speaker;
419
420static void get_output_lock(void)
421{
422 int me = smp_processor_id() + 0x100;
423 int last_speaker = 0, prev;
424 long timeout;
425
426 if (xmon_speaker == me)
427 return;
428
429 for (;;) {
430 last_speaker = cmpxchg(&xmon_speaker, 0, me);
431 if (last_speaker == 0)
432 return;
433
434 /*
435 * Wait a full second for the lock, we might be on a slow
436 * console, but check every 100us.
437 */
438 timeout = 10000;
439 while (xmon_speaker == last_speaker) {
440 if (--timeout > 0) {
441 udelay(100);
442 continue;
443 }
444
445 /* hostile takeover */
446 prev = cmpxchg(&xmon_speaker, last_speaker, me);
447 if (prev == last_speaker)
448 return;
449 break;
450 }
451 }
452}
453
454static void release_output_lock(void)
455{
456 xmon_speaker = 0;
457}
458
459int cpus_are_in_xmon(void)
460{
461 return !cpumask_empty(&cpus_in_xmon);
462}
463
464static bool wait_for_other_cpus(int ncpus)
465{
466 unsigned long timeout;
467
468 /* We wait for 2s, which is a metric "little while" */
469 for (timeout = 20000; timeout != 0; --timeout) {
470 if (cpumask_weight(&cpus_in_xmon) >= ncpus)
471 return true;
472 udelay(100);
473 barrier();
474 }
475
476 return false;
477}
478#else /* CONFIG_SMP */
479static inline void get_output_lock(void) {}
480static inline void release_output_lock(void) {}
481#endif
482
483static void xmon_touch_watchdogs(void)
484{
485 touch_softlockup_watchdog_sync();
486 rcu_cpu_stall_reset();
487 touch_nmi_watchdog();
488}
489
490static int xmon_core(struct pt_regs *regs, volatile int fromipi)
491{
492 volatile int cmd = 0;
493 struct bpt *volatile bp;
494 long recurse_jmp[JMP_BUF_LEN];
495 bool locked_down;
496 unsigned long offset;
497 unsigned long flags;
498#ifdef CONFIG_SMP
499 int cpu;
500 int secondary;
501#endif
502
503 local_irq_save(flags);
504 hard_irq_disable();
505
506 locked_down = xmon_is_locked_down();
507
508 if (!fromipi) {
509 tracing_enabled = tracing_is_on();
510 tracing_off();
511 }
512
513 bp = in_breakpoint_table(regs->nip, &offset);
514 if (bp != NULL) {
515 regs_set_return_ip(regs, bp->address + offset);
516 atomic_dec(&bp->ref_count);
517 }
518
519 remove_cpu_bpts();
520
521#ifdef CONFIG_SMP
522 cpu = smp_processor_id();
523 if (cpumask_test_cpu(cpu, &cpus_in_xmon)) {
524 /*
525 * We catch SPR read/write faults here because the 0x700, 0xf60
526 * etc. handlers don't call debugger_fault_handler().
527 */
528 if (catch_spr_faults)
529 longjmp(bus_error_jmp, 1);
530 get_output_lock();
531 excprint(regs);
532 printf("cpu 0x%x: Exception %lx %s in xmon, "
533 "returning to main loop\n",
534 cpu, regs->trap, getvecname(TRAP(regs)));
535 release_output_lock();
536 longjmp(xmon_fault_jmp[cpu], 1);
537 }
538
539 if (setjmp(recurse_jmp) != 0) {
540 if (!in_xmon || !xmon_gate) {
541 get_output_lock();
542 printf("xmon: WARNING: bad recursive fault "
543 "on cpu 0x%x\n", cpu);
544 release_output_lock();
545 goto waiting;
546 }
547 secondary = !(xmon_taken && cpu == xmon_owner);
548 goto cmdloop;
549 }
550
551 xmon_fault_jmp[cpu] = recurse_jmp;
552
553 bp = NULL;
554 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT))
555 bp = at_breakpoint(regs->nip);
556 if (bp || regs_is_unrecoverable(regs))
557 fromipi = 0;
558
559 if (!fromipi) {
560 get_output_lock();
561 if (!locked_down)
562 excprint(regs);
563 if (bp) {
564 printf("cpu 0x%x stopped at breakpoint 0x%tx (",
565 cpu, BP_NUM(bp));
566 xmon_print_symbol(regs->nip, " ", ")\n");
567 }
568 if (regs_is_unrecoverable(regs))
569 printf("WARNING: exception is not recoverable, "
570 "can't continue\n");
571 release_output_lock();
572 }
573
574 cpumask_set_cpu(cpu, &cpus_in_xmon);
575
576 waiting:
577 secondary = 1;
578 spin_begin();
579 while (secondary && !xmon_gate) {
580 if (in_xmon == 0) {
581 if (fromipi) {
582 spin_end();
583 goto leave;
584 }
585 secondary = test_and_set_bit(0, &in_xmon);
586 }
587 spin_cpu_relax();
588 touch_nmi_watchdog();
589 }
590 spin_end();
591
592 if (!secondary && !xmon_gate) {
593 /* we are the first cpu to come in */
594 /* interrupt other cpu(s) */
595 int ncpus = num_online_cpus();
596
597 xmon_owner = cpu;
598 mb();
599 if (ncpus > 1) {
600 /*
601 * A system reset (trap == 0x100) can be triggered on
602 * all CPUs, so when we come in via 0x100 try waiting
603 * for the other CPUs to come in before we send the
604 * debugger break (IPI). This is similar to
605 * crash_kexec_secondary().
606 */
607 if (TRAP(regs) != INTERRUPT_SYSTEM_RESET || !wait_for_other_cpus(ncpus))
608 smp_send_debugger_break();
609
610 wait_for_other_cpus(ncpus);
611 }
612 remove_bpts();
613 disable_surveillance();
614
615 if (!locked_down) {
616 /* for breakpoint or single step, print curr insn */
617 if (bp || TRAP(regs) == INTERRUPT_TRACE)
618 ppc_inst_dump(regs->nip, 1, 0);
619 printf("enter ? for help\n");
620 }
621
622 mb();
623 xmon_gate = 1;
624 barrier();
625 touch_nmi_watchdog();
626 }
627
628 cmdloop:
629 while (in_xmon) {
630 if (secondary) {
631 spin_begin();
632 if (cpu == xmon_owner) {
633 if (!test_and_set_bit(0, &xmon_taken)) {
634 secondary = 0;
635 spin_end();
636 continue;
637 }
638 /* missed it */
639 while (cpu == xmon_owner)
640 spin_cpu_relax();
641 }
642 spin_cpu_relax();
643 touch_nmi_watchdog();
644 } else {
645 cmd = 1;
646#ifdef CONFIG_SMP
647 if (xmon_batch)
648 cmd = batch_cmds(regs);
649#endif
650 if (!locked_down && cmd)
651 cmd = cmds(regs);
652 if (locked_down || cmd != 0) {
653 /* exiting xmon */
654 insert_bpts();
655 xmon_gate = 0;
656 wmb();
657 in_xmon = 0;
658 break;
659 }
660 /* have switched to some other cpu */
661 secondary = 1;
662 }
663 }
664 leave:
665 cpumask_clear_cpu(cpu, &cpus_in_xmon);
666 xmon_fault_jmp[cpu] = NULL;
667#else
668 /* UP is simple... */
669 if (in_xmon) {
670 printf("Exception %lx %s in xmon, returning to main loop\n",
671 regs->trap, getvecname(TRAP(regs)));
672 longjmp(xmon_fault_jmp[0], 1);
673 }
674 if (setjmp(recurse_jmp) == 0) {
675 xmon_fault_jmp[0] = recurse_jmp;
676 in_xmon = 1;
677
678 excprint(regs);
679 bp = at_breakpoint(regs->nip);
680 if (bp) {
681 printf("Stopped at breakpoint %tx (", BP_NUM(bp));
682 xmon_print_symbol(regs->nip, " ", ")\n");
683 }
684 if (regs_is_unrecoverable(regs))
685 printf("WARNING: exception is not recoverable, "
686 "can't continue\n");
687 remove_bpts();
688 disable_surveillance();
689 if (!locked_down) {
690 /* for breakpoint or single step, print current insn */
691 if (bp || TRAP(regs) == INTERRUPT_TRACE)
692 ppc_inst_dump(regs->nip, 1, 0);
693 printf("enter ? for help\n");
694 }
695 }
696
697 if (!locked_down)
698 cmd = cmds(regs);
699
700 insert_bpts();
701 in_xmon = 0;
702#endif
703
704#ifdef CONFIG_BOOKE
705 if (regs->msr & MSR_DE) {
706 bp = at_breakpoint(regs->nip);
707 if (bp != NULL) {
708 regs_set_return_ip(regs, (unsigned long) &bp->instr[0]);
709 atomic_inc(&bp->ref_count);
710 }
711 }
712#else
713 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT)) {
714 bp = at_breakpoint(regs->nip);
715 if (bp != NULL) {
716 int stepped = emulate_step(regs, ppc_inst_read(bp->instr));
717 if (stepped == 0) {
718 regs_set_return_ip(regs, (unsigned long) &bp->instr[0]);
719 atomic_inc(&bp->ref_count);
720 } else if (stepped < 0) {
721 printf("Couldn't single-step %s instruction\n",
722 IS_RFID(ppc_inst_read(bp->instr))? "rfid": "mtmsrd");
723 }
724 }
725 }
726#endif
727 if (locked_down)
728 clear_all_bpt();
729 else
730 insert_cpu_bpts();
731
732 xmon_touch_watchdogs();
733 local_irq_restore(flags);
734
735 return cmd != 'X' && cmd != EOF;
736}
737
738int xmon(struct pt_regs *excp)
739{
740 struct pt_regs regs;
741
742 if (excp == NULL) {
743 ppc_save_regs(®s);
744 excp = ®s;
745 }
746
747 return xmon_core(excp, 0);
748}
749EXPORT_SYMBOL(xmon);
750
751irqreturn_t xmon_irq(int irq, void *d)
752{
753 unsigned long flags;
754 local_irq_save(flags);
755 printf("Keyboard interrupt\n");
756 xmon(get_irq_regs());
757 local_irq_restore(flags);
758 return IRQ_HANDLED;
759}
760
761static int xmon_bpt(struct pt_regs *regs)
762{
763 struct bpt *bp;
764 unsigned long offset;
765
766 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
767 return 0;
768
769 /* Are we at the trap at bp->instr[1] for some bp? */
770 bp = in_breakpoint_table(regs->nip, &offset);
771 if (bp != NULL && (offset == 4 || offset == 8)) {
772 regs_set_return_ip(regs, bp->address + offset);
773 atomic_dec(&bp->ref_count);
774 return 1;
775 }
776
777 /* Are we at a breakpoint? */
778 bp = at_breakpoint(regs->nip);
779 if (!bp)
780 return 0;
781
782 xmon_core(regs, 0);
783
784 return 1;
785}
786
787static int xmon_sstep(struct pt_regs *regs)
788{
789 if (user_mode(regs))
790 return 0;
791 xmon_core(regs, 0);
792 return 1;
793}
794
795static int xmon_break_match(struct pt_regs *regs)
796{
797 int i;
798
799 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
800 return 0;
801 for (i = 0; i < nr_wp_slots(); i++) {
802 if (dabr[i].enabled)
803 goto found;
804 }
805 return 0;
806
807found:
808 xmon_core(regs, 0);
809 return 1;
810}
811
812static int xmon_iabr_match(struct pt_regs *regs)
813{
814 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
815 return 0;
816 if (iabr == NULL)
817 return 0;
818 xmon_core(regs, 0);
819 return 1;
820}
821
822static int xmon_ipi(struct pt_regs *regs)
823{
824#ifdef CONFIG_SMP
825 if (in_xmon && !cpumask_test_cpu(smp_processor_id(), &cpus_in_xmon))
826 xmon_core(regs, 1);
827#endif
828 return 0;
829}
830
831static int xmon_fault_handler(struct pt_regs *regs)
832{
833 struct bpt *bp;
834 unsigned long offset;
835
836 if (in_xmon && catch_memory_errors)
837 handle_fault(regs); /* doesn't return */
838
839 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT)) {
840 bp = in_breakpoint_table(regs->nip, &offset);
841 if (bp != NULL) {
842 regs_set_return_ip(regs, bp->address + offset);
843 atomic_dec(&bp->ref_count);
844 }
845 }
846
847 return 0;
848}
849
850/* Force enable xmon if not already enabled */
851static inline void force_enable_xmon(void)
852{
853 /* Enable xmon hooks if needed */
854 if (!xmon_on) {
855 printf("xmon: Enabling debugger hooks\n");
856 xmon_on = 1;
857 }
858}
859
860static struct bpt *at_breakpoint(unsigned long pc)
861{
862 int i;
863 struct bpt *volatile bp;
864
865 bp = bpts;
866 for (i = 0; i < NBPTS; ++i, ++bp)
867 if (bp->enabled && pc == bp->address)
868 return bp;
869 return NULL;
870}
871
872static struct bpt *in_breakpoint_table(unsigned long nip, unsigned long *offp)
873{
874 unsigned long off;
875
876 off = nip - (unsigned long)bpt_table;
877 if (off >= sizeof(bpt_table))
878 return NULL;
879 *offp = off & (BPT_SIZE - 1);
880 if (off & 3)
881 return NULL;
882 return bpts + (off / BPT_SIZE);
883}
884
885static struct bpt *new_breakpoint(unsigned long a)
886{
887 struct bpt *bp;
888
889 a &= ~3UL;
890 bp = at_breakpoint(a);
891 if (bp)
892 return bp;
893
894 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
895 if (!bp->enabled && atomic_read(&bp->ref_count) == 0) {
896 bp->address = a;
897 bp->instr = (void *)(bpt_table + ((bp - bpts) * BPT_WORDS));
898 return bp;
899 }
900 }
901
902 printf("Sorry, no free breakpoints. Please clear one first.\n");
903 return NULL;
904}
905
906static void insert_bpts(void)
907{
908 int i;
909 ppc_inst_t instr, instr2;
910 struct bpt *bp, *bp2;
911
912 bp = bpts;
913 for (i = 0; i < NBPTS; ++i, ++bp) {
914 if ((bp->enabled & (BP_TRAP|BP_CIABR)) == 0)
915 continue;
916 if (!mread_instr(bp->address, &instr)) {
917 printf("Couldn't read instruction at %lx, "
918 "disabling breakpoint there\n", bp->address);
919 bp->enabled = 0;
920 continue;
921 }
922 if (!can_single_step(ppc_inst_val(instr))) {
923 printf("Breakpoint at %lx is on an instruction that can't be single stepped, disabling it\n",
924 bp->address);
925 bp->enabled = 0;
926 continue;
927 }
928 /*
929 * Check the address is not a suffix by looking for a prefix in
930 * front of it.
931 */
932 if (mread_instr(bp->address - 4, &instr2) == 8) {
933 printf("Breakpoint at %lx is on the second word of a prefixed instruction, disabling it\n",
934 bp->address);
935 bp->enabled = 0;
936 continue;
937 }
938 /*
939 * We might still be a suffix - if the prefix has already been
940 * replaced by a breakpoint we won't catch it with the above
941 * test.
942 */
943 bp2 = at_breakpoint(bp->address - 4);
944 if (bp2 && ppc_inst_prefixed(ppc_inst_read(bp2->instr))) {
945 printf("Breakpoint at %lx is on the second word of a prefixed instruction, disabling it\n",
946 bp->address);
947 bp->enabled = 0;
948 continue;
949 }
950
951 patch_instruction(bp->instr, instr);
952 patch_instruction(ppc_inst_next(bp->instr, bp->instr),
953 ppc_inst(bpinstr));
954 if (bp->enabled & BP_CIABR)
955 continue;
956 if (patch_instruction((u32 *)bp->address,
957 ppc_inst(bpinstr)) != 0) {
958 printf("Couldn't write instruction at %lx, "
959 "disabling breakpoint there\n", bp->address);
960 bp->enabled &= ~BP_TRAP;
961 continue;
962 }
963 }
964}
965
966static void insert_cpu_bpts(void)
967{
968 int i;
969 struct arch_hw_breakpoint brk;
970
971 for (i = 0; i < nr_wp_slots(); i++) {
972 if (dabr[i].enabled) {
973 brk.address = dabr[i].address;
974 brk.type = (dabr[i].enabled & HW_BRK_TYPE_DABR) | HW_BRK_TYPE_PRIV_ALL;
975 brk.len = 8;
976 brk.hw_len = 8;
977 __set_breakpoint(i, &brk);
978 }
979 }
980
981 if (iabr)
982 set_ciabr(iabr->address);
983}
984
985static void remove_bpts(void)
986{
987 int i;
988 struct bpt *bp;
989 ppc_inst_t instr;
990
991 bp = bpts;
992 for (i = 0; i < NBPTS; ++i, ++bp) {
993 if ((bp->enabled & (BP_TRAP|BP_CIABR)) != BP_TRAP)
994 continue;
995 if (mread_instr(bp->address, &instr)
996 && ppc_inst_equal(instr, ppc_inst(bpinstr))
997 && patch_instruction(
998 (u32 *)bp->address, ppc_inst_read(bp->instr)) != 0)
999 printf("Couldn't remove breakpoint at %lx\n",
1000 bp->address);
1001 }
1002}
1003
1004static void remove_cpu_bpts(void)
1005{
1006 hw_breakpoint_disable();
1007 write_ciabr(0);
1008}
1009
1010/* Based on uptime_proc_show(). */
1011static void
1012show_uptime(void)
1013{
1014 struct timespec64 uptime;
1015
1016 if (setjmp(bus_error_jmp) == 0) {
1017 catch_memory_errors = 1;
1018 sync();
1019
1020 ktime_get_coarse_boottime_ts64(&uptime);
1021 printf("Uptime: %lu.%.2lu seconds\n", (unsigned long)uptime.tv_sec,
1022 ((unsigned long)uptime.tv_nsec / (NSEC_PER_SEC/100)));
1023
1024 sync();
1025 __delay(200); \
1026 }
1027 catch_memory_errors = 0;
1028}
1029
1030static void set_lpp_cmd(void)
1031{
1032 unsigned long lpp;
1033
1034 if (!scanhex(&lpp)) {
1035 printf("Invalid number.\n");
1036 lpp = 0;
1037 }
1038 xmon_set_pagination_lpp(lpp);
1039}
1040/* Command interpreting routine */
1041static char *last_cmd;
1042
1043static int
1044cmds(struct pt_regs *excp)
1045{
1046 int cmd = 0;
1047
1048 last_cmd = NULL;
1049 xmon_regs = excp;
1050
1051 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
1052
1053 for(;;) {
1054#ifdef CONFIG_SMP
1055 printf("%x:", smp_processor_id());
1056#endif /* CONFIG_SMP */
1057 printf("mon> ");
1058 flush_input();
1059 termch = 0;
1060 cmd = skipbl();
1061 if( cmd == '\n' ) {
1062 if (last_cmd == NULL)
1063 continue;
1064 take_input(last_cmd);
1065 last_cmd = NULL;
1066 cmd = inchar();
1067 }
1068 switch (cmd) {
1069 case 'm':
1070 cmd = inchar();
1071 switch (cmd) {
1072 case 'm':
1073 case 's':
1074 case 'd':
1075 memops(cmd);
1076 break;
1077 case 'l':
1078 memlocate();
1079 break;
1080 case 'z':
1081 if (xmon_is_ro) {
1082 printf(xmon_ro_msg);
1083 break;
1084 }
1085 memzcan();
1086 break;
1087 case 'i':
1088 show_mem();
1089 break;
1090 default:
1091 termch = cmd;
1092 memex();
1093 }
1094 break;
1095 case 'd':
1096 dump();
1097 break;
1098 case 'l':
1099 symbol_lookup();
1100 break;
1101 case 'r':
1102 prregs(excp); /* print regs */
1103 break;
1104 case 'e':
1105 excprint(excp);
1106 break;
1107 case 'S':
1108 super_regs();
1109 break;
1110 case 't':
1111 backtrace(excp);
1112 break;
1113 case 'f':
1114 cacheflush();
1115 break;
1116 case 's':
1117 if (do_spu_cmd() == 0)
1118 break;
1119 if (do_step(excp))
1120 return cmd;
1121 break;
1122 case 'x':
1123 case 'X':
1124 if (tracing_enabled)
1125 tracing_on();
1126 return cmd;
1127 case EOF:
1128 printf(" <no input ...>\n");
1129 mdelay(2000);
1130 return cmd;
1131 case '?':
1132 xmon_puts(help_string);
1133 break;
1134 case '#':
1135 set_lpp_cmd();
1136 break;
1137 case 'b':
1138 bpt_cmds();
1139 break;
1140 case 'C':
1141 csum();
1142 break;
1143 case 'c':
1144 if (cpu_cmd())
1145 return 0;
1146 break;
1147 case 'z':
1148 bootcmds();
1149 break;
1150 case 'p':
1151 if (xmon_is_ro) {
1152 printf(xmon_ro_msg);
1153 break;
1154 }
1155 proccall();
1156 break;
1157 case 'P':
1158 show_tasks();
1159 break;
1160#if defined(CONFIG_PPC_BOOK3S_32) || defined(CONFIG_PPC_64S_HASH_MMU)
1161 case 'u':
1162 dump_segments();
1163 break;
1164#elif defined(CONFIG_44x)
1165 case 'u':
1166 dump_tlb_44x();
1167 break;
1168#elif defined(CONFIG_PPC_BOOK3E_64)
1169 case 'u':
1170 dump_tlb_book3e();
1171 break;
1172#endif
1173 case 'U':
1174 show_uptime();
1175 break;
1176 default:
1177 printf("Unrecognized command: ");
1178 do {
1179 if (' ' < cmd && cmd <= '~')
1180 putchar(cmd);
1181 else
1182 printf("\\x%x", cmd);
1183 cmd = inchar();
1184 } while (cmd != '\n');
1185 printf(" (type ? for help)\n");
1186 break;
1187 }
1188 }
1189}
1190
1191#ifdef CONFIG_BOOKE
1192static int do_step(struct pt_regs *regs)
1193{
1194 regs_set_return_msr(regs, regs->msr | MSR_DE);
1195 mtspr(SPRN_DBCR0, mfspr(SPRN_DBCR0) | DBCR0_IC | DBCR0_IDM);
1196 return 1;
1197}
1198#else
1199/*
1200 * Step a single instruction.
1201 * Some instructions we emulate, others we execute with MSR_SE set.
1202 */
1203static int do_step(struct pt_regs *regs)
1204{
1205 ppc_inst_t instr;
1206 int stepped;
1207
1208 force_enable_xmon();
1209 /* check we are in 64-bit kernel mode, translation enabled */
1210 if ((regs->msr & (MSR_64BIT|MSR_PR|MSR_IR)) == (MSR_64BIT|MSR_IR)) {
1211 if (mread_instr(regs->nip, &instr)) {
1212 stepped = emulate_step(regs, instr);
1213 if (stepped < 0) {
1214 printf("Couldn't single-step %s instruction\n",
1215 (IS_RFID(instr)? "rfid": "mtmsrd"));
1216 return 0;
1217 }
1218 if (stepped > 0) {
1219 set_trap(regs, 0xd00);
1220 printf("stepped to ");
1221 xmon_print_symbol(regs->nip, " ", "\n");
1222 ppc_inst_dump(regs->nip, 1, 0);
1223 return 0;
1224 }
1225 }
1226 }
1227 regs_set_return_msr(regs, regs->msr | MSR_SE);
1228 return 1;
1229}
1230#endif
1231
1232static void bootcmds(void)
1233{
1234 char tmp[64];
1235 int cmd;
1236
1237 cmd = inchar();
1238 if (cmd == 'r') {
1239 getstring(tmp, 64);
1240 ppc_md.restart(tmp);
1241 } else if (cmd == 'h') {
1242 ppc_md.halt();
1243 } else if (cmd == 'p') {
1244 do_kernel_power_off();
1245 }
1246}
1247
1248#ifdef CONFIG_SMP
1249static int xmon_switch_cpu(unsigned long cpu)
1250{
1251 int timeout;
1252
1253 xmon_taken = 0;
1254 mb();
1255 xmon_owner = cpu;
1256 timeout = 10000000;
1257 while (!xmon_taken) {
1258 if (--timeout == 0) {
1259 if (test_and_set_bit(0, &xmon_taken))
1260 break;
1261 /* take control back */
1262 mb();
1263 xmon_owner = smp_processor_id();
1264 printf("cpu 0x%lx didn't take control\n", cpu);
1265 return 0;
1266 }
1267 barrier();
1268 }
1269 return 1;
1270}
1271
1272static int xmon_batch_next_cpu(void)
1273{
1274 unsigned long cpu;
1275
1276 while (!cpumask_empty(&xmon_batch_cpus)) {
1277 cpu = cpumask_next_wrap(smp_processor_id(), &xmon_batch_cpus,
1278 xmon_batch_start_cpu, true);
1279 if (cpu >= nr_cpu_ids)
1280 break;
1281 if (xmon_batch_start_cpu == -1)
1282 xmon_batch_start_cpu = cpu;
1283 if (xmon_switch_cpu(cpu))
1284 return 0;
1285 cpumask_clear_cpu(cpu, &xmon_batch_cpus);
1286 }
1287
1288 xmon_batch = 0;
1289 printf("%x:mon> \n", smp_processor_id());
1290 return 1;
1291}
1292
1293static int batch_cmds(struct pt_regs *excp)
1294{
1295 int cmd;
1296
1297 /* simulate command entry */
1298 cmd = xmon_batch;
1299 termch = '\n';
1300
1301 last_cmd = NULL;
1302 xmon_regs = excp;
1303
1304 printf("%x:", smp_processor_id());
1305 printf("mon> ");
1306 printf("%c\n", (char)cmd);
1307
1308 switch (cmd) {
1309 case 'r':
1310 prregs(excp); /* print regs */
1311 break;
1312 case 'S':
1313 super_regs();
1314 break;
1315 case 't':
1316 backtrace(excp);
1317 break;
1318 }
1319
1320 cpumask_clear_cpu(smp_processor_id(), &xmon_batch_cpus);
1321
1322 return xmon_batch_next_cpu();
1323}
1324
1325static int cpu_cmd(void)
1326{
1327 unsigned long cpu, first_cpu, last_cpu;
1328
1329 cpu = skipbl();
1330 if (cpu == '#') {
1331 xmon_batch = skipbl();
1332 if (xmon_batch) {
1333 switch (xmon_batch) {
1334 case 'r':
1335 case 'S':
1336 case 't':
1337 cpumask_copy(&xmon_batch_cpus, &cpus_in_xmon);
1338 if (cpumask_weight(&xmon_batch_cpus) <= 1) {
1339 printf("There are no other cpus in xmon\n");
1340 break;
1341 }
1342 xmon_batch_start_cpu = -1;
1343 if (!xmon_batch_next_cpu())
1344 return 1;
1345 break;
1346 default:
1347 printf("c# only supports 'r', 'S' and 't' commands\n");
1348 }
1349 xmon_batch = 0;
1350 return 0;
1351 }
1352 }
1353 termch = cpu;
1354
1355 if (!scanhex(&cpu)) {
1356 /* print cpus waiting or in xmon */
1357 printf("cpus stopped:");
1358 last_cpu = first_cpu = NR_CPUS;
1359 for_each_possible_cpu(cpu) {
1360 if (cpumask_test_cpu(cpu, &cpus_in_xmon)) {
1361 if (cpu == last_cpu + 1) {
1362 last_cpu = cpu;
1363 } else {
1364 if (last_cpu != first_cpu)
1365 printf("-0x%lx", last_cpu);
1366 last_cpu = first_cpu = cpu;
1367 printf(" 0x%lx", cpu);
1368 }
1369 }
1370 }
1371 if (last_cpu != first_cpu)
1372 printf("-0x%lx", last_cpu);
1373 printf("\n");
1374 return 0;
1375 }
1376 /* try to switch to cpu specified */
1377 if (!cpumask_test_cpu(cpu, &cpus_in_xmon)) {
1378 printf("cpu 0x%lx isn't in xmon\n", cpu);
1379#ifdef CONFIG_PPC64
1380 printf("backtrace of paca[0x%lx].saved_r1 (possibly stale):\n", cpu);
1381 xmon_show_stack(paca_ptrs[cpu]->saved_r1, 0, 0);
1382#endif
1383 return 0;
1384 }
1385
1386 return xmon_switch_cpu(cpu);
1387}
1388#else
1389static int cpu_cmd(void)
1390{
1391 return 0;
1392}
1393#endif /* CONFIG_SMP */
1394
1395static unsigned short fcstab[256] = {
1396 0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
1397 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
1398 0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
1399 0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
1400 0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
1401 0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
1402 0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
1403 0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
1404 0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
1405 0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
1406 0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
1407 0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
1408 0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
1409 0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
1410 0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
1411 0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
1412 0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
1413 0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
1414 0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
1415 0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
1416 0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
1417 0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
1418 0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
1419 0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
1420 0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
1421 0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
1422 0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
1423 0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
1424 0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
1425 0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
1426 0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
1427 0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
1428};
1429
1430#define FCS(fcs, c) (((fcs) >> 8) ^ fcstab[((fcs) ^ (c)) & 0xff])
1431
1432static void
1433csum(void)
1434{
1435 unsigned int i;
1436 unsigned short fcs;
1437 unsigned char v;
1438
1439 if (!scanhex(&adrs))
1440 return;
1441 if (!scanhex(&ncsum))
1442 return;
1443 fcs = 0xffff;
1444 for (i = 0; i < ncsum; ++i) {
1445 if (mread(adrs+i, &v, 1) == 0) {
1446 printf("csum stopped at "REG"\n", adrs+i);
1447 break;
1448 }
1449 fcs = FCS(fcs, v);
1450 }
1451 printf("%x\n", fcs);
1452}
1453
1454/*
1455 * Check if this is a suitable place to put a breakpoint.
1456 */
1457static long check_bp_loc(unsigned long addr)
1458{
1459 ppc_inst_t instr;
1460
1461 addr &= ~3;
1462 if (!is_kernel_addr(addr)) {
1463 printf("Breakpoints may only be placed at kernel addresses\n");
1464 return 0;
1465 }
1466 if (!mread_instr(addr, &instr)) {
1467 printf("Can't read instruction at address %lx\n", addr);
1468 return 0;
1469 }
1470 if (!can_single_step(ppc_inst_val(instr))) {
1471 printf("Breakpoints may not be placed on instructions that can't be single stepped\n");
1472 return 0;
1473 }
1474 return 1;
1475}
1476
1477static int find_free_data_bpt(void)
1478{
1479 int i;
1480
1481 for (i = 0; i < nr_wp_slots(); i++) {
1482 if (!dabr[i].enabled)
1483 return i;
1484 }
1485 printf("Couldn't find free breakpoint register\n");
1486 return -1;
1487}
1488
1489static void print_data_bpts(void)
1490{
1491 int i;
1492
1493 for (i = 0; i < nr_wp_slots(); i++) {
1494 if (!dabr[i].enabled)
1495 continue;
1496
1497 printf(" data "REG" [", dabr[i].address);
1498 if (dabr[i].enabled & 1)
1499 printf("r");
1500 if (dabr[i].enabled & 2)
1501 printf("w");
1502 printf("]\n");
1503 }
1504}
1505
1506static char *breakpoint_help_string =
1507 "Breakpoint command usage:\n"
1508 "b show breakpoints\n"
1509 "b <addr> [cnt] set breakpoint at given instr addr\n"
1510 "bc clear all breakpoints\n"
1511 "bc <n/addr> clear breakpoint number n or at addr\n"
1512 "bi <addr> [cnt] set hardware instr breakpoint (POWER8 only)\n"
1513 "bd <addr> [cnt] set hardware data breakpoint\n"
1514 "";
1515
1516static void
1517bpt_cmds(void)
1518{
1519 int cmd;
1520 unsigned long a;
1521 int i;
1522 struct bpt *bp;
1523
1524 cmd = inchar();
1525
1526 switch (cmd) {
1527 case 'd': { /* bd - hardware data breakpoint */
1528 static const char badaddr[] = "Only kernel addresses are permitted for breakpoints\n";
1529 int mode;
1530 if (xmon_is_ro) {
1531 printf(xmon_ro_msg);
1532 break;
1533 }
1534 if (!ppc_breakpoint_available()) {
1535 printf("Hardware data breakpoint not supported on this cpu\n");
1536 break;
1537 }
1538 i = find_free_data_bpt();
1539 if (i < 0)
1540 break;
1541 mode = 7;
1542 cmd = inchar();
1543 if (cmd == 'r')
1544 mode = 5;
1545 else if (cmd == 'w')
1546 mode = 6;
1547 else
1548 termch = cmd;
1549 dabr[i].address = 0;
1550 dabr[i].enabled = 0;
1551 if (scanhex(&dabr[i].address)) {
1552 if (!is_kernel_addr(dabr[i].address)) {
1553 printf(badaddr);
1554 break;
1555 }
1556 dabr[i].address &= ~HW_BRK_TYPE_DABR;
1557 dabr[i].enabled = mode | BP_DABR;
1558 }
1559
1560 force_enable_xmon();
1561 break;
1562 }
1563
1564 case 'i': /* bi - hardware instr breakpoint */
1565 if (xmon_is_ro) {
1566 printf(xmon_ro_msg);
1567 break;
1568 }
1569 if (!cpu_has_feature(CPU_FTR_ARCH_207S)) {
1570 printf("Hardware instruction breakpoint "
1571 "not supported on this cpu\n");
1572 break;
1573 }
1574 if (iabr) {
1575 iabr->enabled &= ~BP_CIABR;
1576 iabr = NULL;
1577 }
1578 if (!scanhex(&a))
1579 break;
1580 if (!check_bp_loc(a))
1581 break;
1582 bp = new_breakpoint(a);
1583 if (bp != NULL) {
1584 bp->enabled |= BP_CIABR;
1585 iabr = bp;
1586 force_enable_xmon();
1587 }
1588 break;
1589
1590 case 'c':
1591 if (!scanhex(&a)) {
1592 /* clear all breakpoints */
1593 for (i = 0; i < NBPTS; ++i)
1594 bpts[i].enabled = 0;
1595 iabr = NULL;
1596 for (i = 0; i < nr_wp_slots(); i++)
1597 dabr[i].enabled = 0;
1598
1599 printf("All breakpoints cleared\n");
1600 break;
1601 }
1602
1603 if (a <= NBPTS && a >= 1) {
1604 /* assume a breakpoint number */
1605 bp = &bpts[a-1]; /* bp nums are 1 based */
1606 } else {
1607 /* assume a breakpoint address */
1608 bp = at_breakpoint(a);
1609 if (bp == NULL) {
1610 printf("No breakpoint at %lx\n", a);
1611 break;
1612 }
1613 }
1614
1615 printf("Cleared breakpoint %tx (", BP_NUM(bp));
1616 xmon_print_symbol(bp->address, " ", ")\n");
1617 bp->enabled = 0;
1618 break;
1619
1620 default:
1621 termch = cmd;
1622 cmd = skipbl();
1623 if (cmd == '?') {
1624 printf(breakpoint_help_string);
1625 break;
1626 }
1627 termch = cmd;
1628
1629 if (xmon_is_ro || !scanhex(&a)) {
1630 /* print all breakpoints */
1631 printf(" type address\n");
1632 print_data_bpts();
1633 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
1634 if (!bp->enabled)
1635 continue;
1636 printf("%tx %s ", BP_NUM(bp),
1637 (bp->enabled & BP_CIABR) ? "inst": "trap");
1638 xmon_print_symbol(bp->address, " ", "\n");
1639 }
1640 break;
1641 }
1642
1643 if (!check_bp_loc(a))
1644 break;
1645 bp = new_breakpoint(a);
1646 if (bp != NULL) {
1647 bp->enabled |= BP_TRAP;
1648 force_enable_xmon();
1649 }
1650 break;
1651 }
1652}
1653
1654/* Very cheap human name for vector lookup. */
1655static
1656const char *getvecname(unsigned long vec)
1657{
1658 char *ret;
1659
1660 switch (vec) {
1661 case 0x100: ret = "(System Reset)"; break;
1662 case 0x200: ret = "(Machine Check)"; break;
1663 case 0x300: ret = "(Data Access)"; break;
1664 case 0x380:
1665 if (radix_enabled())
1666 ret = "(Data Access Out of Range)";
1667 else
1668 ret = "(Data SLB Access)";
1669 break;
1670 case 0x400: ret = "(Instruction Access)"; break;
1671 case 0x480:
1672 if (radix_enabled())
1673 ret = "(Instruction Access Out of Range)";
1674 else
1675 ret = "(Instruction SLB Access)";
1676 break;
1677 case 0x500: ret = "(Hardware Interrupt)"; break;
1678 case 0x600: ret = "(Alignment)"; break;
1679 case 0x700: ret = "(Program Check)"; break;
1680 case 0x800: ret = "(FPU Unavailable)"; break;
1681 case 0x900: ret = "(Decrementer)"; break;
1682 case 0x980: ret = "(Hypervisor Decrementer)"; break;
1683 case 0xa00: ret = "(Doorbell)"; break;
1684 case 0xc00: ret = "(System Call)"; break;
1685 case 0xd00: ret = "(Single Step)"; break;
1686 case 0xe40: ret = "(Emulation Assist)"; break;
1687 case 0xe60: ret = "(HMI)"; break;
1688 case 0xe80: ret = "(Hypervisor Doorbell)"; break;
1689 case 0xf00: ret = "(Performance Monitor)"; break;
1690 case 0xf20: ret = "(Altivec Unavailable)"; break;
1691 case 0x1300: ret = "(Instruction Breakpoint)"; break;
1692 case 0x1500: ret = "(Denormalisation)"; break;
1693 case 0x1700: ret = "(Altivec Assist)"; break;
1694 case 0x3000: ret = "(System Call Vectored)"; break;
1695 default: ret = "";
1696 }
1697 return ret;
1698}
1699
1700static void get_function_bounds(unsigned long pc, unsigned long *startp,
1701 unsigned long *endp)
1702{
1703 unsigned long size, offset;
1704 const char *name;
1705
1706 *startp = *endp = 0;
1707 if (pc == 0)
1708 return;
1709 if (setjmp(bus_error_jmp) == 0) {
1710 catch_memory_errors = 1;
1711 sync();
1712 name = kallsyms_lookup(pc, &size, &offset, NULL, tmpstr);
1713 if (name != NULL) {
1714 *startp = pc - offset;
1715 *endp = pc - offset + size;
1716 }
1717 sync();
1718 }
1719 catch_memory_errors = 0;
1720}
1721
1722#define LRSAVE_OFFSET (STACK_FRAME_LR_SAVE * sizeof(unsigned long))
1723
1724static void xmon_show_stack(unsigned long sp, unsigned long lr,
1725 unsigned long pc)
1726{
1727 int max_to_print = 64;
1728 unsigned long ip;
1729 unsigned long newsp;
1730 unsigned long marker;
1731 struct pt_regs regs;
1732
1733 while (max_to_print--) {
1734 if (!is_kernel_addr(sp)) {
1735 if (sp != 0)
1736 printf("SP (%lx) is in userspace\n", sp);
1737 break;
1738 }
1739
1740 if (!mread(sp + LRSAVE_OFFSET, &ip, sizeof(unsigned long))
1741 || !mread(sp, &newsp, sizeof(unsigned long))) {
1742 printf("Couldn't read stack frame at %lx\n", sp);
1743 break;
1744 }
1745
1746 /*
1747 * For the first stack frame, try to work out if
1748 * LR and/or the saved LR value in the bottommost
1749 * stack frame are valid.
1750 */
1751 if ((pc | lr) != 0) {
1752 unsigned long fnstart, fnend;
1753 unsigned long nextip;
1754 int printip = 1;
1755
1756 get_function_bounds(pc, &fnstart, &fnend);
1757 nextip = 0;
1758 if (newsp > sp)
1759 mread(newsp + LRSAVE_OFFSET, &nextip,
1760 sizeof(unsigned long));
1761 if (lr == ip) {
1762 if (!is_kernel_addr(lr)
1763 || (fnstart <= lr && lr < fnend))
1764 printip = 0;
1765 } else if (lr == nextip) {
1766 printip = 0;
1767 } else if (is_kernel_addr(lr)
1768 && !(fnstart <= lr && lr < fnend)) {
1769 printf("[link register ] ");
1770 xmon_print_symbol(lr, " ", "\n");
1771 }
1772 if (printip) {
1773 printf("["REG"] ", sp);
1774 xmon_print_symbol(ip, " ", " (unreliable)\n");
1775 }
1776 pc = lr = 0;
1777
1778 } else {
1779 printf("["REG"] ", sp);
1780 xmon_print_symbol(ip, " ", "\n");
1781 }
1782
1783 /* Look for "regs" marker to see if this is
1784 an exception frame. */
1785 if (mread(sp + STACK_INT_FRAME_MARKER, &marker, sizeof(unsigned long))
1786 && marker == STACK_FRAME_REGS_MARKER) {
1787 if (mread(sp + STACK_INT_FRAME_REGS, ®s, sizeof(regs)) != sizeof(regs)) {
1788 printf("Couldn't read registers at %lx\n",
1789 sp + STACK_INT_FRAME_REGS);
1790 break;
1791 }
1792 printf("--- Exception: %lx %s at ", regs.trap,
1793 getvecname(TRAP(®s)));
1794 pc = regs.nip;
1795 lr = regs.link;
1796 xmon_print_symbol(pc, " ", "\n");
1797 }
1798
1799 if (newsp == 0)
1800 break;
1801
1802 sp = newsp;
1803 }
1804}
1805
1806static void backtrace(struct pt_regs *excp)
1807{
1808 unsigned long sp;
1809
1810 if (scanhex(&sp))
1811 xmon_show_stack(sp, 0, 0);
1812 else
1813 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
1814 scannl();
1815}
1816
1817static void print_bug_trap(struct pt_regs *regs)
1818{
1819#ifdef CONFIG_BUG
1820 const struct bug_entry *bug;
1821 unsigned long addr;
1822
1823 if (regs->msr & MSR_PR)
1824 return; /* not in kernel */
1825 addr = regs->nip; /* address of trap instruction */
1826 if (!is_kernel_addr(addr))
1827 return;
1828 bug = find_bug(regs->nip);
1829 if (bug == NULL)
1830 return;
1831 if (is_warning_bug(bug))
1832 return;
1833
1834#ifdef CONFIG_DEBUG_BUGVERBOSE
1835 printf("kernel BUG at %s:%u!\n",
1836 (char *)bug + bug->file_disp, bug->line);
1837#else
1838 printf("kernel BUG at %px!\n", (void *)bug + bug->bug_addr_disp);
1839#endif
1840#endif /* CONFIG_BUG */
1841}
1842
1843static void excprint(struct pt_regs *fp)
1844{
1845 unsigned long trap;
1846
1847#ifdef CONFIG_SMP
1848 printf("cpu 0x%x: ", smp_processor_id());
1849#endif /* CONFIG_SMP */
1850
1851 trap = TRAP(fp);
1852 printf("Vector: %lx %s at [%px]\n", fp->trap, getvecname(trap), fp);
1853 printf(" pc: ");
1854 xmon_print_symbol(fp->nip, ": ", "\n");
1855
1856 printf(" lr: ");
1857 xmon_print_symbol(fp->link, ": ", "\n");
1858
1859 printf(" sp: %lx\n", fp->gpr[1]);
1860 printf(" msr: %lx\n", fp->msr);
1861
1862 if (trap == INTERRUPT_DATA_STORAGE ||
1863 trap == INTERRUPT_DATA_SEGMENT ||
1864 trap == INTERRUPT_ALIGNMENT ||
1865 trap == INTERRUPT_MACHINE_CHECK) {
1866 printf(" dar: %lx\n", fp->dar);
1867 if (trap != INTERRUPT_DATA_SEGMENT)
1868 printf(" dsisr: %lx\n", fp->dsisr);
1869 }
1870
1871 printf(" current = 0x%px\n", current);
1872#ifdef CONFIG_PPC64
1873 printf(" paca = 0x%px\t irqmask: 0x%02x\t irq_happened: 0x%02x\n",
1874 local_paca, local_paca->irq_soft_mask, local_paca->irq_happened);
1875#endif
1876 if (current) {
1877 printf(" pid = %d, comm = %s\n",
1878 current->pid, current->comm);
1879 }
1880
1881 if (trap == INTERRUPT_PROGRAM)
1882 print_bug_trap(fp);
1883
1884 printf(linux_banner);
1885}
1886
1887static void prregs(struct pt_regs *fp)
1888{
1889 int n, trap;
1890 unsigned long base;
1891 struct pt_regs regs;
1892
1893 if (scanhex(&base)) {
1894 if (setjmp(bus_error_jmp) == 0) {
1895 catch_memory_errors = 1;
1896 sync();
1897 regs = *(struct pt_regs *)base;
1898 sync();
1899 __delay(200);
1900 } else {
1901 catch_memory_errors = 0;
1902 printf("*** Error reading registers from "REG"\n",
1903 base);
1904 return;
1905 }
1906 catch_memory_errors = 0;
1907 fp = ®s;
1908 }
1909
1910#ifdef CONFIG_PPC64
1911#define R_PER_LINE 2
1912#else
1913#define R_PER_LINE 4
1914#endif
1915
1916 for (n = 0; n < 32; ++n) {
1917 printf("R%.2d = "REG"%s", n, fp->gpr[n],
1918 (n % R_PER_LINE) == R_PER_LINE - 1 ? "\n" : " ");
1919 }
1920
1921 printf("pc = ");
1922 xmon_print_symbol(fp->nip, " ", "\n");
1923 if (!trap_is_syscall(fp) && cpu_has_feature(CPU_FTR_CFAR)) {
1924 printf("cfar= ");
1925 xmon_print_symbol(fp->orig_gpr3, " ", "\n");
1926 }
1927 printf("lr = ");
1928 xmon_print_symbol(fp->link, " ", "\n");
1929 printf("msr = "REG" cr = %.8lx\n", fp->msr, fp->ccr);
1930 printf("ctr = "REG" xer = "REG" trap = %4lx\n",
1931 fp->ctr, fp->xer, fp->trap);
1932 trap = TRAP(fp);
1933 if (trap == INTERRUPT_DATA_STORAGE ||
1934 trap == INTERRUPT_DATA_SEGMENT ||
1935 trap == INTERRUPT_ALIGNMENT)
1936 printf("dar = "REG" dsisr = %.8lx\n", fp->dar, fp->dsisr);
1937}
1938
1939static void cacheflush(void)
1940{
1941 int cmd;
1942 unsigned long nflush;
1943
1944 cmd = inchar();
1945 if (cmd != 'i')
1946 termch = cmd;
1947 scanhex((void *)&adrs);
1948 if (termch != '\n')
1949 termch = 0;
1950 nflush = 1;
1951 scanhex(&nflush);
1952 nflush = (nflush + L1_CACHE_BYTES - 1) / L1_CACHE_BYTES;
1953 if (setjmp(bus_error_jmp) == 0) {
1954 catch_memory_errors = 1;
1955 sync();
1956
1957 if (cmd != 'i' || IS_ENABLED(CONFIG_PPC_BOOK3S_64)) {
1958 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1959 cflush((void *) adrs);
1960 } else {
1961 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1962 cinval((void *) adrs);
1963 }
1964 sync();
1965 /* wait a little while to see if we get a machine check */
1966 __delay(200);
1967 }
1968 catch_memory_errors = 0;
1969}
1970
1971extern unsigned long xmon_mfspr(int spr, unsigned long default_value);
1972extern void xmon_mtspr(int spr, unsigned long value);
1973
1974static int
1975read_spr(int n, unsigned long *vp)
1976{
1977 unsigned long ret = -1UL;
1978 int ok = 0;
1979
1980 if (setjmp(bus_error_jmp) == 0) {
1981 catch_spr_faults = 1;
1982 sync();
1983
1984 ret = xmon_mfspr(n, *vp);
1985
1986 sync();
1987 *vp = ret;
1988 ok = 1;
1989 }
1990 catch_spr_faults = 0;
1991
1992 return ok;
1993}
1994
1995static void
1996write_spr(int n, unsigned long val)
1997{
1998 if (xmon_is_ro) {
1999 printf(xmon_ro_msg);
2000 return;
2001 }
2002
2003 if (setjmp(bus_error_jmp) == 0) {
2004 catch_spr_faults = 1;
2005 sync();
2006
2007 xmon_mtspr(n, val);
2008
2009 sync();
2010 } else {
2011 printf("SPR 0x%03x (%4d) Faulted during write\n", n, n);
2012 }
2013 catch_spr_faults = 0;
2014}
2015
2016static void dump_206_sprs(void)
2017{
2018#ifdef CONFIG_PPC64
2019 if (!cpu_has_feature(CPU_FTR_ARCH_206))
2020 return;
2021
2022 /* Actually some of these pre-date 2.06, but whatever */
2023
2024 printf("srr0 = %.16lx srr1 = %.16lx dsisr = %.8lx\n",
2025 mfspr(SPRN_SRR0), mfspr(SPRN_SRR1), mfspr(SPRN_DSISR));
2026 printf("dscr = %.16lx ppr = %.16lx pir = %.8lx\n",
2027 mfspr(SPRN_DSCR), mfspr(SPRN_PPR), mfspr(SPRN_PIR));
2028 printf("amr = %.16lx uamor = %.16lx\n",
2029 mfspr(SPRN_AMR), mfspr(SPRN_UAMOR));
2030
2031 if (!(mfmsr() & MSR_HV))
2032 return;
2033
2034 printf("sdr1 = %.16lx hdar = %.16lx hdsisr = %.8lx\n",
2035 mfspr(SPRN_SDR1), mfspr(SPRN_HDAR), mfspr(SPRN_HDSISR));
2036 printf("hsrr0 = %.16lx hsrr1 = %.16lx hdec = %.16lx\n",
2037 mfspr(SPRN_HSRR0), mfspr(SPRN_HSRR1), mfspr(SPRN_HDEC));
2038 printf("lpcr = %.16lx pcr = %.16lx lpidr = %.8lx\n",
2039 mfspr(SPRN_LPCR), mfspr(SPRN_PCR), mfspr(SPRN_LPID));
2040 printf("hsprg0 = %.16lx hsprg1 = %.16lx amor = %.16lx\n",
2041 mfspr(SPRN_HSPRG0), mfspr(SPRN_HSPRG1), mfspr(SPRN_AMOR));
2042 printf("dabr = %.16lx dabrx = %.16lx\n",
2043 mfspr(SPRN_DABR), mfspr(SPRN_DABRX));
2044#endif
2045}
2046
2047static void dump_207_sprs(void)
2048{
2049#ifdef CONFIG_PPC64
2050 unsigned long msr;
2051
2052 if (!cpu_has_feature(CPU_FTR_ARCH_207S))
2053 return;
2054
2055 printf("dpdes = %.16lx tir = %.16lx cir = %.8lx\n",
2056 mfspr(SPRN_DPDES), mfspr(SPRN_TIR), mfspr(SPRN_CIR));
2057
2058 printf("fscr = %.16lx tar = %.16lx pspb = %.8lx\n",
2059 mfspr(SPRN_FSCR), mfspr(SPRN_TAR), mfspr(SPRN_PSPB));
2060
2061 msr = mfmsr();
2062 if (msr & MSR_TM) {
2063 /* Only if TM has been enabled in the kernel */
2064 printf("tfhar = %.16lx tfiar = %.16lx texasr = %.16lx\n",
2065 mfspr(SPRN_TFHAR), mfspr(SPRN_TFIAR),
2066 mfspr(SPRN_TEXASR));
2067 }
2068
2069 printf("mmcr0 = %.16lx mmcr1 = %.16lx mmcr2 = %.16lx\n",
2070 mfspr(SPRN_MMCR0), mfspr(SPRN_MMCR1), mfspr(SPRN_MMCR2));
2071 printf("pmc1 = %.8lx pmc2 = %.8lx pmc3 = %.8lx pmc4 = %.8lx\n",
2072 mfspr(SPRN_PMC1), mfspr(SPRN_PMC2),
2073 mfspr(SPRN_PMC3), mfspr(SPRN_PMC4));
2074 printf("mmcra = %.16lx siar = %.16lx pmc5 = %.8lx\n",
2075 mfspr(SPRN_MMCRA), mfspr(SPRN_SIAR), mfspr(SPRN_PMC5));
2076 printf("sdar = %.16lx sier = %.16lx pmc6 = %.8lx\n",
2077 mfspr(SPRN_SDAR), mfspr(SPRN_SIER), mfspr(SPRN_PMC6));
2078 printf("ebbhr = %.16lx ebbrr = %.16lx bescr = %.16lx\n",
2079 mfspr(SPRN_EBBHR), mfspr(SPRN_EBBRR), mfspr(SPRN_BESCR));
2080 printf("iamr = %.16lx\n", mfspr(SPRN_IAMR));
2081
2082 if (!(msr & MSR_HV))
2083 return;
2084
2085 printf("hfscr = %.16lx dhdes = %.16lx rpr = %.16lx\n",
2086 mfspr(SPRN_HFSCR), mfspr(SPRN_DHDES), mfspr(SPRN_RPR));
2087 printf("dawr0 = %.16lx dawrx0 = %.16lx\n",
2088 mfspr(SPRN_DAWR0), mfspr(SPRN_DAWRX0));
2089 if (nr_wp_slots() > 1) {
2090 printf("dawr1 = %.16lx dawrx1 = %.16lx\n",
2091 mfspr(SPRN_DAWR1), mfspr(SPRN_DAWRX1));
2092 }
2093 printf("ciabr = %.16lx\n", mfspr(SPRN_CIABR));
2094#endif
2095}
2096
2097static void dump_300_sprs(void)
2098{
2099#ifdef CONFIG_PPC64
2100 bool hv = mfmsr() & MSR_HV;
2101
2102 if (!cpu_has_feature(CPU_FTR_ARCH_300))
2103 return;
2104
2105 if (cpu_has_feature(CPU_FTR_P9_TIDR)) {
2106 printf("pidr = %.16lx tidr = %.16lx\n",
2107 mfspr(SPRN_PID), mfspr(SPRN_TIDR));
2108 } else {
2109 printf("pidr = %.16lx\n",
2110 mfspr(SPRN_PID));
2111 }
2112
2113 printf("psscr = %.16lx\n",
2114 hv ? mfspr(SPRN_PSSCR) : mfspr(SPRN_PSSCR_PR));
2115
2116 if (!hv)
2117 return;
2118
2119 printf("ptcr = %.16lx asdr = %.16lx\n",
2120 mfspr(SPRN_PTCR), mfspr(SPRN_ASDR));
2121#endif
2122}
2123
2124static void dump_310_sprs(void)
2125{
2126#ifdef CONFIG_PPC64
2127 if (!cpu_has_feature(CPU_FTR_ARCH_31))
2128 return;
2129
2130 printf("mmcr3 = %.16lx, sier2 = %.16lx, sier3 = %.16lx\n",
2131 mfspr(SPRN_MMCR3), mfspr(SPRN_SIER2), mfspr(SPRN_SIER3));
2132
2133#endif
2134}
2135
2136static void dump_one_spr(int spr, bool show_unimplemented)
2137{
2138 unsigned long val;
2139
2140 val = 0xdeadbeef;
2141 if (!read_spr(spr, &val)) {
2142 printf("SPR 0x%03x (%4d) Faulted during read\n", spr, spr);
2143 return;
2144 }
2145
2146 if (val == 0xdeadbeef) {
2147 /* Looks like read was a nop, confirm */
2148 val = 0x0badcafe;
2149 if (!read_spr(spr, &val)) {
2150 printf("SPR 0x%03x (%4d) Faulted during read\n", spr, spr);
2151 return;
2152 }
2153
2154 if (val == 0x0badcafe) {
2155 if (show_unimplemented)
2156 printf("SPR 0x%03x (%4d) Unimplemented\n", spr, spr);
2157 return;
2158 }
2159 }
2160
2161 printf("SPR 0x%03x (%4d) = 0x%lx\n", spr, spr, val);
2162}
2163
2164static void super_regs(void)
2165{
2166 static unsigned long regno;
2167 int cmd;
2168 int spr;
2169
2170 cmd = skipbl();
2171
2172 switch (cmd) {
2173 case '\n': {
2174 unsigned long sp, toc;
2175 asm("mr %0,1" : "=r" (sp) :);
2176 asm("mr %0,2" : "=r" (toc) :);
2177
2178 printf("msr = "REG" sprg0 = "REG"\n",
2179 mfmsr(), mfspr(SPRN_SPRG0));
2180 printf("pvr = "REG" sprg1 = "REG"\n",
2181 mfspr(SPRN_PVR), mfspr(SPRN_SPRG1));
2182 printf("dec = "REG" sprg2 = "REG"\n",
2183 mfspr(SPRN_DEC), mfspr(SPRN_SPRG2));
2184 printf("sp = "REG" sprg3 = "REG"\n", sp, mfspr(SPRN_SPRG3));
2185 printf("toc = "REG" dar = "REG"\n", toc, mfspr(SPRN_DAR));
2186
2187 dump_206_sprs();
2188 dump_207_sprs();
2189 dump_300_sprs();
2190 dump_310_sprs();
2191
2192 return;
2193 }
2194 case 'w': {
2195 unsigned long val;
2196 scanhex(®no);
2197 val = 0;
2198 read_spr(regno, &val);
2199 scanhex(&val);
2200 write_spr(regno, val);
2201 dump_one_spr(regno, true);
2202 break;
2203 }
2204 case 'r':
2205 scanhex(®no);
2206 dump_one_spr(regno, true);
2207 break;
2208 case 'a':
2209 /* dump ALL SPRs */
2210 for (spr = 1; spr < 1024; ++spr)
2211 dump_one_spr(spr, false);
2212 break;
2213 }
2214
2215 scannl();
2216}
2217
2218/*
2219 * Stuff for reading and writing memory safely
2220 */
2221static int
2222mread(unsigned long adrs, void *buf, int size)
2223{
2224 volatile int n;
2225 char *p, *q;
2226
2227 n = 0;
2228 if (setjmp(bus_error_jmp) == 0) {
2229 catch_memory_errors = 1;
2230 sync();
2231 p = (char *)adrs;
2232 q = (char *)buf;
2233 switch (size) {
2234 case 2:
2235 *(u16 *)q = *(u16 *)p;
2236 break;
2237 case 4:
2238 *(u32 *)q = *(u32 *)p;
2239 break;
2240 case 8:
2241 *(u64 *)q = *(u64 *)p;
2242 break;
2243 default:
2244 for( ; n < size; ++n) {
2245 *q++ = *p++;
2246 sync();
2247 }
2248 }
2249 sync();
2250 /* wait a little while to see if we get a machine check */
2251 __delay(200);
2252 n = size;
2253 }
2254 catch_memory_errors = 0;
2255 return n;
2256}
2257
2258static int
2259mwrite(unsigned long adrs, void *buf, int size)
2260{
2261 volatile int n;
2262 char *p, *q;
2263
2264 n = 0;
2265
2266 if (xmon_is_ro) {
2267 printf(xmon_ro_msg);
2268 return n;
2269 }
2270
2271 if (setjmp(bus_error_jmp) == 0) {
2272 catch_memory_errors = 1;
2273 sync();
2274 p = (char *) adrs;
2275 q = (char *) buf;
2276 switch (size) {
2277 case 2:
2278 *(u16 *)p = *(u16 *)q;
2279 break;
2280 case 4:
2281 *(u32 *)p = *(u32 *)q;
2282 break;
2283 case 8:
2284 *(u64 *)p = *(u64 *)q;
2285 break;
2286 default:
2287 for ( ; n < size; ++n) {
2288 *p++ = *q++;
2289 sync();
2290 }
2291 }
2292 sync();
2293 /* wait a little while to see if we get a machine check */
2294 __delay(200);
2295 n = size;
2296 } else {
2297 printf("*** Error writing address "REG"\n", adrs + n);
2298 }
2299 catch_memory_errors = 0;
2300 return n;
2301}
2302
2303static int
2304mread_instr(unsigned long adrs, ppc_inst_t *instr)
2305{
2306 volatile int n;
2307
2308 n = 0;
2309 if (setjmp(bus_error_jmp) == 0) {
2310 catch_memory_errors = 1;
2311 sync();
2312 *instr = ppc_inst_read((u32 *)adrs);
2313 sync();
2314 /* wait a little while to see if we get a machine check */
2315 __delay(200);
2316 n = ppc_inst_len(*instr);
2317 }
2318 catch_memory_errors = 0;
2319 return n;
2320}
2321
2322static int fault_type;
2323static int fault_except;
2324static char *fault_chars[] = { "--", "**", "##" };
2325
2326static int handle_fault(struct pt_regs *regs)
2327{
2328 fault_except = TRAP(regs);
2329 switch (TRAP(regs)) {
2330 case 0x200:
2331 fault_type = 0;
2332 break;
2333 case 0x300:
2334 case 0x380:
2335 fault_type = 1;
2336 break;
2337 default:
2338 fault_type = 2;
2339 }
2340
2341 longjmp(bus_error_jmp, 1);
2342
2343 return 0;
2344}
2345
2346#define SWAP(a, b, t) ((t) = (a), (a) = (b), (b) = (t))
2347
2348static void
2349byterev(unsigned char *val, int size)
2350{
2351 int t;
2352
2353 switch (size) {
2354 case 2:
2355 SWAP(val[0], val[1], t);
2356 break;
2357 case 4:
2358 SWAP(val[0], val[3], t);
2359 SWAP(val[1], val[2], t);
2360 break;
2361 case 8: /* is there really any use for this? */
2362 SWAP(val[0], val[7], t);
2363 SWAP(val[1], val[6], t);
2364 SWAP(val[2], val[5], t);
2365 SWAP(val[3], val[4], t);
2366 break;
2367 }
2368}
2369
2370static int brev;
2371static int mnoread;
2372
2373static char *memex_help_string =
2374 "Memory examine command usage:\n"
2375 "m [addr] [flags] examine/change memory\n"
2376 " addr is optional. will start where left off.\n"
2377 " flags may include chars from this set:\n"
2378 " b modify by bytes (default)\n"
2379 " w modify by words (2 byte)\n"
2380 " l modify by longs (4 byte)\n"
2381 " d modify by doubleword (8 byte)\n"
2382 " r toggle reverse byte order mode\n"
2383 " n do not read memory (for i/o spaces)\n"
2384 " . ok to read (default)\n"
2385 "NOTE: flags are saved as defaults\n"
2386 "";
2387
2388static char *memex_subcmd_help_string =
2389 "Memory examine subcommands:\n"
2390 " hexval write this val to current location\n"
2391 " 'string' write chars from string to this location\n"
2392 " ' increment address\n"
2393 " ^ decrement address\n"
2394 " / increment addr by 0x10. //=0x100, ///=0x1000, etc\n"
2395 " \\ decrement addr by 0x10. \\\\=0x100, \\\\\\=0x1000, etc\n"
2396 " ` clear no-read flag\n"
2397 " ; stay at this addr\n"
2398 " v change to byte mode\n"
2399 " w change to word (2 byte) mode\n"
2400 " l change to long (4 byte) mode\n"
2401 " u change to doubleword (8 byte) mode\n"
2402 " m addr change current addr\n"
2403 " n toggle no-read flag\n"
2404 " r toggle byte reverse flag\n"
2405 " < count back up count bytes\n"
2406 " > count skip forward count bytes\n"
2407 " x exit this mode\n"
2408 "";
2409
2410static void
2411memex(void)
2412{
2413 int cmd, inc, i, nslash;
2414 unsigned long n;
2415 unsigned char val[16];
2416
2417 scanhex((void *)&adrs);
2418 cmd = skipbl();
2419 if (cmd == '?') {
2420 printf(memex_help_string);
2421 return;
2422 } else {
2423 termch = cmd;
2424 }
2425 last_cmd = "m\n";
2426 while ((cmd = skipbl()) != '\n') {
2427 switch( cmd ){
2428 case 'b': size = 1; break;
2429 case 'w': size = 2; break;
2430 case 'l': size = 4; break;
2431 case 'd': size = 8; break;
2432 case 'r': brev = !brev; break;
2433 case 'n': mnoread = 1; break;
2434 case '.': mnoread = 0; break;
2435 }
2436 }
2437 if( size <= 0 )
2438 size = 1;
2439 else if( size > 8 )
2440 size = 8;
2441 for(;;){
2442 if (!mnoread)
2443 n = mread(adrs, val, size);
2444 printf(REG"%c", adrs, brev? 'r': ' ');
2445 if (!mnoread) {
2446 if (brev)
2447 byterev(val, size);
2448 putchar(' ');
2449 for (i = 0; i < n; ++i)
2450 printf("%.2x", val[i]);
2451 for (; i < size; ++i)
2452 printf("%s", fault_chars[fault_type]);
2453 }
2454 putchar(' ');
2455 inc = size;
2456 nslash = 0;
2457 for(;;){
2458 if( scanhex(&n) ){
2459 for (i = 0; i < size; ++i)
2460 val[i] = n >> (i * 8);
2461 if (!brev)
2462 byterev(val, size);
2463 mwrite(adrs, val, size);
2464 inc = size;
2465 }
2466 cmd = skipbl();
2467 if (cmd == '\n')
2468 break;
2469 inc = 0;
2470 switch (cmd) {
2471 case '\'':
2472 for(;;){
2473 n = inchar();
2474 if( n == '\\' )
2475 n = bsesc();
2476 else if( n == '\'' )
2477 break;
2478 for (i = 0; i < size; ++i)
2479 val[i] = n >> (i * 8);
2480 if (!brev)
2481 byterev(val, size);
2482 mwrite(adrs, val, size);
2483 adrs += size;
2484 }
2485 adrs -= size;
2486 inc = size;
2487 break;
2488 case ',':
2489 adrs += size;
2490 break;
2491 case '.':
2492 mnoread = 0;
2493 break;
2494 case ';':
2495 break;
2496 case 'x':
2497 case EOF:
2498 scannl();
2499 return;
2500 case 'b':
2501 case 'v':
2502 size = 1;
2503 break;
2504 case 'w':
2505 size = 2;
2506 break;
2507 case 'l':
2508 size = 4;
2509 break;
2510 case 'u':
2511 size = 8;
2512 break;
2513 case '^':
2514 adrs -= size;
2515 break;
2516 case '/':
2517 if (nslash > 0)
2518 adrs -= 1 << nslash;
2519 else
2520 nslash = 0;
2521 nslash += 4;
2522 adrs += 1 << nslash;
2523 break;
2524 case '\\':
2525 if (nslash < 0)
2526 adrs += 1 << -nslash;
2527 else
2528 nslash = 0;
2529 nslash -= 4;
2530 adrs -= 1 << -nslash;
2531 break;
2532 case 'm':
2533 scanhex((void *)&adrs);
2534 break;
2535 case 'n':
2536 mnoread = 1;
2537 break;
2538 case 'r':
2539 brev = !brev;
2540 break;
2541 case '<':
2542 n = size;
2543 scanhex(&n);
2544 adrs -= n;
2545 break;
2546 case '>':
2547 n = size;
2548 scanhex(&n);
2549 adrs += n;
2550 break;
2551 case '?':
2552 printf(memex_subcmd_help_string);
2553 break;
2554 }
2555 }
2556 adrs += inc;
2557 }
2558}
2559
2560static int
2561bsesc(void)
2562{
2563 int c;
2564
2565 c = inchar();
2566 switch( c ){
2567 case 'n': c = '\n'; break;
2568 case 'r': c = '\r'; break;
2569 case 'b': c = '\b'; break;
2570 case 't': c = '\t'; break;
2571 }
2572 return c;
2573}
2574
2575static void xmon_rawdump (unsigned long adrs, long ndump)
2576{
2577 long n, m, r, nr;
2578 unsigned char temp[16];
2579
2580 for (n = ndump; n > 0;) {
2581 r = n < 16? n: 16;
2582 nr = mread(adrs, temp, r);
2583 adrs += nr;
2584 for (m = 0; m < r; ++m) {
2585 if (m < nr)
2586 printf("%.2x", temp[m]);
2587 else
2588 printf("%s", fault_chars[fault_type]);
2589 }
2590 n -= r;
2591 if (nr < r)
2592 break;
2593 }
2594 printf("\n");
2595}
2596
2597static void dump_tracing(void)
2598{
2599 int c;
2600
2601 c = inchar();
2602 if (c == 'c')
2603 ftrace_dump(DUMP_ORIG);
2604 else
2605 ftrace_dump(DUMP_ALL);
2606}
2607
2608#ifdef CONFIG_PPC64
2609static void dump_one_paca(int cpu)
2610{
2611 struct paca_struct *p;
2612#ifdef CONFIG_PPC_64S_HASH_MMU
2613 int i = 0;
2614#endif
2615
2616 if (setjmp(bus_error_jmp) != 0) {
2617 printf("*** Error dumping paca for cpu 0x%x!\n", cpu);
2618 return;
2619 }
2620
2621 catch_memory_errors = 1;
2622 sync();
2623
2624 p = paca_ptrs[cpu];
2625
2626 printf("paca for cpu 0x%x @ %px:\n", cpu, p);
2627
2628 printf(" %-*s = %s\n", 25, "possible", cpu_possible(cpu) ? "yes" : "no");
2629 printf(" %-*s = %s\n", 25, "present", cpu_present(cpu) ? "yes" : "no");
2630 printf(" %-*s = %s\n", 25, "online", cpu_online(cpu) ? "yes" : "no");
2631
2632#define DUMP(paca, name, format) \
2633 printf(" %-*s = "format"\t(0x%lx)\n", 25, #name, 18, paca->name, \
2634 offsetof(struct paca_struct, name));
2635
2636 DUMP(p, lock_token, "%#-*x");
2637 DUMP(p, paca_index, "%#-*x");
2638#ifndef CONFIG_PPC_KERNEL_PCREL
2639 DUMP(p, kernel_toc, "%#-*llx");
2640#endif
2641 DUMP(p, kernelbase, "%#-*llx");
2642 DUMP(p, kernel_msr, "%#-*llx");
2643 DUMP(p, emergency_sp, "%-*px");
2644#ifdef CONFIG_PPC_BOOK3S_64
2645 DUMP(p, nmi_emergency_sp, "%-*px");
2646 DUMP(p, mc_emergency_sp, "%-*px");
2647 DUMP(p, in_nmi, "%#-*x");
2648 DUMP(p, in_mce, "%#-*x");
2649 DUMP(p, hmi_event_available, "%#-*x");
2650#endif
2651 DUMP(p, data_offset, "%#-*llx");
2652 DUMP(p, hw_cpu_id, "%#-*x");
2653 DUMP(p, cpu_start, "%#-*x");
2654 DUMP(p, kexec_state, "%#-*x");
2655#ifdef CONFIG_PPC_BOOK3S_64
2656#ifdef CONFIG_PPC_64S_HASH_MMU
2657 if (!early_radix_enabled()) {
2658 for (i = 0; i < SLB_NUM_BOLTED; i++) {
2659 u64 esid, vsid;
2660
2661 if (!p->slb_shadow_ptr)
2662 continue;
2663
2664 esid = be64_to_cpu(p->slb_shadow_ptr->save_area[i].esid);
2665 vsid = be64_to_cpu(p->slb_shadow_ptr->save_area[i].vsid);
2666
2667 if (esid || vsid) {
2668 printf(" %-*s[%d] = 0x%016llx 0x%016llx\n",
2669 22, "slb_shadow", i, esid, vsid);
2670 }
2671 }
2672 DUMP(p, vmalloc_sllp, "%#-*x");
2673 DUMP(p, stab_rr, "%#-*x");
2674 DUMP(p, slb_used_bitmap, "%#-*x");
2675 DUMP(p, slb_kern_bitmap, "%#-*x");
2676
2677 if (!early_cpu_has_feature(CPU_FTR_ARCH_300)) {
2678 DUMP(p, slb_cache_ptr, "%#-*x");
2679 for (i = 0; i < SLB_CACHE_ENTRIES; i++)
2680 printf(" %-*s[%d] = 0x%016x\n",
2681 22, "slb_cache", i, p->slb_cache[i]);
2682 }
2683 }
2684#endif
2685
2686 DUMP(p, rfi_flush_fallback_area, "%-*px");
2687#endif
2688 DUMP(p, dscr_default, "%#-*llx");
2689#ifdef CONFIG_PPC_BOOK3E_64
2690 DUMP(p, pgd, "%-*px");
2691 DUMP(p, kernel_pgd, "%-*px");
2692 DUMP(p, tcd_ptr, "%-*px");
2693 DUMP(p, mc_kstack, "%-*px");
2694 DUMP(p, crit_kstack, "%-*px");
2695 DUMP(p, dbg_kstack, "%-*px");
2696#endif
2697 DUMP(p, __current, "%-*px");
2698 DUMP(p, kstack, "%#-*llx");
2699 printf(" %-*s = 0x%016llx\n", 25, "kstack_base", p->kstack & ~(THREAD_SIZE - 1));
2700#ifdef CONFIG_STACKPROTECTOR
2701 DUMP(p, canary, "%#-*lx");
2702#endif
2703 DUMP(p, saved_r1, "%#-*llx");
2704#ifdef CONFIG_PPC_BOOK3E_64
2705 DUMP(p, trap_save, "%#-*x");
2706#endif
2707 DUMP(p, irq_soft_mask, "%#-*x");
2708 DUMP(p, irq_happened, "%#-*x");
2709#ifdef CONFIG_MMIOWB
2710 DUMP(p, mmiowb_state.nesting_count, "%#-*x");
2711 DUMP(p, mmiowb_state.mmiowb_pending, "%#-*x");
2712#endif
2713 DUMP(p, irq_work_pending, "%#-*x");
2714 DUMP(p, sprg_vdso, "%#-*llx");
2715
2716#ifdef CONFIG_PPC_TRANSACTIONAL_MEM
2717 DUMP(p, tm_scratch, "%#-*llx");
2718#endif
2719
2720#ifdef CONFIG_PPC_POWERNV
2721 DUMP(p, idle_state, "%#-*lx");
2722 if (!early_cpu_has_feature(CPU_FTR_ARCH_300)) {
2723 DUMP(p, thread_idle_state, "%#-*x");
2724 DUMP(p, subcore_sibling_mask, "%#-*x");
2725 } else {
2726#ifdef CONFIG_KVM_BOOK3S_HV_POSSIBLE
2727 DUMP(p, requested_psscr, "%#-*llx");
2728 DUMP(p, dont_stop.counter, "%#-*x");
2729#endif
2730 }
2731#endif
2732
2733 DUMP(p, accounting.utime, "%#-*lx");
2734 DUMP(p, accounting.stime, "%#-*lx");
2735#ifdef CONFIG_ARCH_HAS_SCALED_CPUTIME
2736 DUMP(p, accounting.utime_scaled, "%#-*lx");
2737#endif
2738 DUMP(p, accounting.starttime, "%#-*lx");
2739 DUMP(p, accounting.starttime_user, "%#-*lx");
2740#ifdef CONFIG_ARCH_HAS_SCALED_CPUTIME
2741 DUMP(p, accounting.startspurr, "%#-*lx");
2742 DUMP(p, accounting.utime_sspurr, "%#-*lx");
2743#endif
2744 DUMP(p, accounting.steal_time, "%#-*lx");
2745#undef DUMP
2746
2747 catch_memory_errors = 0;
2748 sync();
2749}
2750
2751static void dump_all_pacas(void)
2752{
2753 int cpu;
2754
2755 if (num_possible_cpus() == 0) {
2756 printf("No possible cpus, use 'dp #' to dump individual cpus\n");
2757 return;
2758 }
2759
2760 for_each_possible_cpu(cpu)
2761 dump_one_paca(cpu);
2762}
2763
2764static void dump_pacas(void)
2765{
2766 unsigned long num;
2767 int c;
2768
2769 c = inchar();
2770 if (c == 'a') {
2771 dump_all_pacas();
2772 return;
2773 }
2774
2775 termch = c; /* Put c back, it wasn't 'a' */
2776
2777 if (scanhex(&num))
2778 dump_one_paca(num);
2779 else
2780 dump_one_paca(xmon_owner);
2781}
2782#endif
2783
2784#ifdef CONFIG_PPC_POWERNV
2785static void dump_one_xive(int cpu)
2786{
2787 unsigned int hwid = get_hard_smp_processor_id(cpu);
2788 bool hv = cpu_has_feature(CPU_FTR_HVMODE);
2789
2790 if (hv) {
2791 opal_xive_dump(XIVE_DUMP_TM_HYP, hwid);
2792 opal_xive_dump(XIVE_DUMP_TM_POOL, hwid);
2793 opal_xive_dump(XIVE_DUMP_TM_OS, hwid);
2794 opal_xive_dump(XIVE_DUMP_TM_USER, hwid);
2795 opal_xive_dump(XIVE_DUMP_VP, hwid);
2796 opal_xive_dump(XIVE_DUMP_EMU_STATE, hwid);
2797 }
2798
2799 if (setjmp(bus_error_jmp) != 0) {
2800 catch_memory_errors = 0;
2801 printf("*** Error dumping xive on cpu %d\n", cpu);
2802 return;
2803 }
2804
2805 catch_memory_errors = 1;
2806 sync();
2807 xmon_xive_do_dump(cpu);
2808 sync();
2809 __delay(200);
2810 catch_memory_errors = 0;
2811}
2812
2813static void dump_all_xives(void)
2814{
2815 int cpu;
2816
2817 if (num_online_cpus() == 0) {
2818 printf("No possible cpus, use 'dx #' to dump individual cpus\n");
2819 return;
2820 }
2821
2822 for_each_online_cpu(cpu)
2823 dump_one_xive(cpu);
2824}
2825
2826static void dump_xives(void)
2827{
2828 unsigned long num;
2829 int c;
2830
2831 if (!xive_enabled()) {
2832 printf("Xive disabled on this system\n");
2833 return;
2834 }
2835
2836 c = inchar();
2837 if (c == 'a') {
2838 dump_all_xives();
2839 return;
2840 } else if (c == 'i') {
2841 if (scanhex(&num))
2842 xmon_xive_get_irq_config(num, NULL);
2843 else
2844 xmon_xive_get_irq_all();
2845 return;
2846 }
2847
2848 termch = c; /* Put c back, it wasn't 'a' */
2849
2850 if (scanhex(&num))
2851 dump_one_xive(num);
2852 else
2853 dump_one_xive(xmon_owner);
2854}
2855#endif /* CONFIG_PPC_POWERNV */
2856
2857static void dump_by_size(unsigned long addr, long count, int size)
2858{
2859 unsigned char temp[16];
2860 int i, j;
2861 u64 val;
2862
2863 count = ALIGN(count, 16);
2864
2865 for (i = 0; i < count; i += 16, addr += 16) {
2866 printf(REG, addr);
2867
2868 if (mread(addr, temp, 16) != 16) {
2869 printf("\nFaulted reading %d bytes from 0x"REG"\n", 16, addr);
2870 return;
2871 }
2872
2873 for (j = 0; j < 16; j += size) {
2874 putchar(' ');
2875 switch (size) {
2876 case 1: val = temp[j]; break;
2877 case 2: val = *(u16 *)&temp[j]; break;
2878 case 4: val = *(u32 *)&temp[j]; break;
2879 case 8: val = *(u64 *)&temp[j]; break;
2880 default: val = 0;
2881 }
2882
2883 printf("%0*llx", size * 2, val);
2884 }
2885 printf(" |");
2886 for (j = 0; j < 16; ++j) {
2887 val = temp[j];
2888 putchar(' ' <= val && val <= '~' ? val : '.');
2889 }
2890 printf("|\n");
2891 }
2892}
2893
2894static void
2895dump(void)
2896{
2897 static char last[] = { "d?\n" };
2898 int c;
2899
2900 c = inchar();
2901
2902#ifdef CONFIG_PPC64
2903 if (c == 'p') {
2904 xmon_start_pagination();
2905 dump_pacas();
2906 xmon_end_pagination();
2907 return;
2908 }
2909#endif
2910#ifdef CONFIG_PPC_POWERNV
2911 if (c == 'x') {
2912 xmon_start_pagination();
2913 dump_xives();
2914 xmon_end_pagination();
2915 return;
2916 }
2917#endif
2918
2919 if (c == 't') {
2920 dump_tracing();
2921 return;
2922 }
2923
2924 if (c == '\n')
2925 termch = c;
2926
2927 scanhex((void *)&adrs);
2928 if (termch != '\n')
2929 termch = 0;
2930 if (c == 'i') {
2931 scanhex(&nidump);
2932 if (nidump == 0)
2933 nidump = 16;
2934 else if (nidump > MAX_IDUMP)
2935 nidump = MAX_IDUMP;
2936 adrs += ppc_inst_dump(adrs, nidump, 1);
2937 last_cmd = "di\n";
2938 } else if (c == 'l') {
2939 dump_log_buf();
2940 } else if (c == 'o') {
2941 dump_opal_msglog();
2942 } else if (c == 'v') {
2943 /* dump virtual to physical translation */
2944 show_pte(adrs);
2945 } else if (c == 'r') {
2946 scanhex(&ndump);
2947 if (ndump == 0)
2948 ndump = 64;
2949 xmon_rawdump(adrs, ndump);
2950 adrs += ndump;
2951 last_cmd = "dr\n";
2952 } else {
2953 scanhex(&ndump);
2954 if (ndump == 0)
2955 ndump = 64;
2956 else if (ndump > MAX_DUMP)
2957 ndump = MAX_DUMP;
2958
2959 switch (c) {
2960 case '8':
2961 case '4':
2962 case '2':
2963 case '1':
2964 ndump = ALIGN(ndump, 16);
2965 dump_by_size(adrs, ndump, c - '0');
2966 last[1] = c;
2967 last_cmd = last;
2968 break;
2969 default:
2970 prdump(adrs, ndump);
2971 last_cmd = "d\n";
2972 }
2973
2974 adrs += ndump;
2975 }
2976}
2977
2978static void
2979prdump(unsigned long adrs, long ndump)
2980{
2981 long n, m, c, r, nr;
2982 unsigned char temp[16];
2983
2984 for (n = ndump; n > 0;) {
2985 printf(REG, adrs);
2986 putchar(' ');
2987 r = n < 16? n: 16;
2988 nr = mread(adrs, temp, r);
2989 adrs += nr;
2990 for (m = 0; m < r; ++m) {
2991 if ((m & (sizeof(long) - 1)) == 0 && m > 0)
2992 putchar(' ');
2993 if (m < nr)
2994 printf("%.2x", temp[m]);
2995 else
2996 printf("%s", fault_chars[fault_type]);
2997 }
2998 for (; m < 16; ++m) {
2999 if ((m & (sizeof(long) - 1)) == 0)
3000 putchar(' ');
3001 printf(" ");
3002 }
3003 printf(" |");
3004 for (m = 0; m < r; ++m) {
3005 if (m < nr) {
3006 c = temp[m];
3007 putchar(' ' <= c && c <= '~'? c: '.');
3008 } else
3009 putchar(' ');
3010 }
3011 n -= r;
3012 for (; m < 16; ++m)
3013 putchar(' ');
3014 printf("|\n");
3015 if (nr < r)
3016 break;
3017 }
3018}
3019
3020typedef int (*instruction_dump_func)(unsigned long inst, unsigned long addr);
3021
3022static int
3023generic_inst_dump(unsigned long adr, long count, int praddr,
3024 instruction_dump_func dump_func)
3025{
3026 int nr, dotted;
3027 unsigned long first_adr;
3028 ppc_inst_t inst, last_inst = ppc_inst(0);
3029
3030 dotted = 0;
3031 for (first_adr = adr; count > 0; --count, adr += ppc_inst_len(inst)) {
3032 nr = mread_instr(adr, &inst);
3033 if (nr == 0) {
3034 if (praddr) {
3035 const char *x = fault_chars[fault_type];
3036 printf(REG" %s%s%s%s\n", adr, x, x, x, x);
3037 }
3038 break;
3039 }
3040 if (adr > first_adr && ppc_inst_equal(inst, last_inst)) {
3041 if (!dotted) {
3042 printf(" ...\n");
3043 dotted = 1;
3044 }
3045 continue;
3046 }
3047 dotted = 0;
3048 last_inst = inst;
3049 if (praddr)
3050 printf(REG" %08lx", adr, ppc_inst_as_ulong(inst));
3051 printf("\t");
3052 if (!ppc_inst_prefixed(inst))
3053 dump_func(ppc_inst_val(inst), adr);
3054 else
3055 dump_func(ppc_inst_as_ulong(inst), adr);
3056 printf("\n");
3057 }
3058 return adr - first_adr;
3059}
3060
3061static int
3062ppc_inst_dump(unsigned long adr, long count, int praddr)
3063{
3064 return generic_inst_dump(adr, count, praddr, print_insn_powerpc);
3065}
3066
3067void
3068print_address(unsigned long addr)
3069{
3070 xmon_print_symbol(addr, "\t# ", "");
3071}
3072
3073static void
3074dump_log_buf(void)
3075{
3076 struct kmsg_dump_iter iter;
3077 static unsigned char buf[1024];
3078 size_t len;
3079
3080 if (setjmp(bus_error_jmp) != 0) {
3081 printf("Error dumping printk buffer!\n");
3082 return;
3083 }
3084
3085 catch_memory_errors = 1;
3086 sync();
3087
3088 kmsg_dump_rewind(&iter);
3089 xmon_start_pagination();
3090 while (kmsg_dump_get_line(&iter, false, buf, sizeof(buf), &len)) {
3091 buf[len] = '\0';
3092 printf("%s", buf);
3093 }
3094 xmon_end_pagination();
3095
3096 sync();
3097 /* wait a little while to see if we get a machine check */
3098 __delay(200);
3099 catch_memory_errors = 0;
3100}
3101
3102#ifdef CONFIG_PPC_POWERNV
3103static void dump_opal_msglog(void)
3104{
3105 unsigned char buf[128];
3106 ssize_t res;
3107 volatile loff_t pos = 0;
3108
3109 if (!firmware_has_feature(FW_FEATURE_OPAL)) {
3110 printf("Machine is not running OPAL firmware.\n");
3111 return;
3112 }
3113
3114 if (setjmp(bus_error_jmp) != 0) {
3115 printf("Error dumping OPAL msglog!\n");
3116 return;
3117 }
3118
3119 catch_memory_errors = 1;
3120 sync();
3121
3122 xmon_start_pagination();
3123 while ((res = opal_msglog_copy(buf, pos, sizeof(buf) - 1))) {
3124 if (res < 0) {
3125 printf("Error dumping OPAL msglog! Error: %zd\n", res);
3126 break;
3127 }
3128 buf[res] = '\0';
3129 printf("%s", buf);
3130 pos += res;
3131 }
3132 xmon_end_pagination();
3133
3134 sync();
3135 /* wait a little while to see if we get a machine check */
3136 __delay(200);
3137 catch_memory_errors = 0;
3138}
3139#endif
3140
3141/*
3142 * Memory operations - move, set, print differences
3143 */
3144static unsigned long mdest; /* destination address */
3145static unsigned long msrc; /* source address */
3146static unsigned long mval; /* byte value to set memory to */
3147static unsigned long mcount; /* # bytes to affect */
3148static unsigned long mdiffs; /* max # differences to print */
3149
3150static void
3151memops(int cmd)
3152{
3153 scanhex((void *)&mdest);
3154 if( termch != '\n' )
3155 termch = 0;
3156 scanhex((void *)(cmd == 's'? &mval: &msrc));
3157 if( termch != '\n' )
3158 termch = 0;
3159 scanhex((void *)&mcount);
3160 switch( cmd ){
3161 case 'm':
3162 if (xmon_is_ro) {
3163 printf(xmon_ro_msg);
3164 break;
3165 }
3166 memmove((void *)mdest, (void *)msrc, mcount);
3167 break;
3168 case 's':
3169 if (xmon_is_ro) {
3170 printf(xmon_ro_msg);
3171 break;
3172 }
3173 memset((void *)mdest, mval, mcount);
3174 break;
3175 case 'd':
3176 if( termch != '\n' )
3177 termch = 0;
3178 scanhex((void *)&mdiffs);
3179 memdiffs((unsigned char *)mdest, (unsigned char *)msrc, mcount, mdiffs);
3180 break;
3181 }
3182}
3183
3184static void
3185memdiffs(unsigned char *p1, unsigned char *p2, unsigned nb, unsigned maxpr)
3186{
3187 unsigned n, prt;
3188
3189 prt = 0;
3190 for( n = nb; n > 0; --n )
3191 if( *p1++ != *p2++ )
3192 if( ++prt <= maxpr )
3193 printf("%px %.2x # %px %.2x\n", p1 - 1,
3194 p1[-1], p2 - 1, p2[-1]);
3195 if( prt > maxpr )
3196 printf("Total of %d differences\n", prt);
3197}
3198
3199static unsigned mend;
3200static unsigned mask;
3201
3202static void
3203memlocate(void)
3204{
3205 unsigned a, n;
3206 unsigned char val[4];
3207
3208 last_cmd = "ml";
3209 scanhex((void *)&mdest);
3210 if (termch != '\n') {
3211 termch = 0;
3212 scanhex((void *)&mend);
3213 if (termch != '\n') {
3214 termch = 0;
3215 scanhex((void *)&mval);
3216 mask = ~0;
3217 if (termch != '\n') termch = 0;
3218 scanhex((void *)&mask);
3219 }
3220 }
3221 n = 0;
3222 for (a = mdest; a < mend; a += 4) {
3223 if (mread(a, val, 4) == 4
3224 && ((GETWORD(val) ^ mval) & mask) == 0) {
3225 printf("%.16x: %.16x\n", a, GETWORD(val));
3226 if (++n >= 10)
3227 break;
3228 }
3229 }
3230}
3231
3232static unsigned long mskip = 0x1000;
3233static unsigned long mlim = 0xffffffff;
3234
3235static void
3236memzcan(void)
3237{
3238 unsigned char v;
3239 unsigned a;
3240 int ok, ook;
3241
3242 scanhex(&mdest);
3243 if (termch != '\n') termch = 0;
3244 scanhex(&mskip);
3245 if (termch != '\n') termch = 0;
3246 scanhex(&mlim);
3247 ook = 0;
3248 for (a = mdest; a < mlim; a += mskip) {
3249 ok = mread(a, &v, 1);
3250 if (ok && !ook) {
3251 printf("%.8x .. ", a);
3252 } else if (!ok && ook)
3253 printf("%.8lx\n", a - mskip);
3254 ook = ok;
3255 if (a + mskip < a)
3256 break;
3257 }
3258 if (ook)
3259 printf("%.8lx\n", a - mskip);
3260}
3261
3262static void show_task(struct task_struct *volatile tsk)
3263{
3264 unsigned int p_state = READ_ONCE(tsk->__state);
3265 char state;
3266
3267 /*
3268 * Cloned from kdb_task_state_char(), which is not entirely
3269 * appropriate for calling from xmon. This could be moved
3270 * to a common, generic, routine used by both.
3271 */
3272 state = (p_state == TASK_RUNNING) ? 'R' :
3273 (p_state & TASK_UNINTERRUPTIBLE) ? 'D' :
3274 (p_state & TASK_STOPPED) ? 'T' :
3275 (p_state & TASK_TRACED) ? 'C' :
3276 (tsk->exit_state & EXIT_ZOMBIE) ? 'Z' :
3277 (tsk->exit_state & EXIT_DEAD) ? 'E' :
3278 (p_state & TASK_INTERRUPTIBLE) ? 'S' : '?';
3279
3280 printf("%16px %16lx %16px %6d %6d %c %2d %s\n", tsk,
3281 tsk->thread.ksp, tsk->thread.regs,
3282 tsk->pid, rcu_dereference(tsk->parent)->pid,
3283 state, task_cpu(tsk),
3284 tsk->comm);
3285}
3286
3287#ifdef CONFIG_PPC_BOOK3S_64
3288static void format_pte(void *ptep, unsigned long pte)
3289{
3290 pte_t entry = __pte(pte);
3291
3292 printf("ptep @ 0x%016lx = 0x%016lx\n", (unsigned long)ptep, pte);
3293 printf("Maps physical address = 0x%016lx\n", pte & PTE_RPN_MASK);
3294
3295 printf("Flags = %s%s%s%s%s\n",
3296 pte_young(entry) ? "Accessed " : "",
3297 pte_dirty(entry) ? "Dirty " : "",
3298 pte_read(entry) ? "Read " : "",
3299 pte_write(entry) ? "Write " : "",
3300 pte_exec(entry) ? "Exec " : "");
3301}
3302
3303static void show_pte(unsigned long addr)
3304{
3305 unsigned long tskv = 0;
3306 struct task_struct *volatile tsk = NULL;
3307 struct mm_struct *volatile mm;
3308 pgd_t *pgdp;
3309 p4d_t *p4dp;
3310 pud_t *pudp;
3311 pmd_t *pmdp;
3312 pte_t *ptep;
3313
3314 if (!scanhex(&tskv))
3315 mm = &init_mm;
3316 else
3317 tsk = (struct task_struct *)tskv;
3318
3319 if (tsk == NULL)
3320 mm = &init_mm;
3321 else
3322 mm = tsk->active_mm;
3323
3324 if (setjmp(bus_error_jmp) != 0) {
3325 catch_memory_errors = 0;
3326 printf("*** Error dumping pte for task %px\n", tsk);
3327 return;
3328 }
3329
3330 catch_memory_errors = 1;
3331 sync();
3332
3333 if (mm == &init_mm)
3334 pgdp = pgd_offset_k(addr);
3335 else
3336 pgdp = pgd_offset(mm, addr);
3337
3338 p4dp = p4d_offset(pgdp, addr);
3339
3340 if (p4d_none(*p4dp)) {
3341 printf("No valid P4D\n");
3342 return;
3343 }
3344
3345 if (p4d_is_leaf(*p4dp)) {
3346 format_pte(p4dp, p4d_val(*p4dp));
3347 return;
3348 }
3349
3350 printf("p4dp @ 0x%px = 0x%016lx\n", p4dp, p4d_val(*p4dp));
3351
3352 pudp = pud_offset(p4dp, addr);
3353
3354 if (pud_none(*pudp)) {
3355 printf("No valid PUD\n");
3356 return;
3357 }
3358
3359 if (pud_is_leaf(*pudp)) {
3360 format_pte(pudp, pud_val(*pudp));
3361 return;
3362 }
3363
3364 printf("pudp @ 0x%px = 0x%016lx\n", pudp, pud_val(*pudp));
3365
3366 pmdp = pmd_offset(pudp, addr);
3367
3368 if (pmd_none(*pmdp)) {
3369 printf("No valid PMD\n");
3370 return;
3371 }
3372
3373 if (pmd_is_leaf(*pmdp)) {
3374 format_pte(pmdp, pmd_val(*pmdp));
3375 return;
3376 }
3377 printf("pmdp @ 0x%px = 0x%016lx\n", pmdp, pmd_val(*pmdp));
3378
3379 ptep = pte_offset_map(pmdp, addr);
3380 if (!ptep || pte_none(*ptep)) {
3381 if (ptep)
3382 pte_unmap(ptep);
3383 printf("no valid PTE\n");
3384 return;
3385 }
3386
3387 format_pte(ptep, pte_val(*ptep));
3388 pte_unmap(ptep);
3389
3390 sync();
3391 __delay(200);
3392 catch_memory_errors = 0;
3393}
3394#else
3395static void show_pte(unsigned long addr)
3396{
3397 printf("show_pte not yet implemented\n");
3398}
3399#endif /* CONFIG_PPC_BOOK3S_64 */
3400
3401static void show_tasks(void)
3402{
3403 unsigned long tskv;
3404 struct task_struct *volatile tsk = NULL;
3405
3406 printf(" task_struct ->thread.ksp ->thread.regs PID PPID S P CMD\n");
3407
3408 if (scanhex(&tskv))
3409 tsk = (struct task_struct *)tskv;
3410
3411 if (setjmp(bus_error_jmp) != 0) {
3412 catch_memory_errors = 0;
3413 printf("*** Error dumping task %px\n", tsk);
3414 return;
3415 }
3416
3417 catch_memory_errors = 1;
3418 sync();
3419
3420 if (tsk)
3421 show_task(tsk);
3422 else
3423 for_each_process(tsk)
3424 show_task(tsk);
3425
3426 sync();
3427 __delay(200);
3428 catch_memory_errors = 0;
3429}
3430
3431static void proccall(void)
3432{
3433 unsigned long args[8];
3434 unsigned long ret;
3435 int i;
3436 typedef unsigned long (*callfunc_t)(unsigned long, unsigned long,
3437 unsigned long, unsigned long, unsigned long,
3438 unsigned long, unsigned long, unsigned long);
3439 callfunc_t func;
3440
3441 if (!scanhex(&adrs))
3442 return;
3443 if (termch != '\n')
3444 termch = 0;
3445 for (i = 0; i < 8; ++i)
3446 args[i] = 0;
3447 for (i = 0; i < 8; ++i) {
3448 if (!scanhex(&args[i]) || termch == '\n')
3449 break;
3450 termch = 0;
3451 }
3452 func = (callfunc_t) adrs;
3453 ret = 0;
3454 if (setjmp(bus_error_jmp) == 0) {
3455 catch_memory_errors = 1;
3456 sync();
3457 ret = func(args[0], args[1], args[2], args[3],
3458 args[4], args[5], args[6], args[7]);
3459 sync();
3460 printf("return value is 0x%lx\n", ret);
3461 } else {
3462 printf("*** %x exception occurred\n", fault_except);
3463 }
3464 catch_memory_errors = 0;
3465}
3466
3467/* Input scanning routines */
3468int
3469skipbl(void)
3470{
3471 int c;
3472
3473 if( termch != 0 ){
3474 c = termch;
3475 termch = 0;
3476 } else
3477 c = inchar();
3478 while( c == ' ' || c == '\t' )
3479 c = inchar();
3480 return c;
3481}
3482
3483#define N_PTREGS 44
3484static const char *regnames[N_PTREGS] = {
3485 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
3486 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
3487 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
3488 "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
3489 "pc", "msr", "or3", "ctr", "lr", "xer", "ccr",
3490#ifdef CONFIG_PPC64
3491 "softe",
3492#else
3493 "mq",
3494#endif
3495 "trap", "dar", "dsisr", "res"
3496};
3497
3498int
3499scanhex(unsigned long *vp)
3500{
3501 int c, d;
3502 unsigned long v;
3503
3504 c = skipbl();
3505 if (c == '%') {
3506 /* parse register name */
3507 char regname[8];
3508 int i;
3509
3510 for (i = 0; i < sizeof(regname) - 1; ++i) {
3511 c = inchar();
3512 if (!isalnum(c)) {
3513 termch = c;
3514 break;
3515 }
3516 regname[i] = c;
3517 }
3518 regname[i] = 0;
3519 i = match_string(regnames, N_PTREGS, regname);
3520 if (i < 0) {
3521 printf("invalid register name '%%%s'\n", regname);
3522 return 0;
3523 }
3524 if (xmon_regs == NULL) {
3525 printf("regs not available\n");
3526 return 0;
3527 }
3528 *vp = ((unsigned long *)xmon_regs)[i];
3529 return 1;
3530 }
3531
3532 /* skip leading "0x" if any */
3533
3534 if (c == '0') {
3535 c = inchar();
3536 if (c == 'x') {
3537 c = inchar();
3538 } else {
3539 d = hexdigit(c);
3540 if (d == EOF) {
3541 termch = c;
3542 *vp = 0;
3543 return 1;
3544 }
3545 }
3546 } else if (c == '$') {
3547 int i;
3548 for (i=0; i<63; i++) {
3549 c = inchar();
3550 if (isspace(c) || c == '\0') {
3551 termch = c;
3552 break;
3553 }
3554 tmpstr[i] = c;
3555 }
3556 tmpstr[i++] = 0;
3557 *vp = 0;
3558 if (setjmp(bus_error_jmp) == 0) {
3559 catch_memory_errors = 1;
3560 sync();
3561 *vp = kallsyms_lookup_name(tmpstr);
3562 sync();
3563 }
3564 catch_memory_errors = 0;
3565 if (!(*vp)) {
3566 printf("unknown symbol '%s'\n", tmpstr);
3567 return 0;
3568 }
3569 return 1;
3570 }
3571
3572 d = hexdigit(c);
3573 if (d == EOF) {
3574 termch = c;
3575 return 0;
3576 }
3577 v = 0;
3578 do {
3579 v = (v << 4) + d;
3580 c = inchar();
3581 d = hexdigit(c);
3582 } while (d != EOF);
3583 termch = c;
3584 *vp = v;
3585 return 1;
3586}
3587
3588static void
3589scannl(void)
3590{
3591 int c;
3592
3593 c = termch;
3594 termch = 0;
3595 while( c != '\n' )
3596 c = inchar();
3597}
3598
3599static int hexdigit(int c)
3600{
3601 if( '0' <= c && c <= '9' )
3602 return c - '0';
3603 if( 'A' <= c && c <= 'F' )
3604 return c - ('A' - 10);
3605 if( 'a' <= c && c <= 'f' )
3606 return c - ('a' - 10);
3607 return EOF;
3608}
3609
3610void
3611getstring(char *s, int size)
3612{
3613 int c;
3614
3615 c = skipbl();
3616 if (c == '\n') {
3617 *s = 0;
3618 return;
3619 }
3620
3621 do {
3622 if( size > 1 ){
3623 *s++ = c;
3624 --size;
3625 }
3626 c = inchar();
3627 } while( c != ' ' && c != '\t' && c != '\n' );
3628 termch = c;
3629 *s = 0;
3630}
3631
3632static char line[256];
3633static char *lineptr;
3634
3635static void
3636flush_input(void)
3637{
3638 lineptr = NULL;
3639}
3640
3641static int
3642inchar(void)
3643{
3644 if (lineptr == NULL || *lineptr == 0) {
3645 if (xmon_gets(line, sizeof(line)) == NULL) {
3646 lineptr = NULL;
3647 return EOF;
3648 }
3649 lineptr = line;
3650 }
3651 return *lineptr++;
3652}
3653
3654static void
3655take_input(char *str)
3656{
3657 lineptr = str;
3658}
3659
3660
3661static void
3662symbol_lookup(void)
3663{
3664 int type = inchar();
3665 unsigned long addr, cpu;
3666 void __percpu *ptr = NULL;
3667 static char tmp[64];
3668
3669 switch (type) {
3670 case 'a':
3671 if (scanhex(&addr))
3672 xmon_print_symbol(addr, ": ", "\n");
3673 termch = 0;
3674 break;
3675 case 's':
3676 getstring(tmp, 64);
3677 if (setjmp(bus_error_jmp) == 0) {
3678 catch_memory_errors = 1;
3679 sync();
3680 addr = kallsyms_lookup_name(tmp);
3681 if (addr)
3682 printf("%s: %lx\n", tmp, addr);
3683 else
3684 printf("Symbol '%s' not found.\n", tmp);
3685 sync();
3686 }
3687 catch_memory_errors = 0;
3688 termch = 0;
3689 break;
3690 case 'p':
3691 getstring(tmp, 64);
3692 if (setjmp(bus_error_jmp) == 0) {
3693 catch_memory_errors = 1;
3694 sync();
3695 ptr = (void __percpu *)kallsyms_lookup_name(tmp);
3696 sync();
3697 }
3698
3699 if (ptr &&
3700 ptr >= (void __percpu *)__per_cpu_start &&
3701 ptr < (void __percpu *)__per_cpu_end)
3702 {
3703 if (scanhex(&cpu) && cpu < num_possible_cpus()) {
3704 addr = (unsigned long)per_cpu_ptr(ptr, cpu);
3705 } else {
3706 cpu = raw_smp_processor_id();
3707 addr = (unsigned long)this_cpu_ptr(ptr);
3708 }
3709
3710 printf("%s for cpu 0x%lx: %lx\n", tmp, cpu, addr);
3711 } else {
3712 printf("Percpu symbol '%s' not found.\n", tmp);
3713 }
3714
3715 catch_memory_errors = 0;
3716 termch = 0;
3717 break;
3718 }
3719}
3720
3721
3722/* Print an address in numeric and symbolic form (if possible) */
3723static void xmon_print_symbol(unsigned long address, const char *mid,
3724 const char *after)
3725{
3726 char *modname;
3727 const char *volatile name = NULL;
3728 unsigned long offset, size;
3729
3730 printf(REG, address);
3731 if (setjmp(bus_error_jmp) == 0) {
3732 catch_memory_errors = 1;
3733 sync();
3734 name = kallsyms_lookup(address, &size, &offset, &modname,
3735 tmpstr);
3736 sync();
3737 /* wait a little while to see if we get a machine check */
3738 __delay(200);
3739 }
3740
3741 catch_memory_errors = 0;
3742
3743 if (name) {
3744 printf("%s%s+%#lx/%#lx", mid, name, offset, size);
3745 if (modname)
3746 printf(" [%s]", modname);
3747 }
3748 printf("%s", after);
3749}
3750
3751#ifdef CONFIG_PPC_64S_HASH_MMU
3752void dump_segments(void)
3753{
3754 int i;
3755 unsigned long esid,vsid;
3756 unsigned long llp;
3757
3758 printf("SLB contents of cpu 0x%x\n", smp_processor_id());
3759
3760 for (i = 0; i < mmu_slb_size; i++) {
3761 asm volatile("slbmfee %0,%1" : "=r" (esid) : "r" (i));
3762 asm volatile("slbmfev %0,%1" : "=r" (vsid) : "r" (i));
3763
3764 if (!esid && !vsid)
3765 continue;
3766
3767 printf("%02d %016lx %016lx", i, esid, vsid);
3768
3769 if (!(esid & SLB_ESID_V)) {
3770 printf("\n");
3771 continue;
3772 }
3773
3774 llp = vsid & SLB_VSID_LLP;
3775 if (vsid & SLB_VSID_B_1T) {
3776 printf(" 1T ESID=%9lx VSID=%13lx LLP:%3lx \n",
3777 GET_ESID_1T(esid),
3778 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT_1T,
3779 llp);
3780 } else {
3781 printf(" 256M ESID=%9lx VSID=%13lx LLP:%3lx \n",
3782 GET_ESID(esid),
3783 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT,
3784 llp);
3785 }
3786 }
3787}
3788#endif
3789
3790#ifdef CONFIG_PPC_BOOK3S_32
3791void dump_segments(void)
3792{
3793 int i;
3794
3795 printf("sr0-15 =");
3796 for (i = 0; i < 16; ++i)
3797 printf(" %x", mfsr(i << 28));
3798 printf("\n");
3799}
3800#endif
3801
3802#ifdef CONFIG_44x
3803static void dump_tlb_44x(void)
3804{
3805 int i;
3806
3807 for (i = 0; i < PPC44x_TLB_SIZE; i++) {
3808 unsigned long w0,w1,w2;
3809 asm volatile("tlbre %0,%1,0" : "=r" (w0) : "r" (i));
3810 asm volatile("tlbre %0,%1,1" : "=r" (w1) : "r" (i));
3811 asm volatile("tlbre %0,%1,2" : "=r" (w2) : "r" (i));
3812 printf("[%02x] %08lx %08lx %08lx ", i, w0, w1, w2);
3813 if (w0 & PPC44x_TLB_VALID) {
3814 printf("V %08lx -> %01lx%08lx %c%c%c%c%c",
3815 w0 & PPC44x_TLB_EPN_MASK,
3816 w1 & PPC44x_TLB_ERPN_MASK,
3817 w1 & PPC44x_TLB_RPN_MASK,
3818 (w2 & PPC44x_TLB_W) ? 'W' : 'w',
3819 (w2 & PPC44x_TLB_I) ? 'I' : 'i',
3820 (w2 & PPC44x_TLB_M) ? 'M' : 'm',
3821 (w2 & PPC44x_TLB_G) ? 'G' : 'g',
3822 (w2 & PPC44x_TLB_E) ? 'E' : 'e');
3823 }
3824 printf("\n");
3825 }
3826}
3827#endif /* CONFIG_44x */
3828
3829#ifdef CONFIG_PPC_BOOK3E_64
3830static void dump_tlb_book3e(void)
3831{
3832 u32 mmucfg;
3833 u64 ramask;
3834 int i, tlb, ntlbs, pidsz, lpidsz, rasz;
3835 int mmu_version;
3836 static const char *pgsz_names[] = {
3837 " 1K",
3838 " 2K",
3839 " 4K",
3840 " 8K",
3841 " 16K",
3842 " 32K",
3843 " 64K",
3844 "128K",
3845 "256K",
3846 "512K",
3847 " 1M",
3848 " 2M",
3849 " 4M",
3850 " 8M",
3851 " 16M",
3852 " 32M",
3853 " 64M",
3854 "128M",
3855 "256M",
3856 "512M",
3857 " 1G",
3858 " 2G",
3859 " 4G",
3860 " 8G",
3861 " 16G",
3862 " 32G",
3863 " 64G",
3864 "128G",
3865 "256G",
3866 "512G",
3867 " 1T",
3868 " 2T",
3869 };
3870
3871 /* Gather some infos about the MMU */
3872 mmucfg = mfspr(SPRN_MMUCFG);
3873 mmu_version = (mmucfg & 3) + 1;
3874 ntlbs = ((mmucfg >> 2) & 3) + 1;
3875 pidsz = ((mmucfg >> 6) & 0x1f) + 1;
3876 lpidsz = (mmucfg >> 24) & 0xf;
3877 rasz = (mmucfg >> 16) & 0x7f;
3878 printf("Book3E MMU MAV=%d.0,%d TLBs,%d-bit PID,%d-bit LPID,%d-bit RA\n",
3879 mmu_version, ntlbs, pidsz, lpidsz, rasz);
3880 ramask = (1ull << rasz) - 1;
3881
3882 for (tlb = 0; tlb < ntlbs; tlb++) {
3883 u32 tlbcfg;
3884 int nent, assoc, new_cc = 1;
3885 printf("TLB %d:\n------\n", tlb);
3886 switch(tlb) {
3887 case 0:
3888 tlbcfg = mfspr(SPRN_TLB0CFG);
3889 break;
3890 case 1:
3891 tlbcfg = mfspr(SPRN_TLB1CFG);
3892 break;
3893 case 2:
3894 tlbcfg = mfspr(SPRN_TLB2CFG);
3895 break;
3896 case 3:
3897 tlbcfg = mfspr(SPRN_TLB3CFG);
3898 break;
3899 default:
3900 printf("Unsupported TLB number !\n");
3901 continue;
3902 }
3903 nent = tlbcfg & 0xfff;
3904 assoc = (tlbcfg >> 24) & 0xff;
3905 for (i = 0; i < nent; i++) {
3906 u32 mas0 = MAS0_TLBSEL(tlb);
3907 u32 mas1 = MAS1_TSIZE(BOOK3E_PAGESZ_4K);
3908 u64 mas2 = 0;
3909 u64 mas7_mas3;
3910 int esel = i, cc = i;
3911
3912 if (assoc != 0) {
3913 cc = i / assoc;
3914 esel = i % assoc;
3915 mas2 = cc * 0x1000;
3916 }
3917
3918 mas0 |= MAS0_ESEL(esel);
3919 mtspr(SPRN_MAS0, mas0);
3920 mtspr(SPRN_MAS1, mas1);
3921 mtspr(SPRN_MAS2, mas2);
3922 asm volatile("tlbre 0,0,0" : : : "memory");
3923 mas1 = mfspr(SPRN_MAS1);
3924 mas2 = mfspr(SPRN_MAS2);
3925 mas7_mas3 = mfspr(SPRN_MAS7_MAS3);
3926 if (assoc && (i % assoc) == 0)
3927 new_cc = 1;
3928 if (!(mas1 & MAS1_VALID))
3929 continue;
3930 if (assoc == 0)
3931 printf("%04x- ", i);
3932 else if (new_cc)
3933 printf("%04x-%c", cc, 'A' + esel);
3934 else
3935 printf(" |%c", 'A' + esel);
3936 new_cc = 0;
3937 printf(" %016llx %04x %s %c%c AS%c",
3938 mas2 & ~0x3ffull,
3939 (mas1 >> 16) & 0x3fff,
3940 pgsz_names[(mas1 >> 7) & 0x1f],
3941 mas1 & MAS1_IND ? 'I' : ' ',
3942 mas1 & MAS1_IPROT ? 'P' : ' ',
3943 mas1 & MAS1_TS ? '1' : '0');
3944 printf(" %c%c%c%c%c%c%c",
3945 mas2 & MAS2_X0 ? 'a' : ' ',
3946 mas2 & MAS2_X1 ? 'v' : ' ',
3947 mas2 & MAS2_W ? 'w' : ' ',
3948 mas2 & MAS2_I ? 'i' : ' ',
3949 mas2 & MAS2_M ? 'm' : ' ',
3950 mas2 & MAS2_G ? 'g' : ' ',
3951 mas2 & MAS2_E ? 'e' : ' ');
3952 printf(" %016llx", mas7_mas3 & ramask & ~0x7ffull);
3953 if (mas1 & MAS1_IND)
3954 printf(" %s\n",
3955 pgsz_names[(mas7_mas3 >> 1) & 0x1f]);
3956 else
3957 printf(" U%c%c%c S%c%c%c\n",
3958 mas7_mas3 & MAS3_UX ? 'x' : ' ',
3959 mas7_mas3 & MAS3_UW ? 'w' : ' ',
3960 mas7_mas3 & MAS3_UR ? 'r' : ' ',
3961 mas7_mas3 & MAS3_SX ? 'x' : ' ',
3962 mas7_mas3 & MAS3_SW ? 'w' : ' ',
3963 mas7_mas3 & MAS3_SR ? 'r' : ' ');
3964 }
3965 }
3966}
3967#endif /* CONFIG_PPC_BOOK3E_64 */
3968
3969static void xmon_init(int enable)
3970{
3971 if (enable) {
3972 __debugger = xmon;
3973 __debugger_ipi = xmon_ipi;
3974 __debugger_bpt = xmon_bpt;
3975 __debugger_sstep = xmon_sstep;
3976 __debugger_iabr_match = xmon_iabr_match;
3977 __debugger_break_match = xmon_break_match;
3978 __debugger_fault_handler = xmon_fault_handler;
3979 } else {
3980 __debugger = NULL;
3981 __debugger_ipi = NULL;
3982 __debugger_bpt = NULL;
3983 __debugger_sstep = NULL;
3984 __debugger_iabr_match = NULL;
3985 __debugger_break_match = NULL;
3986 __debugger_fault_handler = NULL;
3987 }
3988}
3989
3990#ifdef CONFIG_MAGIC_SYSRQ
3991static void sysrq_handle_xmon(u8 key)
3992{
3993 if (xmon_is_locked_down()) {
3994 clear_all_bpt();
3995 xmon_init(0);
3996 return;
3997 }
3998 /* ensure xmon is enabled */
3999 xmon_init(1);
4000 debugger(get_irq_regs());
4001 if (!xmon_on)
4002 xmon_init(0);
4003}
4004
4005static const struct sysrq_key_op sysrq_xmon_op = {
4006 .handler = sysrq_handle_xmon,
4007 .help_msg = "xmon(x)",
4008 .action_msg = "Entering xmon",
4009};
4010
4011static int __init setup_xmon_sysrq(void)
4012{
4013 register_sysrq_key('x', &sysrq_xmon_op);
4014 return 0;
4015}
4016device_initcall(setup_xmon_sysrq);
4017#endif /* CONFIG_MAGIC_SYSRQ */
4018
4019static void clear_all_bpt(void)
4020{
4021 int i;
4022
4023 /* clear/unpatch all breakpoints */
4024 remove_bpts();
4025 remove_cpu_bpts();
4026
4027 /* Disable all breakpoints */
4028 for (i = 0; i < NBPTS; ++i)
4029 bpts[i].enabled = 0;
4030
4031 /* Clear any data or iabr breakpoints */
4032 iabr = NULL;
4033 for (i = 0; i < nr_wp_slots(); i++)
4034 dabr[i].enabled = 0;
4035}
4036
4037#ifdef CONFIG_DEBUG_FS
4038static int xmon_dbgfs_set(void *data, u64 val)
4039{
4040 xmon_on = !!val;
4041 xmon_init(xmon_on);
4042
4043 /* make sure all breakpoints removed when disabling */
4044 if (!xmon_on) {
4045 clear_all_bpt();
4046 get_output_lock();
4047 printf("xmon: All breakpoints cleared\n");
4048 release_output_lock();
4049 }
4050
4051 return 0;
4052}
4053
4054static int xmon_dbgfs_get(void *data, u64 *val)
4055{
4056 *val = xmon_on;
4057 return 0;
4058}
4059
4060DEFINE_SIMPLE_ATTRIBUTE(xmon_dbgfs_ops, xmon_dbgfs_get,
4061 xmon_dbgfs_set, "%llu\n");
4062
4063static int __init setup_xmon_dbgfs(void)
4064{
4065 debugfs_create_file("xmon", 0600, arch_debugfs_dir, NULL,
4066 &xmon_dbgfs_ops);
4067 return 0;
4068}
4069device_initcall(setup_xmon_dbgfs);
4070#endif /* CONFIG_DEBUG_FS */
4071
4072static int xmon_early __initdata;
4073
4074static int __init early_parse_xmon(char *p)
4075{
4076 if (xmon_is_locked_down()) {
4077 xmon_init(0);
4078 xmon_early = 0;
4079 xmon_on = 0;
4080 } else if (!p || strncmp(p, "early", 5) == 0) {
4081 /* just "xmon" is equivalent to "xmon=early" */
4082 xmon_init(1);
4083 xmon_early = 1;
4084 xmon_on = 1;
4085 } else if (strncmp(p, "on", 2) == 0) {
4086 xmon_init(1);
4087 xmon_on = 1;
4088 } else if (strncmp(p, "rw", 2) == 0) {
4089 xmon_init(1);
4090 xmon_on = 1;
4091 xmon_is_ro = false;
4092 } else if (strncmp(p, "ro", 2) == 0) {
4093 xmon_init(1);
4094 xmon_on = 1;
4095 xmon_is_ro = true;
4096 } else if (strncmp(p, "off", 3) == 0)
4097 xmon_on = 0;
4098 else
4099 return 1;
4100
4101 return 0;
4102}
4103early_param("xmon", early_parse_xmon);
4104
4105void __init xmon_setup(void)
4106{
4107 if (xmon_on)
4108 xmon_init(1);
4109 if (xmon_early)
4110 debugger(NULL);
4111}
4112
4113#ifdef CONFIG_SPU_BASE
4114
4115struct spu_info {
4116 struct spu *spu;
4117 u64 saved_mfc_sr1_RW;
4118 u32 saved_spu_runcntl_RW;
4119 unsigned long dump_addr;
4120 u8 stopped_ok;
4121};
4122
4123#define XMON_NUM_SPUS 16 /* Enough for current hardware */
4124
4125static struct spu_info spu_info[XMON_NUM_SPUS];
4126
4127void __init xmon_register_spus(struct list_head *list)
4128{
4129 struct spu *spu;
4130
4131 list_for_each_entry(spu, list, full_list) {
4132 if (spu->number >= XMON_NUM_SPUS) {
4133 WARN_ON(1);
4134 continue;
4135 }
4136
4137 spu_info[spu->number].spu = spu;
4138 spu_info[spu->number].stopped_ok = 0;
4139 spu_info[spu->number].dump_addr = (unsigned long)
4140 spu_info[spu->number].spu->local_store;
4141 }
4142}
4143
4144static void stop_spus(void)
4145{
4146 struct spu *spu;
4147 volatile int i;
4148 u64 tmp;
4149
4150 for (i = 0; i < XMON_NUM_SPUS; i++) {
4151 if (!spu_info[i].spu)
4152 continue;
4153
4154 if (setjmp(bus_error_jmp) == 0) {
4155 catch_memory_errors = 1;
4156 sync();
4157
4158 spu = spu_info[i].spu;
4159
4160 spu_info[i].saved_spu_runcntl_RW =
4161 in_be32(&spu->problem->spu_runcntl_RW);
4162
4163 tmp = spu_mfc_sr1_get(spu);
4164 spu_info[i].saved_mfc_sr1_RW = tmp;
4165
4166 tmp &= ~MFC_STATE1_MASTER_RUN_CONTROL_MASK;
4167 spu_mfc_sr1_set(spu, tmp);
4168
4169 sync();
4170 __delay(200);
4171
4172 spu_info[i].stopped_ok = 1;
4173
4174 printf("Stopped spu %.2d (was %s)\n", i,
4175 spu_info[i].saved_spu_runcntl_RW ?
4176 "running" : "stopped");
4177 } else {
4178 catch_memory_errors = 0;
4179 printf("*** Error stopping spu %.2d\n", i);
4180 }
4181 catch_memory_errors = 0;
4182 }
4183}
4184
4185static void restart_spus(void)
4186{
4187 struct spu *spu;
4188 volatile int i;
4189
4190 for (i = 0; i < XMON_NUM_SPUS; i++) {
4191 if (!spu_info[i].spu)
4192 continue;
4193
4194 if (!spu_info[i].stopped_ok) {
4195 printf("*** Error, spu %d was not successfully stopped"
4196 ", not restarting\n", i);
4197 continue;
4198 }
4199
4200 if (setjmp(bus_error_jmp) == 0) {
4201 catch_memory_errors = 1;
4202 sync();
4203
4204 spu = spu_info[i].spu;
4205 spu_mfc_sr1_set(spu, spu_info[i].saved_mfc_sr1_RW);
4206 out_be32(&spu->problem->spu_runcntl_RW,
4207 spu_info[i].saved_spu_runcntl_RW);
4208
4209 sync();
4210 __delay(200);
4211
4212 printf("Restarted spu %.2d\n", i);
4213 } else {
4214 catch_memory_errors = 0;
4215 printf("*** Error restarting spu %.2d\n", i);
4216 }
4217 catch_memory_errors = 0;
4218 }
4219}
4220
4221#define DUMP_WIDTH 23
4222#define DUMP_VALUE(format, field, value) \
4223do { \
4224 if (setjmp(bus_error_jmp) == 0) { \
4225 catch_memory_errors = 1; \
4226 sync(); \
4227 printf(" %-*s = "format"\n", DUMP_WIDTH, \
4228 #field, value); \
4229 sync(); \
4230 __delay(200); \
4231 } else { \
4232 catch_memory_errors = 0; \
4233 printf(" %-*s = *** Error reading field.\n", \
4234 DUMP_WIDTH, #field); \
4235 } \
4236 catch_memory_errors = 0; \
4237} while (0)
4238
4239#define DUMP_FIELD(obj, format, field) \
4240 DUMP_VALUE(format, field, obj->field)
4241
4242static void dump_spu_fields(struct spu *spu)
4243{
4244 printf("Dumping spu fields at address %p:\n", spu);
4245
4246 DUMP_FIELD(spu, "0x%x", number);
4247 DUMP_FIELD(spu, "%s", name);
4248 DUMP_FIELD(spu, "0x%lx", local_store_phys);
4249 DUMP_FIELD(spu, "0x%p", local_store);
4250 DUMP_FIELD(spu, "0x%lx", ls_size);
4251 DUMP_FIELD(spu, "0x%x", node);
4252 DUMP_FIELD(spu, "0x%lx", flags);
4253 DUMP_FIELD(spu, "%llu", class_0_pending);
4254 DUMP_FIELD(spu, "0x%llx", class_0_dar);
4255 DUMP_FIELD(spu, "0x%llx", class_1_dar);
4256 DUMP_FIELD(spu, "0x%llx", class_1_dsisr);
4257 DUMP_FIELD(spu, "0x%x", irqs[0]);
4258 DUMP_FIELD(spu, "0x%x", irqs[1]);
4259 DUMP_FIELD(spu, "0x%x", irqs[2]);
4260 DUMP_FIELD(spu, "0x%x", slb_replace);
4261 DUMP_FIELD(spu, "%d", pid);
4262 DUMP_FIELD(spu, "0x%p", mm);
4263 DUMP_FIELD(spu, "0x%p", ctx);
4264 DUMP_FIELD(spu, "0x%p", rq);
4265 DUMP_FIELD(spu, "0x%llx", timestamp);
4266 DUMP_FIELD(spu, "0x%lx", problem_phys);
4267 DUMP_FIELD(spu, "0x%p", problem);
4268 DUMP_VALUE("0x%x", problem->spu_runcntl_RW,
4269 in_be32(&spu->problem->spu_runcntl_RW));
4270 DUMP_VALUE("0x%x", problem->spu_status_R,
4271 in_be32(&spu->problem->spu_status_R));
4272 DUMP_VALUE("0x%x", problem->spu_npc_RW,
4273 in_be32(&spu->problem->spu_npc_RW));
4274 DUMP_FIELD(spu, "0x%p", priv2);
4275 DUMP_FIELD(spu, "0x%p", pdata);
4276}
4277
4278static int spu_inst_dump(unsigned long adr, long count, int praddr)
4279{
4280 return generic_inst_dump(adr, count, praddr, print_insn_spu);
4281}
4282
4283static void dump_spu_ls(unsigned long num, int subcmd)
4284{
4285 unsigned long offset, addr, ls_addr;
4286
4287 if (setjmp(bus_error_jmp) == 0) {
4288 catch_memory_errors = 1;
4289 sync();
4290 ls_addr = (unsigned long)spu_info[num].spu->local_store;
4291 sync();
4292 __delay(200);
4293 } else {
4294 catch_memory_errors = 0;
4295 printf("*** Error: accessing spu info for spu %ld\n", num);
4296 return;
4297 }
4298 catch_memory_errors = 0;
4299
4300 if (scanhex(&offset))
4301 addr = ls_addr + offset;
4302 else
4303 addr = spu_info[num].dump_addr;
4304
4305 if (addr >= ls_addr + LS_SIZE) {
4306 printf("*** Error: address outside of local store\n");
4307 return;
4308 }
4309
4310 switch (subcmd) {
4311 case 'i':
4312 addr += spu_inst_dump(addr, 16, 1);
4313 last_cmd = "sdi\n";
4314 break;
4315 default:
4316 prdump(addr, 64);
4317 addr += 64;
4318 last_cmd = "sd\n";
4319 break;
4320 }
4321
4322 spu_info[num].dump_addr = addr;
4323}
4324
4325static int do_spu_cmd(void)
4326{
4327 static unsigned long num = 0;
4328 int cmd, subcmd = 0;
4329
4330 cmd = inchar();
4331 switch (cmd) {
4332 case 's':
4333 stop_spus();
4334 break;
4335 case 'r':
4336 restart_spus();
4337 break;
4338 case 'd':
4339 subcmd = inchar();
4340 if (isxdigit(subcmd) || subcmd == '\n')
4341 termch = subcmd;
4342 fallthrough;
4343 case 'f':
4344 scanhex(&num);
4345 if (num >= XMON_NUM_SPUS || !spu_info[num].spu) {
4346 printf("*** Error: invalid spu number\n");
4347 return 0;
4348 }
4349
4350 switch (cmd) {
4351 case 'f':
4352 dump_spu_fields(spu_info[num].spu);
4353 break;
4354 default:
4355 dump_spu_ls(num, subcmd);
4356 break;
4357 }
4358
4359 break;
4360 default:
4361 return -1;
4362 }
4363
4364 return 0;
4365}
4366#else /* ! CONFIG_SPU_BASE */
4367static int do_spu_cmd(void)
4368{
4369 return -1;
4370}
4371#endif
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/export.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/setjmp.h>
43#include <asm/reg.h>
44#include <asm/debug.h>
45
46#ifdef CONFIG_PPC64
47#include <asm/hvcall.h>
48#include <asm/paca.h>
49#endif
50
51#include "nonstdio.h"
52#include "dis-asm.h"
53
54#define scanhex xmon_scanhex
55#define skipbl xmon_skipbl
56
57#ifdef CONFIG_SMP
58static cpumask_t cpus_in_xmon = CPU_MASK_NONE;
59static unsigned long xmon_taken = 1;
60static int xmon_owner;
61static int xmon_gate;
62#endif /* CONFIG_SMP */
63
64static unsigned long in_xmon __read_mostly = 0;
65
66static unsigned long adrs;
67static int size = 1;
68#define MAX_DUMP (128 * 1024)
69static unsigned long ndump = 64;
70static unsigned long nidump = 16;
71static unsigned long ncsum = 4096;
72static int termch;
73static char tmpstr[128];
74
75static long bus_error_jmp[JMP_BUF_LEN];
76static int catch_memory_errors;
77static long *xmon_fault_jmp[NR_CPUS];
78
79/* Breakpoint stuff */
80struct bpt {
81 unsigned long address;
82 unsigned int instr[2];
83 atomic_t ref_count;
84 int enabled;
85 unsigned long pad;
86};
87
88/* Bits in bpt.enabled */
89#define BP_IABR_TE 1 /* IABR translation enabled */
90#define BP_IABR 2
91#define BP_TRAP 8
92#define BP_DABR 0x10
93
94#define NBPTS 256
95static struct bpt bpts[NBPTS];
96static struct bpt dabr;
97static struct bpt *iabr;
98static unsigned bpinstr = 0x7fe00008; /* trap */
99
100#define BP_NUM(bp) ((bp) - bpts + 1)
101
102/* Prototypes */
103static int cmds(struct pt_regs *);
104static int mread(unsigned long, void *, int);
105static int mwrite(unsigned long, void *, int);
106static int handle_fault(struct pt_regs *);
107static void byterev(unsigned char *, int);
108static void memex(void);
109static int bsesc(void);
110static void dump(void);
111static void prdump(unsigned long, long);
112static int ppc_inst_dump(unsigned long, long, int);
113static void dump_log_buf(void);
114static void backtrace(struct pt_regs *);
115static void excprint(struct pt_regs *);
116static void prregs(struct pt_regs *);
117static void memops(int);
118static void memlocate(void);
119static void memzcan(void);
120static void memdiffs(unsigned char *, unsigned char *, unsigned, unsigned);
121int skipbl(void);
122int scanhex(unsigned long *valp);
123static void scannl(void);
124static int hexdigit(int);
125void getstring(char *, int);
126static void flush_input(void);
127static int inchar(void);
128static void take_input(char *);
129static unsigned long read_spr(int);
130static void write_spr(int, unsigned long);
131static void super_regs(void);
132static void remove_bpts(void);
133static void insert_bpts(void);
134static void remove_cpu_bpts(void);
135static void insert_cpu_bpts(void);
136static struct bpt *at_breakpoint(unsigned long pc);
137static struct bpt *in_breakpoint_table(unsigned long pc, unsigned long *offp);
138static int do_step(struct pt_regs *);
139static void bpt_cmds(void);
140static void cacheflush(void);
141static int cpu_cmd(void);
142static void csum(void);
143static void bootcmds(void);
144static void proccall(void);
145void dump_segments(void);
146static void symbol_lookup(void);
147static void xmon_show_stack(unsigned long sp, unsigned long lr,
148 unsigned long pc);
149static void xmon_print_symbol(unsigned long address, const char *mid,
150 const char *after);
151static const char *getvecname(unsigned long vec);
152
153static int do_spu_cmd(void);
154
155#ifdef CONFIG_44x
156static void dump_tlb_44x(void);
157#endif
158#ifdef CONFIG_PPC_BOOK3E
159static void dump_tlb_book3e(void);
160#endif
161
162static int xmon_no_auto_backtrace;
163
164extern void xmon_enter(void);
165extern void xmon_leave(void);
166
167#ifdef CONFIG_PPC64
168#define REG "%.16lx"
169#define REGS_PER_LINE 4
170#define LAST_VOLATILE 13
171#else
172#define REG "%.8lx"
173#define REGS_PER_LINE 8
174#define LAST_VOLATILE 12
175#endif
176
177#define GETWORD(v) (((v)[0] << 24) + ((v)[1] << 16) + ((v)[2] << 8) + (v)[3])
178
179#define isxdigit(c) (('0' <= (c) && (c) <= '9') \
180 || ('a' <= (c) && (c) <= 'f') \
181 || ('A' <= (c) && (c) <= 'F'))
182#define isalnum(c) (('0' <= (c) && (c) <= '9') \
183 || ('a' <= (c) && (c) <= 'z') \
184 || ('A' <= (c) && (c) <= 'Z'))
185#define isspace(c) (c == ' ' || c == '\t' || c == 10 || c == 13 || c == 0)
186
187static char *help_string = "\
188Commands:\n\
189 b show breakpoints\n\
190 bd set data breakpoint\n\
191 bi set instruction breakpoint\n\
192 bc clear breakpoint\n"
193#ifdef CONFIG_SMP
194 "\
195 c print cpus stopped in xmon\n\
196 c# try to switch to cpu number h (in hex)\n"
197#endif
198 "\
199 C checksum\n\
200 d dump bytes\n\
201 di dump instructions\n\
202 df dump float values\n\
203 dd dump double values\n\
204 dl dump the kernel log buffer\n\
205 dr dump stream of raw bytes\n\
206 e print exception information\n\
207 f flush cache\n\
208 la lookup symbol+offset of specified address\n\
209 ls lookup address of specified symbol\n\
210 m examine/change memory\n\
211 mm move a block of memory\n\
212 ms set a block of memory\n\
213 md compare two blocks of memory\n\
214 ml locate a block of memory\n\
215 mz zero a block of memory\n\
216 mi show information about memory allocation\n\
217 p call a procedure\n\
218 r print registers\n\
219 s single step\n"
220#ifdef CONFIG_SPU_BASE
221" ss stop execution on all spus\n\
222 sr restore execution on stopped spus\n\
223 sf # dump spu fields for spu # (in hex)\n\
224 sd # dump spu local store for spu # (in hex)\n\
225 sdi # disassemble spu local store for spu # (in hex)\n"
226#endif
227" S print special registers\n\
228 t print backtrace\n\
229 x exit monitor and recover\n\
230 X exit monitor and dont recover\n"
231#if defined(CONFIG_PPC64) && !defined(CONFIG_PPC_BOOK3E)
232" u dump segment table or SLB\n"
233#elif defined(CONFIG_PPC_STD_MMU_32)
234" u dump segment registers\n"
235#elif defined(CONFIG_44x) || defined(CONFIG_PPC_BOOK3E)
236" u dump TLB\n"
237#endif
238" ? help\n"
239" zr reboot\n\
240 zh halt\n"
241;
242
243static struct pt_regs *xmon_regs;
244
245static inline void sync(void)
246{
247 asm volatile("sync; isync");
248}
249
250static inline void store_inst(void *p)
251{
252 asm volatile ("dcbst 0,%0; sync; icbi 0,%0; isync" : : "r" (p));
253}
254
255static inline void cflush(void *p)
256{
257 asm volatile ("dcbf 0,%0; icbi 0,%0" : : "r" (p));
258}
259
260static inline void cinval(void *p)
261{
262 asm volatile ("dcbi 0,%0; icbi 0,%0" : : "r" (p));
263}
264
265/*
266 * Disable surveillance (the service processor watchdog function)
267 * while we are in xmon.
268 * XXX we should re-enable it when we leave. :)
269 */
270#define SURVEILLANCE_TOKEN 9000
271
272static inline void disable_surveillance(void)
273{
274#ifdef CONFIG_PPC_PSERIES
275 /* Since this can't be a module, args should end up below 4GB. */
276 static struct rtas_args args;
277
278 /*
279 * At this point we have got all the cpus we can into
280 * xmon, so there is hopefully no other cpu calling RTAS
281 * at the moment, even though we don't take rtas.lock.
282 * If we did try to take rtas.lock there would be a
283 * real possibility of deadlock.
284 */
285 args.token = rtas_token("set-indicator");
286 if (args.token == RTAS_UNKNOWN_SERVICE)
287 return;
288 args.nargs = 3;
289 args.nret = 1;
290 args.rets = &args.args[3];
291 args.args[0] = SURVEILLANCE_TOKEN;
292 args.args[1] = 0;
293 args.args[2] = 0;
294 enter_rtas(__pa(&args));
295#endif /* CONFIG_PPC_PSERIES */
296}
297
298#ifdef CONFIG_SMP
299static int xmon_speaker;
300
301static void get_output_lock(void)
302{
303 int me = smp_processor_id() + 0x100;
304 int last_speaker = 0, prev;
305 long timeout;
306
307 if (xmon_speaker == me)
308 return;
309 for (;;) {
310 if (xmon_speaker == 0) {
311 last_speaker = cmpxchg(&xmon_speaker, 0, me);
312 if (last_speaker == 0)
313 return;
314 }
315 timeout = 10000000;
316 while (xmon_speaker == last_speaker) {
317 if (--timeout > 0)
318 continue;
319 /* hostile takeover */
320 prev = cmpxchg(&xmon_speaker, last_speaker, me);
321 if (prev == last_speaker)
322 return;
323 break;
324 }
325 }
326}
327
328static void release_output_lock(void)
329{
330 xmon_speaker = 0;
331}
332
333int cpus_are_in_xmon(void)
334{
335 return !cpumask_empty(&cpus_in_xmon);
336}
337#endif
338
339static inline int unrecoverable_excp(struct pt_regs *regs)
340{
341#if defined(CONFIG_4xx) || defined(CONFIG_PPC_BOOK3E)
342 /* We have no MSR_RI bit on 4xx or Book3e, so we simply return false */
343 return 0;
344#else
345 return ((regs->msr & MSR_RI) == 0);
346#endif
347}
348
349static int xmon_core(struct pt_regs *regs, int fromipi)
350{
351 int cmd = 0;
352 struct bpt *bp;
353 long recurse_jmp[JMP_BUF_LEN];
354 unsigned long offset;
355 unsigned long flags;
356#ifdef CONFIG_SMP
357 int cpu;
358 int secondary;
359 unsigned long timeout;
360#endif
361
362 local_irq_save(flags);
363
364 bp = in_breakpoint_table(regs->nip, &offset);
365 if (bp != NULL) {
366 regs->nip = bp->address + offset;
367 atomic_dec(&bp->ref_count);
368 }
369
370 remove_cpu_bpts();
371
372#ifdef CONFIG_SMP
373 cpu = smp_processor_id();
374 if (cpumask_test_cpu(cpu, &cpus_in_xmon)) {
375 get_output_lock();
376 excprint(regs);
377 printf("cpu 0x%x: Exception %lx %s in xmon, "
378 "returning to main loop\n",
379 cpu, regs->trap, getvecname(TRAP(regs)));
380 release_output_lock();
381 longjmp(xmon_fault_jmp[cpu], 1);
382 }
383
384 if (setjmp(recurse_jmp) != 0) {
385 if (!in_xmon || !xmon_gate) {
386 get_output_lock();
387 printf("xmon: WARNING: bad recursive fault "
388 "on cpu 0x%x\n", cpu);
389 release_output_lock();
390 goto waiting;
391 }
392 secondary = !(xmon_taken && cpu == xmon_owner);
393 goto cmdloop;
394 }
395
396 xmon_fault_jmp[cpu] = recurse_jmp;
397 cpumask_set_cpu(cpu, &cpus_in_xmon);
398
399 bp = NULL;
400 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT))
401 bp = at_breakpoint(regs->nip);
402 if (bp || unrecoverable_excp(regs))
403 fromipi = 0;
404
405 if (!fromipi) {
406 get_output_lock();
407 excprint(regs);
408 if (bp) {
409 printf("cpu 0x%x stopped at breakpoint 0x%x (",
410 cpu, BP_NUM(bp));
411 xmon_print_symbol(regs->nip, " ", ")\n");
412 }
413 if (unrecoverable_excp(regs))
414 printf("WARNING: exception is not recoverable, "
415 "can't continue\n");
416 release_output_lock();
417 }
418
419 waiting:
420 secondary = 1;
421 while (secondary && !xmon_gate) {
422 if (in_xmon == 0) {
423 if (fromipi)
424 goto leave;
425 secondary = test_and_set_bit(0, &in_xmon);
426 }
427 barrier();
428 }
429
430 if (!secondary && !xmon_gate) {
431 /* we are the first cpu to come in */
432 /* interrupt other cpu(s) */
433 int ncpus = num_online_cpus();
434
435 xmon_owner = cpu;
436 mb();
437 if (ncpus > 1) {
438 smp_send_debugger_break();
439 /* wait for other cpus to come in */
440 for (timeout = 100000000; timeout != 0; --timeout) {
441 if (cpumask_weight(&cpus_in_xmon) >= ncpus)
442 break;
443 barrier();
444 }
445 }
446 remove_bpts();
447 disable_surveillance();
448 /* for breakpoint or single step, print the current instr. */
449 if (bp || TRAP(regs) == 0xd00)
450 ppc_inst_dump(regs->nip, 1, 0);
451 printf("enter ? for help\n");
452 mb();
453 xmon_gate = 1;
454 barrier();
455 }
456
457 cmdloop:
458 while (in_xmon) {
459 if (secondary) {
460 if (cpu == xmon_owner) {
461 if (!test_and_set_bit(0, &xmon_taken)) {
462 secondary = 0;
463 continue;
464 }
465 /* missed it */
466 while (cpu == xmon_owner)
467 barrier();
468 }
469 barrier();
470 } else {
471 cmd = cmds(regs);
472 if (cmd != 0) {
473 /* exiting xmon */
474 insert_bpts();
475 xmon_gate = 0;
476 wmb();
477 in_xmon = 0;
478 break;
479 }
480 /* have switched to some other cpu */
481 secondary = 1;
482 }
483 }
484 leave:
485 cpumask_clear_cpu(cpu, &cpus_in_xmon);
486 xmon_fault_jmp[cpu] = NULL;
487#else
488 /* UP is simple... */
489 if (in_xmon) {
490 printf("Exception %lx %s in xmon, returning to main loop\n",
491 regs->trap, getvecname(TRAP(regs)));
492 longjmp(xmon_fault_jmp[0], 1);
493 }
494 if (setjmp(recurse_jmp) == 0) {
495 xmon_fault_jmp[0] = recurse_jmp;
496 in_xmon = 1;
497
498 excprint(regs);
499 bp = at_breakpoint(regs->nip);
500 if (bp) {
501 printf("Stopped at breakpoint %x (", BP_NUM(bp));
502 xmon_print_symbol(regs->nip, " ", ")\n");
503 }
504 if (unrecoverable_excp(regs))
505 printf("WARNING: exception is not recoverable, "
506 "can't continue\n");
507 remove_bpts();
508 disable_surveillance();
509 /* for breakpoint or single step, print the current instr. */
510 if (bp || TRAP(regs) == 0xd00)
511 ppc_inst_dump(regs->nip, 1, 0);
512 printf("enter ? for help\n");
513 }
514
515 cmd = cmds(regs);
516
517 insert_bpts();
518 in_xmon = 0;
519#endif
520
521#ifdef CONFIG_BOOKE
522 if (regs->msr & MSR_DE) {
523 bp = at_breakpoint(regs->nip);
524 if (bp != NULL) {
525 regs->nip = (unsigned long) &bp->instr[0];
526 atomic_inc(&bp->ref_count);
527 }
528 }
529#else
530 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT)) {
531 bp = at_breakpoint(regs->nip);
532 if (bp != NULL) {
533 int stepped = emulate_step(regs, bp->instr[0]);
534 if (stepped == 0) {
535 regs->nip = (unsigned long) &bp->instr[0];
536 atomic_inc(&bp->ref_count);
537 } else if (stepped < 0) {
538 printf("Couldn't single-step %s instruction\n",
539 (IS_RFID(bp->instr[0])? "rfid": "mtmsrd"));
540 }
541 }
542 }
543#endif
544 insert_cpu_bpts();
545
546 local_irq_restore(flags);
547
548 return cmd != 'X' && cmd != EOF;
549}
550
551int xmon(struct pt_regs *excp)
552{
553 struct pt_regs regs;
554
555 if (excp == NULL) {
556 ppc_save_regs(®s);
557 excp = ®s;
558 }
559
560 return xmon_core(excp, 0);
561}
562EXPORT_SYMBOL(xmon);
563
564irqreturn_t xmon_irq(int irq, void *d)
565{
566 unsigned long flags;
567 local_irq_save(flags);
568 printf("Keyboard interrupt\n");
569 xmon(get_irq_regs());
570 local_irq_restore(flags);
571 return IRQ_HANDLED;
572}
573
574static int xmon_bpt(struct pt_regs *regs)
575{
576 struct bpt *bp;
577 unsigned long offset;
578
579 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
580 return 0;
581
582 /* Are we at the trap at bp->instr[1] for some bp? */
583 bp = in_breakpoint_table(regs->nip, &offset);
584 if (bp != NULL && offset == 4) {
585 regs->nip = bp->address + 4;
586 atomic_dec(&bp->ref_count);
587 return 1;
588 }
589
590 /* Are we at a breakpoint? */
591 bp = at_breakpoint(regs->nip);
592 if (!bp)
593 return 0;
594
595 xmon_core(regs, 0);
596
597 return 1;
598}
599
600static int xmon_sstep(struct pt_regs *regs)
601{
602 if (user_mode(regs))
603 return 0;
604 xmon_core(regs, 0);
605 return 1;
606}
607
608static int xmon_dabr_match(struct pt_regs *regs)
609{
610 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
611 return 0;
612 if (dabr.enabled == 0)
613 return 0;
614 xmon_core(regs, 0);
615 return 1;
616}
617
618static int xmon_iabr_match(struct pt_regs *regs)
619{
620 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) != (MSR_IR|MSR_64BIT))
621 return 0;
622 if (iabr == NULL)
623 return 0;
624 xmon_core(regs, 0);
625 return 1;
626}
627
628static int xmon_ipi(struct pt_regs *regs)
629{
630#ifdef CONFIG_SMP
631 if (in_xmon && !cpumask_test_cpu(smp_processor_id(), &cpus_in_xmon))
632 xmon_core(regs, 1);
633#endif
634 return 0;
635}
636
637static int xmon_fault_handler(struct pt_regs *regs)
638{
639 struct bpt *bp;
640 unsigned long offset;
641
642 if (in_xmon && catch_memory_errors)
643 handle_fault(regs); /* doesn't return */
644
645 if ((regs->msr & (MSR_IR|MSR_PR|MSR_64BIT)) == (MSR_IR|MSR_64BIT)) {
646 bp = in_breakpoint_table(regs->nip, &offset);
647 if (bp != NULL) {
648 regs->nip = bp->address + offset;
649 atomic_dec(&bp->ref_count);
650 }
651 }
652
653 return 0;
654}
655
656static struct bpt *at_breakpoint(unsigned long pc)
657{
658 int i;
659 struct bpt *bp;
660
661 bp = bpts;
662 for (i = 0; i < NBPTS; ++i, ++bp)
663 if (bp->enabled && pc == bp->address)
664 return bp;
665 return NULL;
666}
667
668static struct bpt *in_breakpoint_table(unsigned long nip, unsigned long *offp)
669{
670 unsigned long off;
671
672 off = nip - (unsigned long) bpts;
673 if (off >= sizeof(bpts))
674 return NULL;
675 off %= sizeof(struct bpt);
676 if (off != offsetof(struct bpt, instr[0])
677 && off != offsetof(struct bpt, instr[1]))
678 return NULL;
679 *offp = off - offsetof(struct bpt, instr[0]);
680 return (struct bpt *) (nip - off);
681}
682
683static struct bpt *new_breakpoint(unsigned long a)
684{
685 struct bpt *bp;
686
687 a &= ~3UL;
688 bp = at_breakpoint(a);
689 if (bp)
690 return bp;
691
692 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
693 if (!bp->enabled && atomic_read(&bp->ref_count) == 0) {
694 bp->address = a;
695 bp->instr[1] = bpinstr;
696 store_inst(&bp->instr[1]);
697 return bp;
698 }
699 }
700
701 printf("Sorry, no free breakpoints. Please clear one first.\n");
702 return NULL;
703}
704
705static void insert_bpts(void)
706{
707 int i;
708 struct bpt *bp;
709
710 bp = bpts;
711 for (i = 0; i < NBPTS; ++i, ++bp) {
712 if ((bp->enabled & (BP_TRAP|BP_IABR)) == 0)
713 continue;
714 if (mread(bp->address, &bp->instr[0], 4) != 4) {
715 printf("Couldn't read instruction at %lx, "
716 "disabling breakpoint there\n", bp->address);
717 bp->enabled = 0;
718 continue;
719 }
720 if (IS_MTMSRD(bp->instr[0]) || IS_RFID(bp->instr[0])) {
721 printf("Breakpoint at %lx is on an mtmsrd or rfid "
722 "instruction, disabling it\n", bp->address);
723 bp->enabled = 0;
724 continue;
725 }
726 store_inst(&bp->instr[0]);
727 if (bp->enabled & BP_IABR)
728 continue;
729 if (mwrite(bp->address, &bpinstr, 4) != 4) {
730 printf("Couldn't write instruction at %lx, "
731 "disabling breakpoint there\n", bp->address);
732 bp->enabled &= ~BP_TRAP;
733 continue;
734 }
735 store_inst((void *)bp->address);
736 }
737}
738
739static void insert_cpu_bpts(void)
740{
741 if (dabr.enabled)
742 set_dabr(dabr.address | (dabr.enabled & 7));
743 if (iabr && cpu_has_feature(CPU_FTR_IABR))
744 mtspr(SPRN_IABR, iabr->address
745 | (iabr->enabled & (BP_IABR|BP_IABR_TE)));
746}
747
748static void remove_bpts(void)
749{
750 int i;
751 struct bpt *bp;
752 unsigned instr;
753
754 bp = bpts;
755 for (i = 0; i < NBPTS; ++i, ++bp) {
756 if ((bp->enabled & (BP_TRAP|BP_IABR)) != BP_TRAP)
757 continue;
758 if (mread(bp->address, &instr, 4) == 4
759 && instr == bpinstr
760 && mwrite(bp->address, &bp->instr, 4) != 4)
761 printf("Couldn't remove breakpoint at %lx\n",
762 bp->address);
763 else
764 store_inst((void *)bp->address);
765 }
766}
767
768static void remove_cpu_bpts(void)
769{
770 set_dabr(0);
771 if (cpu_has_feature(CPU_FTR_IABR))
772 mtspr(SPRN_IABR, 0);
773}
774
775/* Command interpreting routine */
776static char *last_cmd;
777
778static int
779cmds(struct pt_regs *excp)
780{
781 int cmd = 0;
782
783 last_cmd = NULL;
784 xmon_regs = excp;
785
786 if (!xmon_no_auto_backtrace) {
787 xmon_no_auto_backtrace = 1;
788 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
789 }
790
791 for(;;) {
792#ifdef CONFIG_SMP
793 printf("%x:", smp_processor_id());
794#endif /* CONFIG_SMP */
795 printf("mon> ");
796 flush_input();
797 termch = 0;
798 cmd = skipbl();
799 if( cmd == '\n' ) {
800 if (last_cmd == NULL)
801 continue;
802 take_input(last_cmd);
803 last_cmd = NULL;
804 cmd = inchar();
805 }
806 switch (cmd) {
807 case 'm':
808 cmd = inchar();
809 switch (cmd) {
810 case 'm':
811 case 's':
812 case 'd':
813 memops(cmd);
814 break;
815 case 'l':
816 memlocate();
817 break;
818 case 'z':
819 memzcan();
820 break;
821 case 'i':
822 show_mem(0);
823 break;
824 default:
825 termch = cmd;
826 memex();
827 }
828 break;
829 case 'd':
830 dump();
831 break;
832 case 'l':
833 symbol_lookup();
834 break;
835 case 'r':
836 prregs(excp); /* print regs */
837 break;
838 case 'e':
839 excprint(excp);
840 break;
841 case 'S':
842 super_regs();
843 break;
844 case 't':
845 backtrace(excp);
846 break;
847 case 'f':
848 cacheflush();
849 break;
850 case 's':
851 if (do_spu_cmd() == 0)
852 break;
853 if (do_step(excp))
854 return cmd;
855 break;
856 case 'x':
857 case 'X':
858 return cmd;
859 case EOF:
860 printf(" <no input ...>\n");
861 mdelay(2000);
862 return cmd;
863 case '?':
864 xmon_puts(help_string);
865 break;
866 case 'b':
867 bpt_cmds();
868 break;
869 case 'C':
870 csum();
871 break;
872 case 'c':
873 if (cpu_cmd())
874 return 0;
875 break;
876 case 'z':
877 bootcmds();
878 break;
879 case 'p':
880 proccall();
881 break;
882#ifdef CONFIG_PPC_STD_MMU
883 case 'u':
884 dump_segments();
885 break;
886#elif defined(CONFIG_4xx)
887 case 'u':
888 dump_tlb_44x();
889 break;
890#elif defined(CONFIG_PPC_BOOK3E)
891 case 'u':
892 dump_tlb_book3e();
893 break;
894#endif
895 default:
896 printf("Unrecognized command: ");
897 do {
898 if (' ' < cmd && cmd <= '~')
899 putchar(cmd);
900 else
901 printf("\\x%x", cmd);
902 cmd = inchar();
903 } while (cmd != '\n');
904 printf(" (type ? for help)\n");
905 break;
906 }
907 }
908}
909
910#ifdef CONFIG_BOOKE
911static int do_step(struct pt_regs *regs)
912{
913 regs->msr |= MSR_DE;
914 mtspr(SPRN_DBCR0, mfspr(SPRN_DBCR0) | DBCR0_IC | DBCR0_IDM);
915 return 1;
916}
917#else
918/*
919 * Step a single instruction.
920 * Some instructions we emulate, others we execute with MSR_SE set.
921 */
922static int do_step(struct pt_regs *regs)
923{
924 unsigned int instr;
925 int stepped;
926
927 /* check we are in 64-bit kernel mode, translation enabled */
928 if ((regs->msr & (MSR_64BIT|MSR_PR|MSR_IR)) == (MSR_64BIT|MSR_IR)) {
929 if (mread(regs->nip, &instr, 4) == 4) {
930 stepped = emulate_step(regs, instr);
931 if (stepped < 0) {
932 printf("Couldn't single-step %s instruction\n",
933 (IS_RFID(instr)? "rfid": "mtmsrd"));
934 return 0;
935 }
936 if (stepped > 0) {
937 regs->trap = 0xd00 | (regs->trap & 1);
938 printf("stepped to ");
939 xmon_print_symbol(regs->nip, " ", "\n");
940 ppc_inst_dump(regs->nip, 1, 0);
941 return 0;
942 }
943 }
944 }
945 regs->msr |= MSR_SE;
946 return 1;
947}
948#endif
949
950static void bootcmds(void)
951{
952 int cmd;
953
954 cmd = inchar();
955 if (cmd == 'r')
956 ppc_md.restart(NULL);
957 else if (cmd == 'h')
958 ppc_md.halt();
959 else if (cmd == 'p')
960 ppc_md.power_off();
961}
962
963static int cpu_cmd(void)
964{
965#ifdef CONFIG_SMP
966 unsigned long cpu;
967 int timeout;
968 int count;
969
970 if (!scanhex(&cpu)) {
971 /* print cpus waiting or in xmon */
972 printf("cpus stopped:");
973 count = 0;
974 for_each_possible_cpu(cpu) {
975 if (cpumask_test_cpu(cpu, &cpus_in_xmon)) {
976 if (count == 0)
977 printf(" %x", cpu);
978 ++count;
979 } else {
980 if (count > 1)
981 printf("-%x", cpu - 1);
982 count = 0;
983 }
984 }
985 if (count > 1)
986 printf("-%x", NR_CPUS - 1);
987 printf("\n");
988 return 0;
989 }
990 /* try to switch to cpu specified */
991 if (!cpumask_test_cpu(cpu, &cpus_in_xmon)) {
992 printf("cpu 0x%x isn't in xmon\n", cpu);
993 return 0;
994 }
995 xmon_taken = 0;
996 mb();
997 xmon_owner = cpu;
998 timeout = 10000000;
999 while (!xmon_taken) {
1000 if (--timeout == 0) {
1001 if (test_and_set_bit(0, &xmon_taken))
1002 break;
1003 /* take control back */
1004 mb();
1005 xmon_owner = smp_processor_id();
1006 printf("cpu %u didn't take control\n", cpu);
1007 return 0;
1008 }
1009 barrier();
1010 }
1011 return 1;
1012#else
1013 return 0;
1014#endif /* CONFIG_SMP */
1015}
1016
1017static unsigned short fcstab[256] = {
1018 0x0000, 0x1189, 0x2312, 0x329b, 0x4624, 0x57ad, 0x6536, 0x74bf,
1019 0x8c48, 0x9dc1, 0xaf5a, 0xbed3, 0xca6c, 0xdbe5, 0xe97e, 0xf8f7,
1020 0x1081, 0x0108, 0x3393, 0x221a, 0x56a5, 0x472c, 0x75b7, 0x643e,
1021 0x9cc9, 0x8d40, 0xbfdb, 0xae52, 0xdaed, 0xcb64, 0xf9ff, 0xe876,
1022 0x2102, 0x308b, 0x0210, 0x1399, 0x6726, 0x76af, 0x4434, 0x55bd,
1023 0xad4a, 0xbcc3, 0x8e58, 0x9fd1, 0xeb6e, 0xfae7, 0xc87c, 0xd9f5,
1024 0x3183, 0x200a, 0x1291, 0x0318, 0x77a7, 0x662e, 0x54b5, 0x453c,
1025 0xbdcb, 0xac42, 0x9ed9, 0x8f50, 0xfbef, 0xea66, 0xd8fd, 0xc974,
1026 0x4204, 0x538d, 0x6116, 0x709f, 0x0420, 0x15a9, 0x2732, 0x36bb,
1027 0xce4c, 0xdfc5, 0xed5e, 0xfcd7, 0x8868, 0x99e1, 0xab7a, 0xbaf3,
1028 0x5285, 0x430c, 0x7197, 0x601e, 0x14a1, 0x0528, 0x37b3, 0x263a,
1029 0xdecd, 0xcf44, 0xfddf, 0xec56, 0x98e9, 0x8960, 0xbbfb, 0xaa72,
1030 0x6306, 0x728f, 0x4014, 0x519d, 0x2522, 0x34ab, 0x0630, 0x17b9,
1031 0xef4e, 0xfec7, 0xcc5c, 0xddd5, 0xa96a, 0xb8e3, 0x8a78, 0x9bf1,
1032 0x7387, 0x620e, 0x5095, 0x411c, 0x35a3, 0x242a, 0x16b1, 0x0738,
1033 0xffcf, 0xee46, 0xdcdd, 0xcd54, 0xb9eb, 0xa862, 0x9af9, 0x8b70,
1034 0x8408, 0x9581, 0xa71a, 0xb693, 0xc22c, 0xd3a5, 0xe13e, 0xf0b7,
1035 0x0840, 0x19c9, 0x2b52, 0x3adb, 0x4e64, 0x5fed, 0x6d76, 0x7cff,
1036 0x9489, 0x8500, 0xb79b, 0xa612, 0xd2ad, 0xc324, 0xf1bf, 0xe036,
1037 0x18c1, 0x0948, 0x3bd3, 0x2a5a, 0x5ee5, 0x4f6c, 0x7df7, 0x6c7e,
1038 0xa50a, 0xb483, 0x8618, 0x9791, 0xe32e, 0xf2a7, 0xc03c, 0xd1b5,
1039 0x2942, 0x38cb, 0x0a50, 0x1bd9, 0x6f66, 0x7eef, 0x4c74, 0x5dfd,
1040 0xb58b, 0xa402, 0x9699, 0x8710, 0xf3af, 0xe226, 0xd0bd, 0xc134,
1041 0x39c3, 0x284a, 0x1ad1, 0x0b58, 0x7fe7, 0x6e6e, 0x5cf5, 0x4d7c,
1042 0xc60c, 0xd785, 0xe51e, 0xf497, 0x8028, 0x91a1, 0xa33a, 0xb2b3,
1043 0x4a44, 0x5bcd, 0x6956, 0x78df, 0x0c60, 0x1de9, 0x2f72, 0x3efb,
1044 0xd68d, 0xc704, 0xf59f, 0xe416, 0x90a9, 0x8120, 0xb3bb, 0xa232,
1045 0x5ac5, 0x4b4c, 0x79d7, 0x685e, 0x1ce1, 0x0d68, 0x3ff3, 0x2e7a,
1046 0xe70e, 0xf687, 0xc41c, 0xd595, 0xa12a, 0xb0a3, 0x8238, 0x93b1,
1047 0x6b46, 0x7acf, 0x4854, 0x59dd, 0x2d62, 0x3ceb, 0x0e70, 0x1ff9,
1048 0xf78f, 0xe606, 0xd49d, 0xc514, 0xb1ab, 0xa022, 0x92b9, 0x8330,
1049 0x7bc7, 0x6a4e, 0x58d5, 0x495c, 0x3de3, 0x2c6a, 0x1ef1, 0x0f78
1050};
1051
1052#define FCS(fcs, c) (((fcs) >> 8) ^ fcstab[((fcs) ^ (c)) & 0xff])
1053
1054static void
1055csum(void)
1056{
1057 unsigned int i;
1058 unsigned short fcs;
1059 unsigned char v;
1060
1061 if (!scanhex(&adrs))
1062 return;
1063 if (!scanhex(&ncsum))
1064 return;
1065 fcs = 0xffff;
1066 for (i = 0; i < ncsum; ++i) {
1067 if (mread(adrs+i, &v, 1) == 0) {
1068 printf("csum stopped at %x\n", adrs+i);
1069 break;
1070 }
1071 fcs = FCS(fcs, v);
1072 }
1073 printf("%x\n", fcs);
1074}
1075
1076/*
1077 * Check if this is a suitable place to put a breakpoint.
1078 */
1079static long check_bp_loc(unsigned long addr)
1080{
1081 unsigned int instr;
1082
1083 addr &= ~3;
1084 if (!is_kernel_addr(addr)) {
1085 printf("Breakpoints may only be placed at kernel addresses\n");
1086 return 0;
1087 }
1088 if (!mread(addr, &instr, sizeof(instr))) {
1089 printf("Can't read instruction at address %lx\n", addr);
1090 return 0;
1091 }
1092 if (IS_MTMSRD(instr) || IS_RFID(instr)) {
1093 printf("Breakpoints may not be placed on mtmsrd or rfid "
1094 "instructions\n");
1095 return 0;
1096 }
1097 return 1;
1098}
1099
1100static char *breakpoint_help_string =
1101 "Breakpoint command usage:\n"
1102 "b show breakpoints\n"
1103 "b <addr> [cnt] set breakpoint at given instr addr\n"
1104 "bc clear all breakpoints\n"
1105 "bc <n/addr> clear breakpoint number n or at addr\n"
1106 "bi <addr> [cnt] set hardware instr breakpoint (POWER3/RS64 only)\n"
1107 "bd <addr> [cnt] set hardware data breakpoint\n"
1108 "";
1109
1110static void
1111bpt_cmds(void)
1112{
1113 int cmd;
1114 unsigned long a;
1115 int mode, i;
1116 struct bpt *bp;
1117 const char badaddr[] = "Only kernel addresses are permitted "
1118 "for breakpoints\n";
1119
1120 cmd = inchar();
1121 switch (cmd) {
1122#ifndef CONFIG_8xx
1123 case 'd': /* bd - hardware data breakpoint */
1124 mode = 7;
1125 cmd = inchar();
1126 if (cmd == 'r')
1127 mode = 5;
1128 else if (cmd == 'w')
1129 mode = 6;
1130 else
1131 termch = cmd;
1132 dabr.address = 0;
1133 dabr.enabled = 0;
1134 if (scanhex(&dabr.address)) {
1135 if (!is_kernel_addr(dabr.address)) {
1136 printf(badaddr);
1137 break;
1138 }
1139 dabr.address &= ~7;
1140 dabr.enabled = mode | BP_DABR;
1141 }
1142 break;
1143
1144 case 'i': /* bi - hardware instr breakpoint */
1145 if (!cpu_has_feature(CPU_FTR_IABR)) {
1146 printf("Hardware instruction breakpoint "
1147 "not supported on this cpu\n");
1148 break;
1149 }
1150 if (iabr) {
1151 iabr->enabled &= ~(BP_IABR | BP_IABR_TE);
1152 iabr = NULL;
1153 }
1154 if (!scanhex(&a))
1155 break;
1156 if (!check_bp_loc(a))
1157 break;
1158 bp = new_breakpoint(a);
1159 if (bp != NULL) {
1160 bp->enabled |= BP_IABR | BP_IABR_TE;
1161 iabr = bp;
1162 }
1163 break;
1164#endif
1165
1166 case 'c':
1167 if (!scanhex(&a)) {
1168 /* clear all breakpoints */
1169 for (i = 0; i < NBPTS; ++i)
1170 bpts[i].enabled = 0;
1171 iabr = NULL;
1172 dabr.enabled = 0;
1173 printf("All breakpoints cleared\n");
1174 break;
1175 }
1176
1177 if (a <= NBPTS && a >= 1) {
1178 /* assume a breakpoint number */
1179 bp = &bpts[a-1]; /* bp nums are 1 based */
1180 } else {
1181 /* assume a breakpoint address */
1182 bp = at_breakpoint(a);
1183 if (bp == NULL) {
1184 printf("No breakpoint at %x\n", a);
1185 break;
1186 }
1187 }
1188
1189 printf("Cleared breakpoint %x (", BP_NUM(bp));
1190 xmon_print_symbol(bp->address, " ", ")\n");
1191 bp->enabled = 0;
1192 break;
1193
1194 default:
1195 termch = cmd;
1196 cmd = skipbl();
1197 if (cmd == '?') {
1198 printf(breakpoint_help_string);
1199 break;
1200 }
1201 termch = cmd;
1202 if (!scanhex(&a)) {
1203 /* print all breakpoints */
1204 printf(" type address\n");
1205 if (dabr.enabled) {
1206 printf(" data "REG" [", dabr.address);
1207 if (dabr.enabled & 1)
1208 printf("r");
1209 if (dabr.enabled & 2)
1210 printf("w");
1211 printf("]\n");
1212 }
1213 for (bp = bpts; bp < &bpts[NBPTS]; ++bp) {
1214 if (!bp->enabled)
1215 continue;
1216 printf("%2x %s ", BP_NUM(bp),
1217 (bp->enabled & BP_IABR)? "inst": "trap");
1218 xmon_print_symbol(bp->address, " ", "\n");
1219 }
1220 break;
1221 }
1222
1223 if (!check_bp_loc(a))
1224 break;
1225 bp = new_breakpoint(a);
1226 if (bp != NULL)
1227 bp->enabled |= BP_TRAP;
1228 break;
1229 }
1230}
1231
1232/* Very cheap human name for vector lookup. */
1233static
1234const char *getvecname(unsigned long vec)
1235{
1236 char *ret;
1237
1238 switch (vec) {
1239 case 0x100: ret = "(System Reset)"; break;
1240 case 0x200: ret = "(Machine Check)"; break;
1241 case 0x300: ret = "(Data Access)"; break;
1242 case 0x380: ret = "(Data SLB Access)"; break;
1243 case 0x400: ret = "(Instruction Access)"; break;
1244 case 0x480: ret = "(Instruction SLB Access)"; break;
1245 case 0x500: ret = "(Hardware Interrupt)"; break;
1246 case 0x600: ret = "(Alignment)"; break;
1247 case 0x700: ret = "(Program Check)"; break;
1248 case 0x800: ret = "(FPU Unavailable)"; break;
1249 case 0x900: ret = "(Decrementer)"; break;
1250 case 0xc00: ret = "(System Call)"; break;
1251 case 0xd00: ret = "(Single Step)"; break;
1252 case 0xf00: ret = "(Performance Monitor)"; break;
1253 case 0xf20: ret = "(Altivec Unavailable)"; break;
1254 case 0x1300: ret = "(Instruction Breakpoint)"; break;
1255 default: ret = "";
1256 }
1257 return ret;
1258}
1259
1260static void get_function_bounds(unsigned long pc, unsigned long *startp,
1261 unsigned long *endp)
1262{
1263 unsigned long size, offset;
1264 const char *name;
1265
1266 *startp = *endp = 0;
1267 if (pc == 0)
1268 return;
1269 if (setjmp(bus_error_jmp) == 0) {
1270 catch_memory_errors = 1;
1271 sync();
1272 name = kallsyms_lookup(pc, &size, &offset, NULL, tmpstr);
1273 if (name != NULL) {
1274 *startp = pc - offset;
1275 *endp = pc - offset + size;
1276 }
1277 sync();
1278 }
1279 catch_memory_errors = 0;
1280}
1281
1282static int xmon_depth_to_print = 64;
1283
1284#define LRSAVE_OFFSET (STACK_FRAME_LR_SAVE * sizeof(unsigned long))
1285#define MARKER_OFFSET (STACK_FRAME_MARKER * sizeof(unsigned long))
1286
1287#ifdef __powerpc64__
1288#define REGS_OFFSET 0x70
1289#else
1290#define REGS_OFFSET 16
1291#endif
1292
1293static void xmon_show_stack(unsigned long sp, unsigned long lr,
1294 unsigned long pc)
1295{
1296 unsigned long ip;
1297 unsigned long newsp;
1298 unsigned long marker;
1299 int count = 0;
1300 struct pt_regs regs;
1301
1302 do {
1303 if (sp < PAGE_OFFSET) {
1304 if (sp != 0)
1305 printf("SP (%lx) is in userspace\n", sp);
1306 break;
1307 }
1308
1309 if (!mread(sp + LRSAVE_OFFSET, &ip, sizeof(unsigned long))
1310 || !mread(sp, &newsp, sizeof(unsigned long))) {
1311 printf("Couldn't read stack frame at %lx\n", sp);
1312 break;
1313 }
1314
1315 /*
1316 * For the first stack frame, try to work out if
1317 * LR and/or the saved LR value in the bottommost
1318 * stack frame are valid.
1319 */
1320 if ((pc | lr) != 0) {
1321 unsigned long fnstart, fnend;
1322 unsigned long nextip;
1323 int printip = 1;
1324
1325 get_function_bounds(pc, &fnstart, &fnend);
1326 nextip = 0;
1327 if (newsp > sp)
1328 mread(newsp + LRSAVE_OFFSET, &nextip,
1329 sizeof(unsigned long));
1330 if (lr == ip) {
1331 if (lr < PAGE_OFFSET
1332 || (fnstart <= lr && lr < fnend))
1333 printip = 0;
1334 } else if (lr == nextip) {
1335 printip = 0;
1336 } else if (lr >= PAGE_OFFSET
1337 && !(fnstart <= lr && lr < fnend)) {
1338 printf("[link register ] ");
1339 xmon_print_symbol(lr, " ", "\n");
1340 }
1341 if (printip) {
1342 printf("["REG"] ", sp);
1343 xmon_print_symbol(ip, " ", " (unreliable)\n");
1344 }
1345 pc = lr = 0;
1346
1347 } else {
1348 printf("["REG"] ", sp);
1349 xmon_print_symbol(ip, " ", "\n");
1350 }
1351
1352 /* Look for "regshere" marker to see if this is
1353 an exception frame. */
1354 if (mread(sp + MARKER_OFFSET, &marker, sizeof(unsigned long))
1355 && marker == STACK_FRAME_REGS_MARKER) {
1356 if (mread(sp + REGS_OFFSET, ®s, sizeof(regs))
1357 != sizeof(regs)) {
1358 printf("Couldn't read registers at %lx\n",
1359 sp + REGS_OFFSET);
1360 break;
1361 }
1362 printf("--- Exception: %lx %s at ", regs.trap,
1363 getvecname(TRAP(®s)));
1364 pc = regs.nip;
1365 lr = regs.link;
1366 xmon_print_symbol(pc, " ", "\n");
1367 }
1368
1369 if (newsp == 0)
1370 break;
1371
1372 sp = newsp;
1373 } while (count++ < xmon_depth_to_print);
1374}
1375
1376static void backtrace(struct pt_regs *excp)
1377{
1378 unsigned long sp;
1379
1380 if (scanhex(&sp))
1381 xmon_show_stack(sp, 0, 0);
1382 else
1383 xmon_show_stack(excp->gpr[1], excp->link, excp->nip);
1384 scannl();
1385}
1386
1387static void print_bug_trap(struct pt_regs *regs)
1388{
1389#ifdef CONFIG_BUG
1390 const struct bug_entry *bug;
1391 unsigned long addr;
1392
1393 if (regs->msr & MSR_PR)
1394 return; /* not in kernel */
1395 addr = regs->nip; /* address of trap instruction */
1396 if (addr < PAGE_OFFSET)
1397 return;
1398 bug = find_bug(regs->nip);
1399 if (bug == NULL)
1400 return;
1401 if (is_warning_bug(bug))
1402 return;
1403
1404#ifdef CONFIG_DEBUG_BUGVERBOSE
1405 printf("kernel BUG at %s:%u!\n",
1406 bug->file, bug->line);
1407#else
1408 printf("kernel BUG at %p!\n", (void *)bug->bug_addr);
1409#endif
1410#endif /* CONFIG_BUG */
1411}
1412
1413static void excprint(struct pt_regs *fp)
1414{
1415 unsigned long trap;
1416
1417#ifdef CONFIG_SMP
1418 printf("cpu 0x%x: ", smp_processor_id());
1419#endif /* CONFIG_SMP */
1420
1421 trap = TRAP(fp);
1422 printf("Vector: %lx %s at [%lx]\n", fp->trap, getvecname(trap), fp);
1423 printf(" pc: ");
1424 xmon_print_symbol(fp->nip, ": ", "\n");
1425
1426 printf(" lr: ", fp->link);
1427 xmon_print_symbol(fp->link, ": ", "\n");
1428
1429 printf(" sp: %lx\n", fp->gpr[1]);
1430 printf(" msr: %lx\n", fp->msr);
1431
1432 if (trap == 0x300 || trap == 0x380 || trap == 0x600) {
1433 printf(" dar: %lx\n", fp->dar);
1434 if (trap != 0x380)
1435 printf(" dsisr: %lx\n", fp->dsisr);
1436 }
1437
1438 printf(" current = 0x%lx\n", current);
1439#ifdef CONFIG_PPC64
1440 printf(" paca = 0x%lx\t softe: %d\t irq_happened: 0x%02x\n",
1441 local_paca, local_paca->soft_enabled, local_paca->irq_happened);
1442#endif
1443 if (current) {
1444 printf(" pid = %ld, comm = %s\n",
1445 current->pid, current->comm);
1446 }
1447
1448 if (trap == 0x700)
1449 print_bug_trap(fp);
1450}
1451
1452static void prregs(struct pt_regs *fp)
1453{
1454 int n, trap;
1455 unsigned long base;
1456 struct pt_regs regs;
1457
1458 if (scanhex(&base)) {
1459 if (setjmp(bus_error_jmp) == 0) {
1460 catch_memory_errors = 1;
1461 sync();
1462 regs = *(struct pt_regs *)base;
1463 sync();
1464 __delay(200);
1465 } else {
1466 catch_memory_errors = 0;
1467 printf("*** Error reading registers from "REG"\n",
1468 base);
1469 return;
1470 }
1471 catch_memory_errors = 0;
1472 fp = ®s;
1473 }
1474
1475#ifdef CONFIG_PPC64
1476 if (FULL_REGS(fp)) {
1477 for (n = 0; n < 16; ++n)
1478 printf("R%.2ld = "REG" R%.2ld = "REG"\n",
1479 n, fp->gpr[n], n+16, fp->gpr[n+16]);
1480 } else {
1481 for (n = 0; n < 7; ++n)
1482 printf("R%.2ld = "REG" R%.2ld = "REG"\n",
1483 n, fp->gpr[n], n+7, fp->gpr[n+7]);
1484 }
1485#else
1486 for (n = 0; n < 32; ++n) {
1487 printf("R%.2d = %.8x%s", n, fp->gpr[n],
1488 (n & 3) == 3? "\n": " ");
1489 if (n == 12 && !FULL_REGS(fp)) {
1490 printf("\n");
1491 break;
1492 }
1493 }
1494#endif
1495 printf("pc = ");
1496 xmon_print_symbol(fp->nip, " ", "\n");
1497 if (TRAP(fp) != 0xc00 && cpu_has_feature(CPU_FTR_CFAR)) {
1498 printf("cfar= ");
1499 xmon_print_symbol(fp->orig_gpr3, " ", "\n");
1500 }
1501 printf("lr = ");
1502 xmon_print_symbol(fp->link, " ", "\n");
1503 printf("msr = "REG" cr = %.8lx\n", fp->msr, fp->ccr);
1504 printf("ctr = "REG" xer = "REG" trap = %4lx\n",
1505 fp->ctr, fp->xer, fp->trap);
1506 trap = TRAP(fp);
1507 if (trap == 0x300 || trap == 0x380 || trap == 0x600)
1508 printf("dar = "REG" dsisr = %.8lx\n", fp->dar, fp->dsisr);
1509}
1510
1511static void cacheflush(void)
1512{
1513 int cmd;
1514 unsigned long nflush;
1515
1516 cmd = inchar();
1517 if (cmd != 'i')
1518 termch = cmd;
1519 scanhex((void *)&adrs);
1520 if (termch != '\n')
1521 termch = 0;
1522 nflush = 1;
1523 scanhex(&nflush);
1524 nflush = (nflush + L1_CACHE_BYTES - 1) / L1_CACHE_BYTES;
1525 if (setjmp(bus_error_jmp) == 0) {
1526 catch_memory_errors = 1;
1527 sync();
1528
1529 if (cmd != 'i') {
1530 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1531 cflush((void *) adrs);
1532 } else {
1533 for (; nflush > 0; --nflush, adrs += L1_CACHE_BYTES)
1534 cinval((void *) adrs);
1535 }
1536 sync();
1537 /* wait a little while to see if we get a machine check */
1538 __delay(200);
1539 }
1540 catch_memory_errors = 0;
1541}
1542
1543static unsigned long
1544read_spr(int n)
1545{
1546 unsigned int instrs[2];
1547 unsigned long (*code)(void);
1548 unsigned long ret = -1UL;
1549#ifdef CONFIG_PPC64
1550 unsigned long opd[3];
1551
1552 opd[0] = (unsigned long)instrs;
1553 opd[1] = 0;
1554 opd[2] = 0;
1555 code = (unsigned long (*)(void)) opd;
1556#else
1557 code = (unsigned long (*)(void)) instrs;
1558#endif
1559
1560 /* mfspr r3,n; blr */
1561 instrs[0] = 0x7c6002a6 + ((n & 0x1F) << 16) + ((n & 0x3e0) << 6);
1562 instrs[1] = 0x4e800020;
1563 store_inst(instrs);
1564 store_inst(instrs+1);
1565
1566 if (setjmp(bus_error_jmp) == 0) {
1567 catch_memory_errors = 1;
1568 sync();
1569
1570 ret = code();
1571
1572 sync();
1573 /* wait a little while to see if we get a machine check */
1574 __delay(200);
1575 n = size;
1576 }
1577
1578 return ret;
1579}
1580
1581static void
1582write_spr(int n, unsigned long val)
1583{
1584 unsigned int instrs[2];
1585 unsigned long (*code)(unsigned long);
1586#ifdef CONFIG_PPC64
1587 unsigned long opd[3];
1588
1589 opd[0] = (unsigned long)instrs;
1590 opd[1] = 0;
1591 opd[2] = 0;
1592 code = (unsigned long (*)(unsigned long)) opd;
1593#else
1594 code = (unsigned long (*)(unsigned long)) instrs;
1595#endif
1596
1597 instrs[0] = 0x7c6003a6 + ((n & 0x1F) << 16) + ((n & 0x3e0) << 6);
1598 instrs[1] = 0x4e800020;
1599 store_inst(instrs);
1600 store_inst(instrs+1);
1601
1602 if (setjmp(bus_error_jmp) == 0) {
1603 catch_memory_errors = 1;
1604 sync();
1605
1606 code(val);
1607
1608 sync();
1609 /* wait a little while to see if we get a machine check */
1610 __delay(200);
1611 n = size;
1612 }
1613}
1614
1615static unsigned long regno;
1616extern char exc_prolog;
1617extern char dec_exc;
1618
1619static void super_regs(void)
1620{
1621 int cmd;
1622 unsigned long val;
1623
1624 cmd = skipbl();
1625 if (cmd == '\n') {
1626 unsigned long sp, toc;
1627 asm("mr %0,1" : "=r" (sp) :);
1628 asm("mr %0,2" : "=r" (toc) :);
1629
1630 printf("msr = "REG" sprg0= "REG"\n",
1631 mfmsr(), mfspr(SPRN_SPRG0));
1632 printf("pvr = "REG" sprg1= "REG"\n",
1633 mfspr(SPRN_PVR), mfspr(SPRN_SPRG1));
1634 printf("dec = "REG" sprg2= "REG"\n",
1635 mfspr(SPRN_DEC), mfspr(SPRN_SPRG2));
1636 printf("sp = "REG" sprg3= "REG"\n", sp, mfspr(SPRN_SPRG3));
1637 printf("toc = "REG" dar = "REG"\n", toc, mfspr(SPRN_DAR));
1638
1639 return;
1640 }
1641
1642 scanhex(®no);
1643 switch (cmd) {
1644 case 'w':
1645 val = read_spr(regno);
1646 scanhex(&val);
1647 write_spr(regno, val);
1648 /* fall through */
1649 case 'r':
1650 printf("spr %lx = %lx\n", regno, read_spr(regno));
1651 break;
1652 }
1653 scannl();
1654}
1655
1656/*
1657 * Stuff for reading and writing memory safely
1658 */
1659static int
1660mread(unsigned long adrs, void *buf, int size)
1661{
1662 volatile int n;
1663 char *p, *q;
1664
1665 n = 0;
1666 if (setjmp(bus_error_jmp) == 0) {
1667 catch_memory_errors = 1;
1668 sync();
1669 p = (char *)adrs;
1670 q = (char *)buf;
1671 switch (size) {
1672 case 2:
1673 *(u16 *)q = *(u16 *)p;
1674 break;
1675 case 4:
1676 *(u32 *)q = *(u32 *)p;
1677 break;
1678 case 8:
1679 *(u64 *)q = *(u64 *)p;
1680 break;
1681 default:
1682 for( ; n < size; ++n) {
1683 *q++ = *p++;
1684 sync();
1685 }
1686 }
1687 sync();
1688 /* wait a little while to see if we get a machine check */
1689 __delay(200);
1690 n = size;
1691 }
1692 catch_memory_errors = 0;
1693 return n;
1694}
1695
1696static int
1697mwrite(unsigned long adrs, void *buf, int size)
1698{
1699 volatile int n;
1700 char *p, *q;
1701
1702 n = 0;
1703 if (setjmp(bus_error_jmp) == 0) {
1704 catch_memory_errors = 1;
1705 sync();
1706 p = (char *) adrs;
1707 q = (char *) buf;
1708 switch (size) {
1709 case 2:
1710 *(u16 *)p = *(u16 *)q;
1711 break;
1712 case 4:
1713 *(u32 *)p = *(u32 *)q;
1714 break;
1715 case 8:
1716 *(u64 *)p = *(u64 *)q;
1717 break;
1718 default:
1719 for ( ; n < size; ++n) {
1720 *p++ = *q++;
1721 sync();
1722 }
1723 }
1724 sync();
1725 /* wait a little while to see if we get a machine check */
1726 __delay(200);
1727 n = size;
1728 } else {
1729 printf("*** Error writing address %x\n", adrs + n);
1730 }
1731 catch_memory_errors = 0;
1732 return n;
1733}
1734
1735static int fault_type;
1736static int fault_except;
1737static char *fault_chars[] = { "--", "**", "##" };
1738
1739static int handle_fault(struct pt_regs *regs)
1740{
1741 fault_except = TRAP(regs);
1742 switch (TRAP(regs)) {
1743 case 0x200:
1744 fault_type = 0;
1745 break;
1746 case 0x300:
1747 case 0x380:
1748 fault_type = 1;
1749 break;
1750 default:
1751 fault_type = 2;
1752 }
1753
1754 longjmp(bus_error_jmp, 1);
1755
1756 return 0;
1757}
1758
1759#define SWAP(a, b, t) ((t) = (a), (a) = (b), (b) = (t))
1760
1761static void
1762byterev(unsigned char *val, int size)
1763{
1764 int t;
1765
1766 switch (size) {
1767 case 2:
1768 SWAP(val[0], val[1], t);
1769 break;
1770 case 4:
1771 SWAP(val[0], val[3], t);
1772 SWAP(val[1], val[2], t);
1773 break;
1774 case 8: /* is there really any use for this? */
1775 SWAP(val[0], val[7], t);
1776 SWAP(val[1], val[6], t);
1777 SWAP(val[2], val[5], t);
1778 SWAP(val[3], val[4], t);
1779 break;
1780 }
1781}
1782
1783static int brev;
1784static int mnoread;
1785
1786static char *memex_help_string =
1787 "Memory examine command usage:\n"
1788 "m [addr] [flags] examine/change memory\n"
1789 " addr is optional. will start where left off.\n"
1790 " flags may include chars from this set:\n"
1791 " b modify by bytes (default)\n"
1792 " w modify by words (2 byte)\n"
1793 " l modify by longs (4 byte)\n"
1794 " d modify by doubleword (8 byte)\n"
1795 " r toggle reverse byte order mode\n"
1796 " n do not read memory (for i/o spaces)\n"
1797 " . ok to read (default)\n"
1798 "NOTE: flags are saved as defaults\n"
1799 "";
1800
1801static char *memex_subcmd_help_string =
1802 "Memory examine subcommands:\n"
1803 " hexval write this val to current location\n"
1804 " 'string' write chars from string to this location\n"
1805 " ' increment address\n"
1806 " ^ decrement address\n"
1807 " / increment addr by 0x10. //=0x100, ///=0x1000, etc\n"
1808 " \\ decrement addr by 0x10. \\\\=0x100, \\\\\\=0x1000, etc\n"
1809 " ` clear no-read flag\n"
1810 " ; stay at this addr\n"
1811 " v change to byte mode\n"
1812 " w change to word (2 byte) mode\n"
1813 " l change to long (4 byte) mode\n"
1814 " u change to doubleword (8 byte) mode\n"
1815 " m addr change current addr\n"
1816 " n toggle no-read flag\n"
1817 " r toggle byte reverse flag\n"
1818 " < count back up count bytes\n"
1819 " > count skip forward count bytes\n"
1820 " x exit this mode\n"
1821 "";
1822
1823static void
1824memex(void)
1825{
1826 int cmd, inc, i, nslash;
1827 unsigned long n;
1828 unsigned char val[16];
1829
1830 scanhex((void *)&adrs);
1831 cmd = skipbl();
1832 if (cmd == '?') {
1833 printf(memex_help_string);
1834 return;
1835 } else {
1836 termch = cmd;
1837 }
1838 last_cmd = "m\n";
1839 while ((cmd = skipbl()) != '\n') {
1840 switch( cmd ){
1841 case 'b': size = 1; break;
1842 case 'w': size = 2; break;
1843 case 'l': size = 4; break;
1844 case 'd': size = 8; break;
1845 case 'r': brev = !brev; break;
1846 case 'n': mnoread = 1; break;
1847 case '.': mnoread = 0; break;
1848 }
1849 }
1850 if( size <= 0 )
1851 size = 1;
1852 else if( size > 8 )
1853 size = 8;
1854 for(;;){
1855 if (!mnoread)
1856 n = mread(adrs, val, size);
1857 printf(REG"%c", adrs, brev? 'r': ' ');
1858 if (!mnoread) {
1859 if (brev)
1860 byterev(val, size);
1861 putchar(' ');
1862 for (i = 0; i < n; ++i)
1863 printf("%.2x", val[i]);
1864 for (; i < size; ++i)
1865 printf("%s", fault_chars[fault_type]);
1866 }
1867 putchar(' ');
1868 inc = size;
1869 nslash = 0;
1870 for(;;){
1871 if( scanhex(&n) ){
1872 for (i = 0; i < size; ++i)
1873 val[i] = n >> (i * 8);
1874 if (!brev)
1875 byterev(val, size);
1876 mwrite(adrs, val, size);
1877 inc = size;
1878 }
1879 cmd = skipbl();
1880 if (cmd == '\n')
1881 break;
1882 inc = 0;
1883 switch (cmd) {
1884 case '\'':
1885 for(;;){
1886 n = inchar();
1887 if( n == '\\' )
1888 n = bsesc();
1889 else if( n == '\'' )
1890 break;
1891 for (i = 0; i < size; ++i)
1892 val[i] = n >> (i * 8);
1893 if (!brev)
1894 byterev(val, size);
1895 mwrite(adrs, val, size);
1896 adrs += size;
1897 }
1898 adrs -= size;
1899 inc = size;
1900 break;
1901 case ',':
1902 adrs += size;
1903 break;
1904 case '.':
1905 mnoread = 0;
1906 break;
1907 case ';':
1908 break;
1909 case 'x':
1910 case EOF:
1911 scannl();
1912 return;
1913 case 'b':
1914 case 'v':
1915 size = 1;
1916 break;
1917 case 'w':
1918 size = 2;
1919 break;
1920 case 'l':
1921 size = 4;
1922 break;
1923 case 'u':
1924 size = 8;
1925 break;
1926 case '^':
1927 adrs -= size;
1928 break;
1929 break;
1930 case '/':
1931 if (nslash > 0)
1932 adrs -= 1 << nslash;
1933 else
1934 nslash = 0;
1935 nslash += 4;
1936 adrs += 1 << nslash;
1937 break;
1938 case '\\':
1939 if (nslash < 0)
1940 adrs += 1 << -nslash;
1941 else
1942 nslash = 0;
1943 nslash -= 4;
1944 adrs -= 1 << -nslash;
1945 break;
1946 case 'm':
1947 scanhex((void *)&adrs);
1948 break;
1949 case 'n':
1950 mnoread = 1;
1951 break;
1952 case 'r':
1953 brev = !brev;
1954 break;
1955 case '<':
1956 n = size;
1957 scanhex(&n);
1958 adrs -= n;
1959 break;
1960 case '>':
1961 n = size;
1962 scanhex(&n);
1963 adrs += n;
1964 break;
1965 case '?':
1966 printf(memex_subcmd_help_string);
1967 break;
1968 }
1969 }
1970 adrs += inc;
1971 }
1972}
1973
1974static int
1975bsesc(void)
1976{
1977 int c;
1978
1979 c = inchar();
1980 switch( c ){
1981 case 'n': c = '\n'; break;
1982 case 'r': c = '\r'; break;
1983 case 'b': c = '\b'; break;
1984 case 't': c = '\t'; break;
1985 }
1986 return c;
1987}
1988
1989static void xmon_rawdump (unsigned long adrs, long ndump)
1990{
1991 long n, m, r, nr;
1992 unsigned char temp[16];
1993
1994 for (n = ndump; n > 0;) {
1995 r = n < 16? n: 16;
1996 nr = mread(adrs, temp, r);
1997 adrs += nr;
1998 for (m = 0; m < r; ++m) {
1999 if (m < nr)
2000 printf("%.2x", temp[m]);
2001 else
2002 printf("%s", fault_chars[fault_type]);
2003 }
2004 n -= r;
2005 if (nr < r)
2006 break;
2007 }
2008 printf("\n");
2009}
2010
2011#define isxdigit(c) (('0' <= (c) && (c) <= '9') \
2012 || ('a' <= (c) && (c) <= 'f') \
2013 || ('A' <= (c) && (c) <= 'F'))
2014static void
2015dump(void)
2016{
2017 int c;
2018
2019 c = inchar();
2020 if ((isxdigit(c) && c != 'f' && c != 'd') || c == '\n')
2021 termch = c;
2022 scanhex((void *)&adrs);
2023 if (termch != '\n')
2024 termch = 0;
2025 if (c == 'i') {
2026 scanhex(&nidump);
2027 if (nidump == 0)
2028 nidump = 16;
2029 else if (nidump > MAX_DUMP)
2030 nidump = MAX_DUMP;
2031 adrs += ppc_inst_dump(adrs, nidump, 1);
2032 last_cmd = "di\n";
2033 } else if (c == 'l') {
2034 dump_log_buf();
2035 } else if (c == 'r') {
2036 scanhex(&ndump);
2037 if (ndump == 0)
2038 ndump = 64;
2039 xmon_rawdump(adrs, ndump);
2040 adrs += ndump;
2041 last_cmd = "dr\n";
2042 } else {
2043 scanhex(&ndump);
2044 if (ndump == 0)
2045 ndump = 64;
2046 else if (ndump > MAX_DUMP)
2047 ndump = MAX_DUMP;
2048 prdump(adrs, ndump);
2049 adrs += ndump;
2050 last_cmd = "d\n";
2051 }
2052}
2053
2054static void
2055prdump(unsigned long adrs, long ndump)
2056{
2057 long n, m, c, r, nr;
2058 unsigned char temp[16];
2059
2060 for (n = ndump; n > 0;) {
2061 printf(REG, adrs);
2062 putchar(' ');
2063 r = n < 16? n: 16;
2064 nr = mread(adrs, temp, r);
2065 adrs += nr;
2066 for (m = 0; m < r; ++m) {
2067 if ((m & (sizeof(long) - 1)) == 0 && m > 0)
2068 putchar(' ');
2069 if (m < nr)
2070 printf("%.2x", temp[m]);
2071 else
2072 printf("%s", fault_chars[fault_type]);
2073 }
2074 for (; m < 16; ++m) {
2075 if ((m & (sizeof(long) - 1)) == 0)
2076 putchar(' ');
2077 printf(" ");
2078 }
2079 printf(" |");
2080 for (m = 0; m < r; ++m) {
2081 if (m < nr) {
2082 c = temp[m];
2083 putchar(' ' <= c && c <= '~'? c: '.');
2084 } else
2085 putchar(' ');
2086 }
2087 n -= r;
2088 for (; m < 16; ++m)
2089 putchar(' ');
2090 printf("|\n");
2091 if (nr < r)
2092 break;
2093 }
2094}
2095
2096typedef int (*instruction_dump_func)(unsigned long inst, unsigned long addr);
2097
2098static int
2099generic_inst_dump(unsigned long adr, long count, int praddr,
2100 instruction_dump_func dump_func)
2101{
2102 int nr, dotted;
2103 unsigned long first_adr;
2104 unsigned long inst, last_inst = 0;
2105 unsigned char val[4];
2106
2107 dotted = 0;
2108 for (first_adr = adr; count > 0; --count, adr += 4) {
2109 nr = mread(adr, val, 4);
2110 if (nr == 0) {
2111 if (praddr) {
2112 const char *x = fault_chars[fault_type];
2113 printf(REG" %s%s%s%s\n", adr, x, x, x, x);
2114 }
2115 break;
2116 }
2117 inst = GETWORD(val);
2118 if (adr > first_adr && inst == last_inst) {
2119 if (!dotted) {
2120 printf(" ...\n");
2121 dotted = 1;
2122 }
2123 continue;
2124 }
2125 dotted = 0;
2126 last_inst = inst;
2127 if (praddr)
2128 printf(REG" %.8x", adr, inst);
2129 printf("\t");
2130 dump_func(inst, adr);
2131 printf("\n");
2132 }
2133 return adr - first_adr;
2134}
2135
2136static int
2137ppc_inst_dump(unsigned long adr, long count, int praddr)
2138{
2139 return generic_inst_dump(adr, count, praddr, print_insn_powerpc);
2140}
2141
2142void
2143print_address(unsigned long addr)
2144{
2145 xmon_print_symbol(addr, "\t# ", "");
2146}
2147
2148void
2149dump_log_buf(void)
2150{
2151 const unsigned long size = 128;
2152 unsigned long end, addr;
2153 unsigned char buf[size + 1];
2154
2155 addr = 0;
2156 buf[size] = '\0';
2157
2158 if (setjmp(bus_error_jmp) != 0) {
2159 printf("Unable to lookup symbol __log_buf!\n");
2160 return;
2161 }
2162
2163 catch_memory_errors = 1;
2164 sync();
2165 addr = kallsyms_lookup_name("__log_buf");
2166
2167 if (! addr)
2168 printf("Symbol __log_buf not found!\n");
2169 else {
2170 end = addr + (1 << CONFIG_LOG_BUF_SHIFT);
2171 while (addr < end) {
2172 if (! mread(addr, buf, size)) {
2173 printf("Can't read memory at address 0x%lx\n", addr);
2174 break;
2175 }
2176
2177 printf("%s", buf);
2178
2179 if (strlen(buf) < size)
2180 break;
2181
2182 addr += size;
2183 }
2184 }
2185
2186 sync();
2187 /* wait a little while to see if we get a machine check */
2188 __delay(200);
2189 catch_memory_errors = 0;
2190}
2191
2192/*
2193 * Memory operations - move, set, print differences
2194 */
2195static unsigned long mdest; /* destination address */
2196static unsigned long msrc; /* source address */
2197static unsigned long mval; /* byte value to set memory to */
2198static unsigned long mcount; /* # bytes to affect */
2199static unsigned long mdiffs; /* max # differences to print */
2200
2201static void
2202memops(int cmd)
2203{
2204 scanhex((void *)&mdest);
2205 if( termch != '\n' )
2206 termch = 0;
2207 scanhex((void *)(cmd == 's'? &mval: &msrc));
2208 if( termch != '\n' )
2209 termch = 0;
2210 scanhex((void *)&mcount);
2211 switch( cmd ){
2212 case 'm':
2213 memmove((void *)mdest, (void *)msrc, mcount);
2214 break;
2215 case 's':
2216 memset((void *)mdest, mval, mcount);
2217 break;
2218 case 'd':
2219 if( termch != '\n' )
2220 termch = 0;
2221 scanhex((void *)&mdiffs);
2222 memdiffs((unsigned char *)mdest, (unsigned char *)msrc, mcount, mdiffs);
2223 break;
2224 }
2225}
2226
2227static void
2228memdiffs(unsigned char *p1, unsigned char *p2, unsigned nb, unsigned maxpr)
2229{
2230 unsigned n, prt;
2231
2232 prt = 0;
2233 for( n = nb; n > 0; --n )
2234 if( *p1++ != *p2++ )
2235 if( ++prt <= maxpr )
2236 printf("%.16x %.2x # %.16x %.2x\n", p1 - 1,
2237 p1[-1], p2 - 1, p2[-1]);
2238 if( prt > maxpr )
2239 printf("Total of %d differences\n", prt);
2240}
2241
2242static unsigned mend;
2243static unsigned mask;
2244
2245static void
2246memlocate(void)
2247{
2248 unsigned a, n;
2249 unsigned char val[4];
2250
2251 last_cmd = "ml";
2252 scanhex((void *)&mdest);
2253 if (termch != '\n') {
2254 termch = 0;
2255 scanhex((void *)&mend);
2256 if (termch != '\n') {
2257 termch = 0;
2258 scanhex((void *)&mval);
2259 mask = ~0;
2260 if (termch != '\n') termch = 0;
2261 scanhex((void *)&mask);
2262 }
2263 }
2264 n = 0;
2265 for (a = mdest; a < mend; a += 4) {
2266 if (mread(a, val, 4) == 4
2267 && ((GETWORD(val) ^ mval) & mask) == 0) {
2268 printf("%.16x: %.16x\n", a, GETWORD(val));
2269 if (++n >= 10)
2270 break;
2271 }
2272 }
2273}
2274
2275static unsigned long mskip = 0x1000;
2276static unsigned long mlim = 0xffffffff;
2277
2278static void
2279memzcan(void)
2280{
2281 unsigned char v;
2282 unsigned a;
2283 int ok, ook;
2284
2285 scanhex(&mdest);
2286 if (termch != '\n') termch = 0;
2287 scanhex(&mskip);
2288 if (termch != '\n') termch = 0;
2289 scanhex(&mlim);
2290 ook = 0;
2291 for (a = mdest; a < mlim; a += mskip) {
2292 ok = mread(a, &v, 1);
2293 if (ok && !ook) {
2294 printf("%.8x .. ", a);
2295 } else if (!ok && ook)
2296 printf("%.8x\n", a - mskip);
2297 ook = ok;
2298 if (a + mskip < a)
2299 break;
2300 }
2301 if (ook)
2302 printf("%.8x\n", a - mskip);
2303}
2304
2305static void proccall(void)
2306{
2307 unsigned long args[8];
2308 unsigned long ret;
2309 int i;
2310 typedef unsigned long (*callfunc_t)(unsigned long, unsigned long,
2311 unsigned long, unsigned long, unsigned long,
2312 unsigned long, unsigned long, unsigned long);
2313 callfunc_t func;
2314
2315 if (!scanhex(&adrs))
2316 return;
2317 if (termch != '\n')
2318 termch = 0;
2319 for (i = 0; i < 8; ++i)
2320 args[i] = 0;
2321 for (i = 0; i < 8; ++i) {
2322 if (!scanhex(&args[i]) || termch == '\n')
2323 break;
2324 termch = 0;
2325 }
2326 func = (callfunc_t) adrs;
2327 ret = 0;
2328 if (setjmp(bus_error_jmp) == 0) {
2329 catch_memory_errors = 1;
2330 sync();
2331 ret = func(args[0], args[1], args[2], args[3],
2332 args[4], args[5], args[6], args[7]);
2333 sync();
2334 printf("return value is %x\n", ret);
2335 } else {
2336 printf("*** %x exception occurred\n", fault_except);
2337 }
2338 catch_memory_errors = 0;
2339}
2340
2341/* Input scanning routines */
2342int
2343skipbl(void)
2344{
2345 int c;
2346
2347 if( termch != 0 ){
2348 c = termch;
2349 termch = 0;
2350 } else
2351 c = inchar();
2352 while( c == ' ' || c == '\t' )
2353 c = inchar();
2354 return c;
2355}
2356
2357#define N_PTREGS 44
2358static char *regnames[N_PTREGS] = {
2359 "r0", "r1", "r2", "r3", "r4", "r5", "r6", "r7",
2360 "r8", "r9", "r10", "r11", "r12", "r13", "r14", "r15",
2361 "r16", "r17", "r18", "r19", "r20", "r21", "r22", "r23",
2362 "r24", "r25", "r26", "r27", "r28", "r29", "r30", "r31",
2363 "pc", "msr", "or3", "ctr", "lr", "xer", "ccr",
2364#ifdef CONFIG_PPC64
2365 "softe",
2366#else
2367 "mq",
2368#endif
2369 "trap", "dar", "dsisr", "res"
2370};
2371
2372int
2373scanhex(unsigned long *vp)
2374{
2375 int c, d;
2376 unsigned long v;
2377
2378 c = skipbl();
2379 if (c == '%') {
2380 /* parse register name */
2381 char regname[8];
2382 int i;
2383
2384 for (i = 0; i < sizeof(regname) - 1; ++i) {
2385 c = inchar();
2386 if (!isalnum(c)) {
2387 termch = c;
2388 break;
2389 }
2390 regname[i] = c;
2391 }
2392 regname[i] = 0;
2393 for (i = 0; i < N_PTREGS; ++i) {
2394 if (strcmp(regnames[i], regname) == 0) {
2395 if (xmon_regs == NULL) {
2396 printf("regs not available\n");
2397 return 0;
2398 }
2399 *vp = ((unsigned long *)xmon_regs)[i];
2400 return 1;
2401 }
2402 }
2403 printf("invalid register name '%%%s'\n", regname);
2404 return 0;
2405 }
2406
2407 /* skip leading "0x" if any */
2408
2409 if (c == '0') {
2410 c = inchar();
2411 if (c == 'x') {
2412 c = inchar();
2413 } else {
2414 d = hexdigit(c);
2415 if (d == EOF) {
2416 termch = c;
2417 *vp = 0;
2418 return 1;
2419 }
2420 }
2421 } else if (c == '$') {
2422 int i;
2423 for (i=0; i<63; i++) {
2424 c = inchar();
2425 if (isspace(c)) {
2426 termch = c;
2427 break;
2428 }
2429 tmpstr[i] = c;
2430 }
2431 tmpstr[i++] = 0;
2432 *vp = 0;
2433 if (setjmp(bus_error_jmp) == 0) {
2434 catch_memory_errors = 1;
2435 sync();
2436 *vp = kallsyms_lookup_name(tmpstr);
2437 sync();
2438 }
2439 catch_memory_errors = 0;
2440 if (!(*vp)) {
2441 printf("unknown symbol '%s'\n", tmpstr);
2442 return 0;
2443 }
2444 return 1;
2445 }
2446
2447 d = hexdigit(c);
2448 if (d == EOF) {
2449 termch = c;
2450 return 0;
2451 }
2452 v = 0;
2453 do {
2454 v = (v << 4) + d;
2455 c = inchar();
2456 d = hexdigit(c);
2457 } while (d != EOF);
2458 termch = c;
2459 *vp = v;
2460 return 1;
2461}
2462
2463static void
2464scannl(void)
2465{
2466 int c;
2467
2468 c = termch;
2469 termch = 0;
2470 while( c != '\n' )
2471 c = inchar();
2472}
2473
2474static int hexdigit(int c)
2475{
2476 if( '0' <= c && c <= '9' )
2477 return c - '0';
2478 if( 'A' <= c && c <= 'F' )
2479 return c - ('A' - 10);
2480 if( 'a' <= c && c <= 'f' )
2481 return c - ('a' - 10);
2482 return EOF;
2483}
2484
2485void
2486getstring(char *s, int size)
2487{
2488 int c;
2489
2490 c = skipbl();
2491 do {
2492 if( size > 1 ){
2493 *s++ = c;
2494 --size;
2495 }
2496 c = inchar();
2497 } while( c != ' ' && c != '\t' && c != '\n' );
2498 termch = c;
2499 *s = 0;
2500}
2501
2502static char line[256];
2503static char *lineptr;
2504
2505static void
2506flush_input(void)
2507{
2508 lineptr = NULL;
2509}
2510
2511static int
2512inchar(void)
2513{
2514 if (lineptr == NULL || *lineptr == 0) {
2515 if (xmon_gets(line, sizeof(line)) == NULL) {
2516 lineptr = NULL;
2517 return EOF;
2518 }
2519 lineptr = line;
2520 }
2521 return *lineptr++;
2522}
2523
2524static void
2525take_input(char *str)
2526{
2527 lineptr = str;
2528}
2529
2530
2531static void
2532symbol_lookup(void)
2533{
2534 int type = inchar();
2535 unsigned long addr;
2536 static char tmp[64];
2537
2538 switch (type) {
2539 case 'a':
2540 if (scanhex(&addr))
2541 xmon_print_symbol(addr, ": ", "\n");
2542 termch = 0;
2543 break;
2544 case 's':
2545 getstring(tmp, 64);
2546 if (setjmp(bus_error_jmp) == 0) {
2547 catch_memory_errors = 1;
2548 sync();
2549 addr = kallsyms_lookup_name(tmp);
2550 if (addr)
2551 printf("%s: %lx\n", tmp, addr);
2552 else
2553 printf("Symbol '%s' not found.\n", tmp);
2554 sync();
2555 }
2556 catch_memory_errors = 0;
2557 termch = 0;
2558 break;
2559 }
2560}
2561
2562
2563/* Print an address in numeric and symbolic form (if possible) */
2564static void xmon_print_symbol(unsigned long address, const char *mid,
2565 const char *after)
2566{
2567 char *modname;
2568 const char *name = NULL;
2569 unsigned long offset, size;
2570
2571 printf(REG, address);
2572 if (setjmp(bus_error_jmp) == 0) {
2573 catch_memory_errors = 1;
2574 sync();
2575 name = kallsyms_lookup(address, &size, &offset, &modname,
2576 tmpstr);
2577 sync();
2578 /* wait a little while to see if we get a machine check */
2579 __delay(200);
2580 }
2581
2582 catch_memory_errors = 0;
2583
2584 if (name) {
2585 printf("%s%s+%#lx/%#lx", mid, name, offset, size);
2586 if (modname)
2587 printf(" [%s]", modname);
2588 }
2589 printf("%s", after);
2590}
2591
2592#ifdef CONFIG_PPC_BOOK3S_64
2593static void dump_slb(void)
2594{
2595 int i;
2596 unsigned long esid,vsid,valid;
2597 unsigned long llp;
2598
2599 printf("SLB contents of cpu %x\n", smp_processor_id());
2600
2601 for (i = 0; i < mmu_slb_size; i++) {
2602 asm volatile("slbmfee %0,%1" : "=r" (esid) : "r" (i));
2603 asm volatile("slbmfev %0,%1" : "=r" (vsid) : "r" (i));
2604 valid = (esid & SLB_ESID_V);
2605 if (valid | esid | vsid) {
2606 printf("%02d %016lx %016lx", i, esid, vsid);
2607 if (valid) {
2608 llp = vsid & SLB_VSID_LLP;
2609 if (vsid & SLB_VSID_B_1T) {
2610 printf(" 1T ESID=%9lx VSID=%13lx LLP:%3lx \n",
2611 GET_ESID_1T(esid),
2612 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT_1T,
2613 llp);
2614 } else {
2615 printf(" 256M ESID=%9lx VSID=%13lx LLP:%3lx \n",
2616 GET_ESID(esid),
2617 (vsid & ~SLB_VSID_B) >> SLB_VSID_SHIFT,
2618 llp);
2619 }
2620 } else
2621 printf("\n");
2622 }
2623 }
2624}
2625
2626static void dump_stab(void)
2627{
2628 int i;
2629 unsigned long *tmp = (unsigned long *)local_paca->stab_addr;
2630
2631 printf("Segment table contents of cpu %x\n", smp_processor_id());
2632
2633 for (i = 0; i < PAGE_SIZE/16; i++) {
2634 unsigned long a, b;
2635
2636 a = *tmp++;
2637 b = *tmp++;
2638
2639 if (a || b) {
2640 printf("%03d %016lx ", i, a);
2641 printf("%016lx\n", b);
2642 }
2643 }
2644}
2645
2646void dump_segments(void)
2647{
2648 if (mmu_has_feature(MMU_FTR_SLB))
2649 dump_slb();
2650 else
2651 dump_stab();
2652}
2653#endif
2654
2655#ifdef CONFIG_PPC_STD_MMU_32
2656void dump_segments(void)
2657{
2658 int i;
2659
2660 printf("sr0-15 =");
2661 for (i = 0; i < 16; ++i)
2662 printf(" %x", mfsrin(i));
2663 printf("\n");
2664}
2665#endif
2666
2667#ifdef CONFIG_44x
2668static void dump_tlb_44x(void)
2669{
2670 int i;
2671
2672 for (i = 0; i < PPC44x_TLB_SIZE; i++) {
2673 unsigned long w0,w1,w2;
2674 asm volatile("tlbre %0,%1,0" : "=r" (w0) : "r" (i));
2675 asm volatile("tlbre %0,%1,1" : "=r" (w1) : "r" (i));
2676 asm volatile("tlbre %0,%1,2" : "=r" (w2) : "r" (i));
2677 printf("[%02x] %08x %08x %08x ", i, w0, w1, w2);
2678 if (w0 & PPC44x_TLB_VALID) {
2679 printf("V %08x -> %01x%08x %c%c%c%c%c",
2680 w0 & PPC44x_TLB_EPN_MASK,
2681 w1 & PPC44x_TLB_ERPN_MASK,
2682 w1 & PPC44x_TLB_RPN_MASK,
2683 (w2 & PPC44x_TLB_W) ? 'W' : 'w',
2684 (w2 & PPC44x_TLB_I) ? 'I' : 'i',
2685 (w2 & PPC44x_TLB_M) ? 'M' : 'm',
2686 (w2 & PPC44x_TLB_G) ? 'G' : 'g',
2687 (w2 & PPC44x_TLB_E) ? 'E' : 'e');
2688 }
2689 printf("\n");
2690 }
2691}
2692#endif /* CONFIG_44x */
2693
2694#ifdef CONFIG_PPC_BOOK3E
2695static void dump_tlb_book3e(void)
2696{
2697 u32 mmucfg, pidmask, lpidmask;
2698 u64 ramask;
2699 int i, tlb, ntlbs, pidsz, lpidsz, rasz, lrat = 0;
2700 int mmu_version;
2701 static const char *pgsz_names[] = {
2702 " 1K",
2703 " 2K",
2704 " 4K",
2705 " 8K",
2706 " 16K",
2707 " 32K",
2708 " 64K",
2709 "128K",
2710 "256K",
2711 "512K",
2712 " 1M",
2713 " 2M",
2714 " 4M",
2715 " 8M",
2716 " 16M",
2717 " 32M",
2718 " 64M",
2719 "128M",
2720 "256M",
2721 "512M",
2722 " 1G",
2723 " 2G",
2724 " 4G",
2725 " 8G",
2726 " 16G",
2727 " 32G",
2728 " 64G",
2729 "128G",
2730 "256G",
2731 "512G",
2732 " 1T",
2733 " 2T",
2734 };
2735
2736 /* Gather some infos about the MMU */
2737 mmucfg = mfspr(SPRN_MMUCFG);
2738 mmu_version = (mmucfg & 3) + 1;
2739 ntlbs = ((mmucfg >> 2) & 3) + 1;
2740 pidsz = ((mmucfg >> 6) & 0x1f) + 1;
2741 lpidsz = (mmucfg >> 24) & 0xf;
2742 rasz = (mmucfg >> 16) & 0x7f;
2743 if ((mmu_version > 1) && (mmucfg & 0x10000))
2744 lrat = 1;
2745 printf("Book3E MMU MAV=%d.0,%d TLBs,%d-bit PID,%d-bit LPID,%d-bit RA\n",
2746 mmu_version, ntlbs, pidsz, lpidsz, rasz);
2747 pidmask = (1ul << pidsz) - 1;
2748 lpidmask = (1ul << lpidsz) - 1;
2749 ramask = (1ull << rasz) - 1;
2750
2751 for (tlb = 0; tlb < ntlbs; tlb++) {
2752 u32 tlbcfg;
2753 int nent, assoc, new_cc = 1;
2754 printf("TLB %d:\n------\n", tlb);
2755 switch(tlb) {
2756 case 0:
2757 tlbcfg = mfspr(SPRN_TLB0CFG);
2758 break;
2759 case 1:
2760 tlbcfg = mfspr(SPRN_TLB1CFG);
2761 break;
2762 case 2:
2763 tlbcfg = mfspr(SPRN_TLB2CFG);
2764 break;
2765 case 3:
2766 tlbcfg = mfspr(SPRN_TLB3CFG);
2767 break;
2768 default:
2769 printf("Unsupported TLB number !\n");
2770 continue;
2771 }
2772 nent = tlbcfg & 0xfff;
2773 assoc = (tlbcfg >> 24) & 0xff;
2774 for (i = 0; i < nent; i++) {
2775 u32 mas0 = MAS0_TLBSEL(tlb);
2776 u32 mas1 = MAS1_TSIZE(BOOK3E_PAGESZ_4K);
2777 u64 mas2 = 0;
2778 u64 mas7_mas3;
2779 int esel = i, cc = i;
2780
2781 if (assoc != 0) {
2782 cc = i / assoc;
2783 esel = i % assoc;
2784 mas2 = cc * 0x1000;
2785 }
2786
2787 mas0 |= MAS0_ESEL(esel);
2788 mtspr(SPRN_MAS0, mas0);
2789 mtspr(SPRN_MAS1, mas1);
2790 mtspr(SPRN_MAS2, mas2);
2791 asm volatile("tlbre 0,0,0" : : : "memory");
2792 mas1 = mfspr(SPRN_MAS1);
2793 mas2 = mfspr(SPRN_MAS2);
2794 mas7_mas3 = mfspr(SPRN_MAS7_MAS3);
2795 if (assoc && (i % assoc) == 0)
2796 new_cc = 1;
2797 if (!(mas1 & MAS1_VALID))
2798 continue;
2799 if (assoc == 0)
2800 printf("%04x- ", i);
2801 else if (new_cc)
2802 printf("%04x-%c", cc, 'A' + esel);
2803 else
2804 printf(" |%c", 'A' + esel);
2805 new_cc = 0;
2806 printf(" %016llx %04x %s %c%c AS%c",
2807 mas2 & ~0x3ffull,
2808 (mas1 >> 16) & 0x3fff,
2809 pgsz_names[(mas1 >> 7) & 0x1f],
2810 mas1 & MAS1_IND ? 'I' : ' ',
2811 mas1 & MAS1_IPROT ? 'P' : ' ',
2812 mas1 & MAS1_TS ? '1' : '0');
2813 printf(" %c%c%c%c%c%c%c",
2814 mas2 & MAS2_X0 ? 'a' : ' ',
2815 mas2 & MAS2_X1 ? 'v' : ' ',
2816 mas2 & MAS2_W ? 'w' : ' ',
2817 mas2 & MAS2_I ? 'i' : ' ',
2818 mas2 & MAS2_M ? 'm' : ' ',
2819 mas2 & MAS2_G ? 'g' : ' ',
2820 mas2 & MAS2_E ? 'e' : ' ');
2821 printf(" %016llx", mas7_mas3 & ramask & ~0x7ffull);
2822 if (mas1 & MAS1_IND)
2823 printf(" %s\n",
2824 pgsz_names[(mas7_mas3 >> 1) & 0x1f]);
2825 else
2826 printf(" U%c%c%c S%c%c%c\n",
2827 mas7_mas3 & MAS3_UX ? 'x' : ' ',
2828 mas7_mas3 & MAS3_UW ? 'w' : ' ',
2829 mas7_mas3 & MAS3_UR ? 'r' : ' ',
2830 mas7_mas3 & MAS3_SX ? 'x' : ' ',
2831 mas7_mas3 & MAS3_SW ? 'w' : ' ',
2832 mas7_mas3 & MAS3_SR ? 'r' : ' ');
2833 }
2834 }
2835}
2836#endif /* CONFIG_PPC_BOOK3E */
2837
2838static void xmon_init(int enable)
2839{
2840 if (enable) {
2841 __debugger = xmon;
2842 __debugger_ipi = xmon_ipi;
2843 __debugger_bpt = xmon_bpt;
2844 __debugger_sstep = xmon_sstep;
2845 __debugger_iabr_match = xmon_iabr_match;
2846 __debugger_dabr_match = xmon_dabr_match;
2847 __debugger_fault_handler = xmon_fault_handler;
2848 } else {
2849 __debugger = NULL;
2850 __debugger_ipi = NULL;
2851 __debugger_bpt = NULL;
2852 __debugger_sstep = NULL;
2853 __debugger_iabr_match = NULL;
2854 __debugger_dabr_match = NULL;
2855 __debugger_fault_handler = NULL;
2856 }
2857 xmon_map_scc();
2858}
2859
2860#ifdef CONFIG_MAGIC_SYSRQ
2861static void sysrq_handle_xmon(int key)
2862{
2863 /* ensure xmon is enabled */
2864 xmon_init(1);
2865 debugger(get_irq_regs());
2866}
2867
2868static struct sysrq_key_op sysrq_xmon_op = {
2869 .handler = sysrq_handle_xmon,
2870 .help_msg = "Xmon",
2871 .action_msg = "Entering xmon",
2872};
2873
2874static int __init setup_xmon_sysrq(void)
2875{
2876 register_sysrq_key('x', &sysrq_xmon_op);
2877 return 0;
2878}
2879__initcall(setup_xmon_sysrq);
2880#endif /* CONFIG_MAGIC_SYSRQ */
2881
2882static int __initdata xmon_early, xmon_off;
2883
2884static int __init early_parse_xmon(char *p)
2885{
2886 if (!p || strncmp(p, "early", 5) == 0) {
2887 /* just "xmon" is equivalent to "xmon=early" */
2888 xmon_init(1);
2889 xmon_early = 1;
2890 } else if (strncmp(p, "on", 2) == 0)
2891 xmon_init(1);
2892 else if (strncmp(p, "off", 3) == 0)
2893 xmon_off = 1;
2894 else if (strncmp(p, "nobt", 4) == 0)
2895 xmon_no_auto_backtrace = 1;
2896 else
2897 return 1;
2898
2899 return 0;
2900}
2901early_param("xmon", early_parse_xmon);
2902
2903void __init xmon_setup(void)
2904{
2905#ifdef CONFIG_XMON_DEFAULT
2906 if (!xmon_off)
2907 xmon_init(1);
2908#endif
2909 if (xmon_early)
2910 debugger(NULL);
2911}
2912
2913#ifdef CONFIG_SPU_BASE
2914
2915struct spu_info {
2916 struct spu *spu;
2917 u64 saved_mfc_sr1_RW;
2918 u32 saved_spu_runcntl_RW;
2919 unsigned long dump_addr;
2920 u8 stopped_ok;
2921};
2922
2923#define XMON_NUM_SPUS 16 /* Enough for current hardware */
2924
2925static struct spu_info spu_info[XMON_NUM_SPUS];
2926
2927void xmon_register_spus(struct list_head *list)
2928{
2929 struct spu *spu;
2930
2931 list_for_each_entry(spu, list, full_list) {
2932 if (spu->number >= XMON_NUM_SPUS) {
2933 WARN_ON(1);
2934 continue;
2935 }
2936
2937 spu_info[spu->number].spu = spu;
2938 spu_info[spu->number].stopped_ok = 0;
2939 spu_info[spu->number].dump_addr = (unsigned long)
2940 spu_info[spu->number].spu->local_store;
2941 }
2942}
2943
2944static void stop_spus(void)
2945{
2946 struct spu *spu;
2947 int i;
2948 u64 tmp;
2949
2950 for (i = 0; i < XMON_NUM_SPUS; i++) {
2951 if (!spu_info[i].spu)
2952 continue;
2953
2954 if (setjmp(bus_error_jmp) == 0) {
2955 catch_memory_errors = 1;
2956 sync();
2957
2958 spu = spu_info[i].spu;
2959
2960 spu_info[i].saved_spu_runcntl_RW =
2961 in_be32(&spu->problem->spu_runcntl_RW);
2962
2963 tmp = spu_mfc_sr1_get(spu);
2964 spu_info[i].saved_mfc_sr1_RW = tmp;
2965
2966 tmp &= ~MFC_STATE1_MASTER_RUN_CONTROL_MASK;
2967 spu_mfc_sr1_set(spu, tmp);
2968
2969 sync();
2970 __delay(200);
2971
2972 spu_info[i].stopped_ok = 1;
2973
2974 printf("Stopped spu %.2d (was %s)\n", i,
2975 spu_info[i].saved_spu_runcntl_RW ?
2976 "running" : "stopped");
2977 } else {
2978 catch_memory_errors = 0;
2979 printf("*** Error stopping spu %.2d\n", i);
2980 }
2981 catch_memory_errors = 0;
2982 }
2983}
2984
2985static void restart_spus(void)
2986{
2987 struct spu *spu;
2988 int i;
2989
2990 for (i = 0; i < XMON_NUM_SPUS; i++) {
2991 if (!spu_info[i].spu)
2992 continue;
2993
2994 if (!spu_info[i].stopped_ok) {
2995 printf("*** Error, spu %d was not successfully stopped"
2996 ", not restarting\n", i);
2997 continue;
2998 }
2999
3000 if (setjmp(bus_error_jmp) == 0) {
3001 catch_memory_errors = 1;
3002 sync();
3003
3004 spu = spu_info[i].spu;
3005 spu_mfc_sr1_set(spu, spu_info[i].saved_mfc_sr1_RW);
3006 out_be32(&spu->problem->spu_runcntl_RW,
3007 spu_info[i].saved_spu_runcntl_RW);
3008
3009 sync();
3010 __delay(200);
3011
3012 printf("Restarted spu %.2d\n", i);
3013 } else {
3014 catch_memory_errors = 0;
3015 printf("*** Error restarting spu %.2d\n", i);
3016 }
3017 catch_memory_errors = 0;
3018 }
3019}
3020
3021#define DUMP_WIDTH 23
3022#define DUMP_VALUE(format, field, value) \
3023do { \
3024 if (setjmp(bus_error_jmp) == 0) { \
3025 catch_memory_errors = 1; \
3026 sync(); \
3027 printf(" %-*s = "format"\n", DUMP_WIDTH, \
3028 #field, value); \
3029 sync(); \
3030 __delay(200); \
3031 } else { \
3032 catch_memory_errors = 0; \
3033 printf(" %-*s = *** Error reading field.\n", \
3034 DUMP_WIDTH, #field); \
3035 } \
3036 catch_memory_errors = 0; \
3037} while (0)
3038
3039#define DUMP_FIELD(obj, format, field) \
3040 DUMP_VALUE(format, field, obj->field)
3041
3042static void dump_spu_fields(struct spu *spu)
3043{
3044 printf("Dumping spu fields at address %p:\n", spu);
3045
3046 DUMP_FIELD(spu, "0x%x", number);
3047 DUMP_FIELD(spu, "%s", name);
3048 DUMP_FIELD(spu, "0x%lx", local_store_phys);
3049 DUMP_FIELD(spu, "0x%p", local_store);
3050 DUMP_FIELD(spu, "0x%lx", ls_size);
3051 DUMP_FIELD(spu, "0x%x", node);
3052 DUMP_FIELD(spu, "0x%lx", flags);
3053 DUMP_FIELD(spu, "%d", class_0_pending);
3054 DUMP_FIELD(spu, "0x%lx", class_0_dar);
3055 DUMP_FIELD(spu, "0x%lx", class_1_dar);
3056 DUMP_FIELD(spu, "0x%lx", class_1_dsisr);
3057 DUMP_FIELD(spu, "0x%lx", irqs[0]);
3058 DUMP_FIELD(spu, "0x%lx", irqs[1]);
3059 DUMP_FIELD(spu, "0x%lx", irqs[2]);
3060 DUMP_FIELD(spu, "0x%x", slb_replace);
3061 DUMP_FIELD(spu, "%d", pid);
3062 DUMP_FIELD(spu, "0x%p", mm);
3063 DUMP_FIELD(spu, "0x%p", ctx);
3064 DUMP_FIELD(spu, "0x%p", rq);
3065 DUMP_FIELD(spu, "0x%p", timestamp);
3066 DUMP_FIELD(spu, "0x%lx", problem_phys);
3067 DUMP_FIELD(spu, "0x%p", problem);
3068 DUMP_VALUE("0x%x", problem->spu_runcntl_RW,
3069 in_be32(&spu->problem->spu_runcntl_RW));
3070 DUMP_VALUE("0x%x", problem->spu_status_R,
3071 in_be32(&spu->problem->spu_status_R));
3072 DUMP_VALUE("0x%x", problem->spu_npc_RW,
3073 in_be32(&spu->problem->spu_npc_RW));
3074 DUMP_FIELD(spu, "0x%p", priv2);
3075 DUMP_FIELD(spu, "0x%p", pdata);
3076}
3077
3078int
3079spu_inst_dump(unsigned long adr, long count, int praddr)
3080{
3081 return generic_inst_dump(adr, count, praddr, print_insn_spu);
3082}
3083
3084static void dump_spu_ls(unsigned long num, int subcmd)
3085{
3086 unsigned long offset, addr, ls_addr;
3087
3088 if (setjmp(bus_error_jmp) == 0) {
3089 catch_memory_errors = 1;
3090 sync();
3091 ls_addr = (unsigned long)spu_info[num].spu->local_store;
3092 sync();
3093 __delay(200);
3094 } else {
3095 catch_memory_errors = 0;
3096 printf("*** Error: accessing spu info for spu %d\n", num);
3097 return;
3098 }
3099 catch_memory_errors = 0;
3100
3101 if (scanhex(&offset))
3102 addr = ls_addr + offset;
3103 else
3104 addr = spu_info[num].dump_addr;
3105
3106 if (addr >= ls_addr + LS_SIZE) {
3107 printf("*** Error: address outside of local store\n");
3108 return;
3109 }
3110
3111 switch (subcmd) {
3112 case 'i':
3113 addr += spu_inst_dump(addr, 16, 1);
3114 last_cmd = "sdi\n";
3115 break;
3116 default:
3117 prdump(addr, 64);
3118 addr += 64;
3119 last_cmd = "sd\n";
3120 break;
3121 }
3122
3123 spu_info[num].dump_addr = addr;
3124}
3125
3126static int do_spu_cmd(void)
3127{
3128 static unsigned long num = 0;
3129 int cmd, subcmd = 0;
3130
3131 cmd = inchar();
3132 switch (cmd) {
3133 case 's':
3134 stop_spus();
3135 break;
3136 case 'r':
3137 restart_spus();
3138 break;
3139 case 'd':
3140 subcmd = inchar();
3141 if (isxdigit(subcmd) || subcmd == '\n')
3142 termch = subcmd;
3143 case 'f':
3144 scanhex(&num);
3145 if (num >= XMON_NUM_SPUS || !spu_info[num].spu) {
3146 printf("*** Error: invalid spu number\n");
3147 return 0;
3148 }
3149
3150 switch (cmd) {
3151 case 'f':
3152 dump_spu_fields(spu_info[num].spu);
3153 break;
3154 default:
3155 dump_spu_ls(num, subcmd);
3156 break;
3157 }
3158
3159 break;
3160 default:
3161 return -1;
3162 }
3163
3164 return 0;
3165}
3166#else /* ! CONFIG_SPU_BASE */
3167static int do_spu_cmd(void)
3168{
3169 return -1;
3170}
3171#endif