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