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