git.oblomov.eu Git - linux-2.6/blob - arch/ppc/kernel/ppc-stub.c

   1 /*
   2  * ppc-stub.c:  KGDB support for the Linux kernel.
   3  *
   4  * adapted from arch/sparc/kernel/sparc-stub.c for the PowerPC
   5  * some stuff borrowed from Paul Mackerras' xmon
   6  * Copyright (C) 1998 Michael AK Tesch (tesch@cs.wisc.edu)
   7  *
   8  * Modifications to run under Linux
   9  * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
  10  *
  11  * This file originally came from the gdb sources, and the
  12  * copyright notices have been retained below.
  13  */
  14
  15 /****************************************************************************
  16
  17                 THIS SOFTWARE IS NOT COPYRIGHTED
  18
  19    HP offers the following for use in the public domain.  HP makes no
  20    warranty with regard to the software or its performance and the
  21    user accepts the software "AS IS" with all faults.
  22
  23    HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD
  24    TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  25    OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  26
  27 ****************************************************************************/
  28
  29 /****************************************************************************
  30  *  Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $
  31  *
  32  *  Module name: remcom.c $
  33  *  Revision: 1.34 $
  34  *  Date: 91/03/09 12:29:49 $
  35  *  Contributor:     Lake Stevens Instrument Division$
  36  *
  37  *  Description:     low level support for gdb debugger. $
  38  *
  39  *  Considerations:  only works on target hardware $
  40  *
  41  *  Written by:      Glenn Engel $
  42  *  ModuleState:     Experimental $
  43  *
  44  *  NOTES:           See Below $
  45  *
  46  *  Modified for SPARC by Stu Grossman, Cygnus Support.
  47  *
  48  *  This code has been extensively tested on the Fujitsu SPARClite demo board.
  49  *
  50  *  To enable debugger support, two things need to happen.  One, a
  51  *  call to set_debug_traps() is necessary in order to allow any breakpoints
  52  *  or error conditions to be properly intercepted and reported to gdb.
  53  *  Two, a breakpoint needs to be generated to begin communication.  This
  54  *  is most easily accomplished by a call to breakpoint().  Breakpoint()
  55  *  simulates a breakpoint by executing a trap #1.
  56  *
  57  *************
  58  *
  59  *    The following gdb commands are supported:
  60  *
  61  * command          function                      Return value
  62  *
  63  *    g             return the value of the CPU registers  hex data or ENN
  64  *    G             set the value of the CPU registers     OK or ENN
  65  *    qOffsets      Get section offsets.  Reply is Text=xxx;Data=yyy;Bss=zzz
  66  *
  67  *    mAA..AA,LLLL  Read LLLL bytes at address AA..AA      hex data or ENN
  68  *    MAA..AA,LLLL: Write LLLL bytes at address AA.AA      OK or ENN
  69  *
  70  *    c             Resume at current address              SNN   ( signal NN)
  71  *    cAA..AA       Continue at address AA..AA             SNN
  72  *
  73  *    s             Step one instruction                   SNN
  74  *    sAA..AA       Step one instruction from AA..AA       SNN
  75  *
  76  *    k             kill
  77  *
  78  *    ?             What was the last sigval ?             SNN   (signal NN)
  79  *
  80  *    bBB..BB       Set baud rate to BB..BB                OK or BNN, then sets
  81  *                                                         baud rate
  82  *
  83  * All commands and responses are sent with a packet which includes a
  84  * checksum.  A packet consists of
  85  *
  86  * $<packet info>#<checksum>.
  87  *
  88  * where
  89  * <packet info> :: <characters representing the command or response>
  90  * <checksum>    :: <two hex digits computed as modulo 256 sum of <packetinfo>>
  91  *
  92  * When a packet is received, it is first acknowledged with either '+' or '-'.
  93  * '+' indicates a successful transfer.  '-' indicates a failed transfer.
  94  *
  95  * Example:
  96  *
  97  * Host:                  Reply:
  98  * $m0,10#2a               +$00010203040506070809101112131415#42
  99  *
 100  ****************************************************************************/
 101
 102 #include <linux/kernel.h>
 103 #include <linux/string.h>
 104 #include <linux/mm.h>
 105 #include <linux/smp.h>
 106 #include <linux/smp_lock.h>
 107 #include <linux/init.h>
 108 #include <linux/sysrq.h>
 109
 110 #include <asm/cacheflush.h>
 111 #include <asm/system.h>
 112 #include <asm/signal.h>
 113 #include <asm/kgdb.h>
 114 #include <asm/pgtable.h>
 115 #include <asm/ptrace.h>
 116
 117 void breakinst(void);
 118
 119 /*
 120  * BUFMAX defines the maximum number of characters in inbound/outbound buffers
 121  * at least NUMREGBYTES*2 are needed for register packets
 122  */
 123 #define BUFMAX 2048
 124 static char remcomInBuffer[BUFMAX];
 125 static char remcomOutBuffer[BUFMAX];
 126
 127 static int initialized;
 128 static int kgdb_active;
 129 static int kgdb_started;
 130 static u_int fault_jmp_buf[100];
 131 static int kdebug;
 132
 133
 134 static const char hexchars[]="0123456789abcdef";
 135
 136 /* Place where we save old trap entries for restoration - sparc*/
 137 /* struct tt_entry kgdb_savettable[256]; */
 138 /* typedef void (*trapfunc_t)(void); */
 139
 140 static void kgdb_fault_handler(struct pt_regs *regs);
 141 static int handle_exception (struct pt_regs *regs);
 142
 143 #if 0
 144 /* Install an exception handler for kgdb */
 145 static void exceptionHandler(int tnum, unsigned int *tfunc)
 146 {
 147         /* We are dorking with a live trap table, all irqs off */
 148 }
 149 #endif
 150
 151 int
 152 kgdb_setjmp(long *buf)
 153 {
 154         asm ("mflr 0; stw 0,0(%0);"
 155              "stw 1,4(%0); stw 2,8(%0);"
 156              "mfcr 0; stw 0,12(%0);"
 157              "stmw 13,16(%0)"
 158              : : "r" (buf));
 159         /* XXX should save fp regs as well */
 160         return 0;
 161 }
 162 void
 163 kgdb_longjmp(long *buf, int val)
 164 {
 165         if (val == 0)
 166                 val = 1;
 167         asm ("lmw 13,16(%0);"
 168              "lwz 0,12(%0); mtcrf 0x38,0;"
 169              "lwz 0,0(%0); lwz 1,4(%0); lwz 2,8(%0);"
 170              "mtlr 0; mr 3,%1"
 171              : : "r" (buf), "r" (val));
 172 }
 173 /* Convert ch from a hex digit to an int */
 174 static int
 175 hex(unsigned char ch)
 176 {
 177         if (ch >= 'a' && ch <= 'f')
 178                 return ch-'a'+10;
 179         if (ch >= '0' && ch <= '9')
 180                 return ch-'0';
 181         if (ch >= 'A' && ch <= 'F')
 182                 return ch-'A'+10;
 183         return -1;
 184 }
 185
 186 /* Convert the memory pointed to by mem into hex, placing result in buf.
 187  * Return a pointer to the last char put in buf (null), in case of mem fault,
 188  * return 0.
 189  */
 190 static unsigned char *
 191 mem2hex(const char *mem, char *buf, int count)
 192 {
 193         unsigned char ch;
 194         unsigned short tmp_s;
 195         unsigned long tmp_l;
 196
 197         if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
 198                 debugger_fault_handler = kgdb_fault_handler;
 199
 200                 /* Accessing 16 bit and 32 bit objects in a single
 201                 ** load instruction is required to avoid bad side
 202                 ** effects for some IO registers.
 203                 */
 204
 205                 if ((count == 2) && (((long)mem & 1) == 0)) {
 206                         tmp_s = *(unsigned short *)mem;
 207                         mem += 2;
 208                         *buf++ = hexchars[(tmp_s >> 12) & 0xf];
 209                         *buf++ = hexchars[(tmp_s >> 8) & 0xf];
 210                         *buf++ = hexchars[(tmp_s >> 4) & 0xf];
 211                         *buf++ = hexchars[tmp_s & 0xf];
 212
 213                 } else if ((count == 4) && (((long)mem & 3) == 0)) {
 214                         tmp_l = *(unsigned int *)mem;
 215                         mem += 4;
 216                         *buf++ = hexchars[(tmp_l >> 28) & 0xf];
 217                         *buf++ = hexchars[(tmp_l >> 24) & 0xf];
 218                         *buf++ = hexchars[(tmp_l >> 20) & 0xf];
 219                         *buf++ = hexchars[(tmp_l >> 16) & 0xf];
 220                         *buf++ = hexchars[(tmp_l >> 12) & 0xf];
 221                         *buf++ = hexchars[(tmp_l >> 8) & 0xf];
 222                         *buf++ = hexchars[(tmp_l >> 4) & 0xf];
 223                         *buf++ = hexchars[tmp_l & 0xf];
 224
 225                 } else {
 226                         while (count-- > 0) {
 227                                 ch = *mem++;
 228                                 *buf++ = hexchars[ch >> 4];
 229                                 *buf++ = hexchars[ch & 0xf];
 230                         }
 231                 }
 232
 233         } else {
 234                 /* error condition */
 235         }
 236         debugger_fault_handler = NULL;
 237         *buf = 0;
 238         return buf;
 239 }
 240
 241 /* convert the hex array pointed to by buf into binary to be placed in mem
 242  * return a pointer to the character AFTER the last byte written.
 243 */
 244 static char *
 245 hex2mem(char *buf, char *mem, int count)
 246 {
 247         unsigned char ch;
 248         int i;
 249         char *orig_mem;
 250         unsigned short tmp_s;
 251         unsigned long tmp_l;
 252
 253         orig_mem = mem;
 254
 255         if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
 256                 debugger_fault_handler = kgdb_fault_handler;
 257
 258                 /* Accessing 16 bit and 32 bit objects in a single
 259                 ** store instruction is required to avoid bad side
 260                 ** effects for some IO registers.
 261                 */
 262
 263                 if ((count == 2) && (((long)mem & 1) == 0)) {
 264                         tmp_s = hex(*buf++) << 12;
 265                         tmp_s |= hex(*buf++) << 8;
 266                         tmp_s |= hex(*buf++) << 4;
 267                         tmp_s |= hex(*buf++);
 268
 269                         *(unsigned short *)mem = tmp_s;
 270                         mem += 2;
 271
 272                 } else if ((count == 4) && (((long)mem & 3) == 0)) {
 273                         tmp_l = hex(*buf++) << 28;
 274                         tmp_l |= hex(*buf++) << 24;
 275                         tmp_l |= hex(*buf++) << 20;
 276                         tmp_l |= hex(*buf++) << 16;
 277                         tmp_l |= hex(*buf++) << 12;
 278                         tmp_l |= hex(*buf++) << 8;
 279                         tmp_l |= hex(*buf++) << 4;
 280                         tmp_l |= hex(*buf++);
 281
 282                         *(unsigned long *)mem = tmp_l;
 283                         mem += 4;
 284
 285                 } else {
 286                         for (i=0; i<count; i++) {
 287                                 ch = hex(*buf++) << 4;
 288                                 ch |= hex(*buf++);
 289                                 *mem++ = ch;
 290                         }
 291                 }
 292
 293
 294                 /*
 295                 ** Flush the data cache, invalidate the instruction cache.
 296                 */
 297                 flush_icache_range((int)orig_mem, (int)orig_mem + count - 1);
 298
 299         } else {
 300                 /* error condition */
 301         }
 302         debugger_fault_handler = NULL;
 303         return mem;
 304 }
 305
 306 /*
 307  * While we find nice hex chars, build an int.
 308  * Return number of chars processed.
 309  */
 310 static int
 311 hexToInt(char **ptr, int *intValue)
 312 {
 313         int numChars = 0;
 314         int hexValue;
 315
 316         *intValue = 0;
 317
 318         if (kgdb_setjmp((long*)fault_jmp_buf) == 0) {
 319                 debugger_fault_handler = kgdb_fault_handler;
 320                 while (**ptr) {
 321                         hexValue = hex(**ptr);
 322                         if (hexValue < 0)
 323                                 break;
 324
 325                         *intValue = (*intValue << 4) | hexValue;
 326                         numChars ++;
 327
 328                         (*ptr)++;
 329                 }
 330         } else {
 331                 /* error condition */
 332         }
 333         debugger_fault_handler = NULL;
 334
 335         return (numChars);
 336 }
 337
 338 /* scan for the sequence $<data>#<checksum> */
 339 static void
 340 getpacket(char *buffer)
 341 {
 342         unsigned char checksum;
 343         unsigned char xmitcsum;
 344         int i;
 345         int count;
 346         unsigned char ch;
 347
 348         do {
 349                 /* wait around for the start character, ignore all other
 350                  * characters */
 351                 while ((ch = (getDebugChar() & 0x7f)) != '$') ;
 352
 353                 checksum = 0;
 354                 xmitcsum = -1;
 355
 356                 count = 0;
 357
 358                 /* now, read until a # or end of buffer is found */
 359                 while (count < BUFMAX) {
 360                         ch = getDebugChar() & 0x7f;
 361                         if (ch == '#')
 362                                 break;
 363                         checksum = checksum + ch;
 364                         buffer[count] = ch;
 365                         count = count + 1;
 366                 }
 367
 368                 if (count >= BUFMAX)
 369                         continue;
 370
 371                 buffer[count] = 0;
 372
 373                 if (ch == '#') {
 374                         xmitcsum = hex(getDebugChar() & 0x7f) << 4;
 375                         xmitcsum |= hex(getDebugChar() & 0x7f);
 376                         if (checksum != xmitcsum)
 377                                 putDebugChar('-');      /* failed checksum */
 378                         else {
 379                                 putDebugChar('+'); /* successful transfer */
 380                                 /* if a sequence char is present, reply the ID */
 381                                 if (buffer[2] == ':') {
 382                                         putDebugChar(buffer[0]);
 383                                         putDebugChar(buffer[1]);
 384                                         /* remove sequence chars from buffer */
 385                                         count = strlen(buffer);
 386                                         for (i=3; i <= count; i++)
 387                                                 buffer[i-3] = buffer[i];
 388                                 }
 389                         }
 390                 }
 391         } while (checksum != xmitcsum);
 392 }
 393
 394 /* send the packet in buffer. */
 395 static void putpacket(unsigned char *buffer)
 396 {
 397         unsigned char checksum;
 398         int count;
 399         unsigned char ch, recv;
 400
 401         /* $<packet info>#<checksum>. */
 402         do {
 403                 putDebugChar('$');
 404                 checksum = 0;
 405                 count = 0;
 406
 407                 while ((ch = buffer[count])) {
 408                         putDebugChar(ch);
 409                         checksum += ch;
 410                         count += 1;
 411                 }
 412
 413                 putDebugChar('#');
 414                 putDebugChar(hexchars[checksum >> 4]);
 415                 putDebugChar(hexchars[checksum & 0xf]);
 416                 recv = getDebugChar();
 417         } while ((recv & 0x7f) != '+');
 418 }
 419
 420 static void kgdb_flush_cache_all(void)
 421 {
 422         flush_instruction_cache();
 423 }
 424
 425 /* Set up exception handlers for tracing and breakpoints
 426  * [could be called kgdb_init()]
 427  */
 428 void set_debug_traps(void)
 429 {
 430 #if 0
 431         unsigned char c;
 432
 433         save_and_cli(flags);
 434
 435         /* In case GDB is started before us, ack any packets (presumably
 436          * "$?#xx") sitting there.
 437          *
 438          * I've found this code causes more problems than it solves,
 439          * so that's why it's commented out.  GDB seems to work fine
 440          * now starting either before or after the kernel   -bwb
 441          */
 442
 443         while((c = getDebugChar()) != '$');
 444         while((c = getDebugChar()) != '#');
 445         c = getDebugChar(); /* eat first csum byte */
 446         c = getDebugChar(); /* eat second csum byte */
 447         putDebugChar('+'); /* ack it */
 448 #endif
 449         debugger = kgdb;
 450         debugger_bpt = kgdb_bpt;
 451         debugger_sstep = kgdb_sstep;
 452         debugger_iabr_match = kgdb_iabr_match;
 453         debugger_dabr_match = kgdb_dabr_match;
 454
 455         initialized = 1;
 456 }
 457
 458 static void kgdb_fault_handler(struct pt_regs *regs)
 459 {
 460         kgdb_longjmp((long*)fault_jmp_buf, 1);
 461 }
 462
 463 int kgdb_bpt(struct pt_regs *regs)
 464 {
 465         return handle_exception(regs);
 466 }
 467
 468 int kgdb_sstep(struct pt_regs *regs)
 469 {
 470         return handle_exception(regs);
 471 }
 472
 473 void kgdb(struct pt_regs *regs)
 474 {
 475         handle_exception(regs);
 476 }
 477
 478 int kgdb_iabr_match(struct pt_regs *regs)
 479 {
 480         printk(KERN_ERR "kgdb doesn't support iabr, what?!?\n");
 481         return handle_exception(regs);
 482 }
 483
 484 int kgdb_dabr_match(struct pt_regs *regs)
 485 {
 486         printk(KERN_ERR "kgdb doesn't support dabr, what?!?\n");
 487         return handle_exception(regs);
 488 }
 489
 490 /* Convert the hardware trap type code to a unix signal number. */
 491 /*
 492  * This table contains the mapping between PowerPC hardware trap types, and
 493  * signals, which are primarily what GDB understands.
 494  */
 495 static struct hard_trap_info
 496 {
 497         unsigned int tt;                /* Trap type code for powerpc */
 498         unsigned char signo;            /* Signal that we map this trap into */
 499 } hard_trap_info[] = {
 500 #if defined(CONFIG_40x) || defined(CONFIG_BOOKE)
 501         { 0x100, SIGINT  },             /* critical input interrupt */
 502         { 0x200, SIGSEGV },             /* machine check */
 503         { 0x300, SIGSEGV },             /* data storage */
 504         { 0x400, SIGBUS  },             /* instruction storage */
 505         { 0x500, SIGINT  },             /* interrupt */
 506         { 0x600, SIGBUS  },             /* alignment */
 507         { 0x700, SIGILL  },             /* program */
 508         { 0x800, SIGILL  },             /* reserved */
 509         { 0x900, SIGILL  },             /* reserved */
 510         { 0xa00, SIGILL  },             /* reserved */
 511         { 0xb00, SIGILL  },             /* reserved */
 512         { 0xc00, SIGCHLD },             /* syscall */
 513         { 0xd00, SIGILL  },             /* reserved */
 514         { 0xe00, SIGILL  },             /* reserved */
 515         { 0xf00, SIGILL  },             /* reserved */
 516         /*
 517         ** 0x1000  PIT
 518         ** 0x1010  FIT
 519         ** 0x1020  watchdog
 520         ** 0x1100  data TLB miss
 521         ** 0x1200  instruction TLB miss
 522         */
 523         { 0x2002, SIGTRAP},             /* debug */
 524 #else
 525         { 0x200, SIGSEGV },             /* machine check */
 526         { 0x300, SIGSEGV },             /* address error (store) */
 527         { 0x400, SIGBUS },              /* instruction bus error */
 528         { 0x500, SIGINT },              /* interrupt */
 529         { 0x600, SIGBUS },              /* alingment */
 530         { 0x700, SIGTRAP },             /* breakpoint trap */
 531         { 0x800, SIGFPE },              /* fpu unavail */
 532         { 0x900, SIGALRM },             /* decrementer */
 533         { 0xa00, SIGILL },              /* reserved */
 534         { 0xb00, SIGILL },              /* reserved */
 535         { 0xc00, SIGCHLD },             /* syscall */
 536         { 0xd00, SIGTRAP },             /* single-step/watch */
 537         { 0xe00, SIGFPE },              /* fp assist */
 538 #endif
 539         { 0, 0}                         /* Must be last */
 540
 541 };
 542
 543 static int computeSignal(unsigned int tt)
 544 {
 545         struct hard_trap_info *ht;
 546
 547         for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
 548                 if (ht->tt == tt)
 549                         return ht->signo;
 550
 551         return SIGHUP; /* default for things we don't know about */
 552 }
 553
 554 #define PC_REGNUM 64
 555 #define SP_REGNUM 1
 556
 557 /*
 558  * This function does all command processing for interfacing to gdb.
 559  */
 560 static int
 561 handle_exception (struct pt_regs *regs)
 562 {
 563         int sigval;
 564         int addr;
 565         int length;
 566         char *ptr;
 567         unsigned int msr;
 568
 569         /* We don't handle user-mode breakpoints. */
 570         if (user_mode(regs))
 571                 return 0;
 572
 573         if (debugger_fault_handler) {
 574                 debugger_fault_handler(regs);
 575                 panic("kgdb longjump failed!\n");
 576         }
 577         if (kgdb_active) {
 578                 printk(KERN_ERR "interrupt while in kgdb, returning\n");
 579                 return 0;
 580         }
 581
 582         kgdb_active = 1;
 583         kgdb_started = 1;
 584
 585 #ifdef KGDB_DEBUG
 586         printk("kgdb: entering handle_exception; trap [0x%x]\n",
 587                         (unsigned int)regs->trap);
 588 #endif
 589
 590         kgdb_interruptible(0);
 591         lock_kernel();
 592         msr = mfmsr();
 593         mtmsr(msr & ~MSR_EE);   /* disable interrupts */
 594
 595         if (regs->nip == (unsigned long)breakinst) {
 596                 /* Skip over breakpoint trap insn */
 597                 regs->nip += 4;
 598         }
 599
 600         /* reply to host that an exception has occurred */
 601         sigval = computeSignal(regs->trap);
 602         ptr = remcomOutBuffer;
 603
 604         *ptr++ = 'T';
 605         *ptr++ = hexchars[sigval >> 4];
 606         *ptr++ = hexchars[sigval & 0xf];
 607         *ptr++ = hexchars[PC_REGNUM >> 4];
 608         *ptr++ = hexchars[PC_REGNUM & 0xf];
 609         *ptr++ = ':';
 610         ptr = mem2hex((char *)&regs->nip, ptr, 4);
 611         *ptr++ = ';';
 612         *ptr++ = hexchars[SP_REGNUM >> 4];
 613         *ptr++ = hexchars[SP_REGNUM & 0xf];
 614         *ptr++ = ':';
 615         ptr = mem2hex(((char *)regs) + SP_REGNUM*4, ptr, 4);
 616         *ptr++ = ';';
 617         *ptr++ = 0;
 618
 619         putpacket(remcomOutBuffer);
 620         if (kdebug)
 621                 printk("remcomOutBuffer: %s\n", remcomOutBuffer);
 622
 623         /* XXX We may want to add some features dealing with poking the
 624          * XXX page tables, ... (look at sparc-stub.c for more info)
 625          * XXX also required hacking to the gdb sources directly...
 626          */
 627
 628         while (1) {
 629                 remcomOutBuffer[0] = 0;
 630
 631                 getpacket(remcomInBuffer);
 632                 switch (remcomInBuffer[0]) {
 633                 case '?': /* report most recent signal */
 634                         remcomOutBuffer[0] = 'S';
 635                         remcomOutBuffer[1] = hexchars[sigval >> 4];
 636                         remcomOutBuffer[2] = hexchars[sigval & 0xf];
 637                         remcomOutBuffer[3] = 0;
 638                         break;
 639 #if 0
 640                 case 'q': /* this screws up gdb for some reason...*/
 641                 {
 642                         extern long _start, sdata, __bss_start;
 643
 644                         ptr = &remcomInBuffer[1];
 645                         if (strncmp(ptr, "Offsets", 7) != 0)
 646                                 break;
 647
 648                         ptr = remcomOutBuffer;
 649                         sprintf(ptr, "Text=%8.8x;Data=%8.8x;Bss=%8.8x",
 650                                 &_start, &sdata, &__bss_start);
 651                         break;
 652                 }
 653 #endif
 654                 case 'd':
 655                         /* toggle debug flag */
 656                         kdebug ^= 1;
 657                         break;
 658
 659                 case 'g':       /* return the value of the CPU registers.
 660                                  * some of them are non-PowerPC names :(
 661                                  * they are stored in gdb like:
 662                                  * struct {
 663                                  *     u32 gpr[32];
 664                                  *     f64 fpr[32];
 665                                  *     u32 pc, ps, cnd, lr; (ps=msr)
 666                                  *     u32 cnt, xer, mq;
 667                                  * }
 668                                  */
 669                 {
 670                         int i;
 671                         ptr = remcomOutBuffer;
 672                         /* General Purpose Regs */
 673                         ptr = mem2hex((char *)regs, ptr, 32 * 4);
 674                         /* Floating Point Regs - FIXME */
 675                         /*ptr = mem2hex((char *), ptr, 32 * 8);*/
 676                         for(i=0; i<(32*8*2); i++) { /* 2chars/byte */
 677                                 ptr[i] = '0';
 678                         }
 679                         ptr += 32*8*2;
 680                         /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
 681                         ptr = mem2hex((char *)&regs->nip, ptr, 4);
 682                         ptr = mem2hex((char *)&regs->msr, ptr, 4);
 683                         ptr = mem2hex((char *)&regs->ccr, ptr, 4);
 684                         ptr = mem2hex((char *)&regs->link, ptr, 4);
 685                         ptr = mem2hex((char *)&regs->ctr, ptr, 4);
 686                         ptr = mem2hex((char *)&regs->xer, ptr, 4);
 687                 }
 688                         break;
 689
 690                 case 'G': /* set the value of the CPU registers */
 691                 {
 692                         ptr = &remcomInBuffer[1];
 693
 694                         /*
 695                          * If the stack pointer has moved, you should pray.
 696                          * (cause only god can help you).
 697                          */
 698
 699                         /* General Purpose Regs */
 700                         hex2mem(ptr, (char *)regs, 32 * 4);
 701
 702                         /* Floating Point Regs - FIXME?? */
 703                         /*ptr = hex2mem(ptr, ??, 32 * 8);*/
 704                         ptr += 32*8*2;
 705
 706                         /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
 707                         ptr = hex2mem(ptr, (char *)&regs->nip, 4);
 708                         ptr = hex2mem(ptr, (char *)&regs->msr, 4);
 709                         ptr = hex2mem(ptr, (char *)&regs->ccr, 4);
 710                         ptr = hex2mem(ptr, (char *)&regs->link, 4);
 711                         ptr = hex2mem(ptr, (char *)&regs->ctr, 4);
 712                         ptr = hex2mem(ptr, (char *)&regs->xer, 4);
 713
 714                         strcpy(remcomOutBuffer,"OK");
 715                 }
 716                         break;
 717                 case 'H':
 718                         /* don't do anything, yet, just acknowledge */
 719                         hexToInt(&ptr, &addr);
 720                         strcpy(remcomOutBuffer,"OK");
 721                         break;
 722
 723                 case 'm':       /* mAA..AA,LLLL  Read LLLL bytes at address AA..AA */
 724                                 /* Try to read %x,%x.  */
 725
 726                         ptr = &remcomInBuffer[1];
 727
 728                         if (hexToInt(&ptr, &addr) && *ptr++ == ','
 729                                         && hexToInt(&ptr, &length)) {
 730                                 if (mem2hex((char *)addr, remcomOutBuffer,
 731                                                         length))
 732                                         break;
 733                                 strcpy(remcomOutBuffer, "E03");
 734                         } else
 735                                 strcpy(remcomOutBuffer, "E01");
 736                         break;
 737
 738                 case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
 739                         /* Try to read '%x,%x:'.  */
 740
 741                         ptr = &remcomInBuffer[1];
 742
 743                         if (hexToInt(&ptr, &addr) && *ptr++ == ','
 744                                         && hexToInt(&ptr, &length)
 745                                         && *ptr++ == ':') {
 746                                 if (hex2mem(ptr, (char *)addr, length))
 747                                         strcpy(remcomOutBuffer, "OK");
 748                                 else
 749                                         strcpy(remcomOutBuffer, "E03");
 750                                 flush_icache_range(addr, addr+length);
 751                         } else
 752                                 strcpy(remcomOutBuffer, "E02");
 753                         break;
 754
 755
 756                 case 'k': /* kill the program, actually just continue */
 757                 case 'c': /* cAA..AA  Continue; address AA..AA optional */
 758                         /* try to read optional parameter, pc unchanged if no parm */
 759
 760                         ptr = &remcomInBuffer[1];
 761                         if (hexToInt(&ptr, &addr))
 762                                 regs->nip = addr;
 763
 764 /* Need to flush the instruction cache here, as we may have deposited a
 765  * breakpoint, and the icache probably has no way of knowing that a data ref to
 766  * some location may have changed something that is in the instruction cache.
 767  */
 768                         kgdb_flush_cache_all();
 769                         mtmsr(msr);
 770
 771                         kgdb_interruptible(1);
 772                         unlock_kernel();
 773                         kgdb_active = 0;
 774                         if (kdebug) {
 775                                 printk("remcomInBuffer: %s\n", remcomInBuffer);
 776                                 printk("remcomOutBuffer: %s\n", remcomOutBuffer);
 777                         }
 778                         return 1;
 779
 780                 case 's':
 781                         kgdb_flush_cache_all();
 782 #if defined(CONFIG_40x) || defined(CONFIG_BOOKE)
 783                         mtspr(SPRN_DBCR0, mfspr(SPRN_DBCR0) | DBCR0_IC);
 784                         regs->msr |= MSR_DE;
 785 #else
 786                         regs->msr |= MSR_SE;
 787 #endif
 788                         unlock_kernel();
 789                         kgdb_active = 0;
 790                         if (kdebug) {
 791                                 printk("remcomInBuffer: %s\n", remcomInBuffer);
 792                                 printk("remcomOutBuffer: %s\n", remcomOutBuffer);
 793                         }
 794                         return 1;
 795
 796                 case 'r':               /* Reset (if user process..exit ???)*/
 797                         panic("kgdb reset.");
 798                         break;
 799                 }                       /* switch */
 800                 if (remcomOutBuffer[0] && kdebug) {
 801                         printk("remcomInBuffer: %s\n", remcomInBuffer);
 802                         printk("remcomOutBuffer: %s\n", remcomOutBuffer);
 803                 }
 804                 /* reply to the request */
 805                 putpacket(remcomOutBuffer);
 806         } /* while(1) */
 807 }
 808
 809 /* This function will generate a breakpoint exception.  It is used at the
 810    beginning of a program to sync up with a debugger and can be used
 811    otherwise as a quick means to stop program execution and "break" into
 812    the debugger. */
 813
 814 void
 815 breakpoint(void)
 816 {
 817         if (!initialized) {
 818                 printk("breakpoint() called b4 kgdb init\n");
 819                 return;
 820         }
 821
 822         asm("   .globl breakinst        \n\
 823              breakinst: .long 0x7d821008");
 824 }
 825
 826 #ifdef CONFIG_KGDB_CONSOLE
 827 /* Output string in GDB O-packet format if GDB has connected. If nothing
 828    output, returns 0 (caller must then handle output). */
 829 int
 830 kgdb_output_string (const char* s, unsigned int count)
 831 {
 832         char buffer[512];
 833
 834         if (!kgdb_started)
 835                 return 0;
 836
 837         count = (count <= (sizeof(buffer) / 2 - 2))
 838                 ? count : (sizeof(buffer) / 2 - 2);
 839
 840         buffer[0] = 'O';
 841         mem2hex (s, &buffer[1], count);
 842         putpacket(buffer);
 843
 844         return 1;
 845 }
 846 #endif
 847
 848 static void sysrq_handle_gdb(int key, struct pt_regs *pt_regs,
 849                              struct tty_struct *tty)
 850 {
 851         printk("Entering GDB stub\n");
 852         breakpoint();
 853 }
 854 static struct sysrq_key_op sysrq_gdb_op = {
 855         .handler        = sysrq_handle_gdb,
 856         .help_msg       = "Gdb",
 857         .action_msg     = "GDB",
 858 };
 859
 860 static int gdb_register_sysrq(void)
 861 {
 862         printk("Registering GDB sysrq handler\n");
 863         register_sysrq_key('g', &sysrq_gdb_op);
 864         return 0;
 865 }
 866 module_init(gdb_register_sysrq);