arch/powerpc/xmon/xmon.c

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