gdb/i386-stub.c

   1 /****************************************************************************
   2
   3                 THIS SOFTWARE IS NOT COPYRIGHTED
   4
   5    HP offers the following for use in the public domain.  HP makes no
   6    warranty with regard to the software or it's performance and the
   7    user accepts the software "AS IS" with all faults.
   8
   9    HP DISCLAIMS ANY WARRANTIES, EXPRESS OR IMPLIED, WITH REGARD
  10    TO THIS SOFTWARE INCLUDING BUT NOT LIMITED TO THE WARRANTIES
  11    OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE.
  12
  13 ****************************************************************************/
  14
  15 /****************************************************************************
  16  *  Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $
  17  *
  18  *  Module name: remcom.c $
  19  *  Revision: 1.34 $
  20  *  Date: 91/03/09 12:29:49 $
  21  *  Contributor:     Lake Stevens Instrument Division$
  22  *
  23  *  Description:     low level support for gdb debugger. $
  24  *
  25  *  Considerations:  only works on target hardware $
  26  *
  27  *  Written by:      Glenn Engel $
  28  *  ModuleState:     Experimental $
  29  *
  30  *  NOTES:           See Below $
  31  *
  32  *  Modified for 386 by Jim Kingdon, Cygnus Support.
  33  *
  34  *  To enable debugger support, two things need to happen.  One, a
  35  *  call to set_debug_traps() is necessary in order to allow any breakpoints
  36  *  or error conditions to be properly intercepted and reported to gdb.
  37  *  Two, a breakpoint needs to be generated to begin communication.  This
  38  *  is most easily accomplished by a call to breakpoint().  Breakpoint()
  39  *  simulates a breakpoint by executing a trap #1.
  40  *
  41  *  The external function exceptionHandler() is
  42  *  used to attach a specific handler to a specific 386 vector number.
  43  *  It should use the same privilege level it runs at.  It should
  44  *  install it as an interrupt gate so that interrupts are masked
  45  *  while the handler runs.
  46  *
  47  *  Because gdb will sometimes write to the stack area to execute function
  48  *  calls, this program cannot rely on using the supervisor stack so it
  49  *  uses it's own stack area reserved in the int array remcomStack.
  50  *
  51  *************
  52  *
  53  *    The following gdb commands are supported:
  54  *
  55  * command          function                               Return value
  56  *
  57  *    g             return the value of the CPU registers  hex data or ENN
  58  *    G             set the value of the CPU registers     OK or ENN
  59  *
  60  *    mAA..AA,LLLL  Read LLLL bytes at address AA..AA      hex data or ENN
  61  *    MAA..AA,LLLL: Write LLLL bytes at address AA.AA      OK or ENN
  62  *
  63  *    c             Resume at current address              SNN   ( signal NN)
  64  *    cAA..AA       Continue at address AA..AA             SNN
  65  *
  66  *    s             Step one instruction                   SNN
  67  *    sAA..AA       Step one instruction from AA..AA       SNN
  68  *
  69  *    k             kill
  70  *
  71  *    ?             What was the last sigval ?             SNN   (signal NN)
  72  *
  73  * All commands and responses are sent with a packet which includes a
  74  * checksum.  A packet consists of
  75  *
  76  * $<packet info>#<checksum>.
  77  *
  78  * where
  79  * <packet info> :: <characters representing the command or response>
  80  * <checksum>    :: < two hex digits computed as modulo 256 sum of <packetinfo>>
  81  *
  82  * When a packet is received, it is first acknowledged with either '+' or '-'.
  83  * '+' indicates a successful transfer.  '-' indicates a failed transfer.
  84  *
  85  * Example:
  86  *
  87  * Host:                  Reply:
  88  * $m0,10#2a               +$00010203040506070809101112131415#42
  89  *
  90  ****************************************************************************/
  91
  92 #include <stdio.h>
  93 #include <string.h>
  94
  95 /************************************************************************
  96  *
  97  * external low-level support routines
  98  */
  99
 100 extern void putDebugChar();     /* write a single character      */
 101 extern int getDebugChar();      /* read and return a single char */
 102 extern void exceptionHandler(); /* assign an exception handler   */
 103
 104 /************************************************************************/
 105 /* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/
 106 /* at least NUMREGBYTES*2 are needed for register packets */
 107 #define BUFMAX 400
 108
 109 static char initialized;  /* boolean flag. != 0 means we've been initialized */
 110
 111 int     remote_debug;
 112 /*  debug >  0 prints ill-formed commands in valid packets & checksum errors */
 113
 114 static const char hexchars[]="0123456789abcdef";
 115
 116 /* Number of registers.  */
 117 #define NUMREGS 16
 118
 119 /* Number of bytes of registers.  */
 120 #define NUMREGBYTES (NUMREGS * 4)
 121
 122 enum regnames {EAX, ECX, EDX, EBX, ESP, EBP, ESI, EDI,
 123                PC /* also known as eip */,
 124                PS /* also known as eflags */,
 125                CS, SS, DS, ES, FS, GS};
 126
 127 /*
 128  * these should not be static cuz they can be used outside this module
 129  */
 130 int registers[NUMREGS];
 131
 132 #define STACKSIZE 10000
 133 int remcomStack[STACKSIZE/sizeof(int)];
 134 static int* stackPtr = &remcomStack[STACKSIZE/sizeof(int) - 1];
 135
 136 /***************************  ASSEMBLY CODE MACROS *************************/
 137 /*                                                                         */
 138
 139 extern void
 140 return_to_prog ();
 141
 142 /* Restore the program's registers (including the stack pointer, which
 143    means we get the right stack and don't have to worry about popping our
 144    return address and any stack frames and so on) and return.  */
 145 asm(".text");
 146 asm(".globl _return_to_prog");
 147 asm("_return_to_prog:");
 148 asm("        movw _registers+44, %ss");
 149 asm("        movl _registers+16, %esp");
 150 asm("        movl _registers+4, %ecx");
 151 asm("        movl _registers+8, %edx");
 152 asm("        movl _registers+12, %ebx");
 153 asm("        movl _registers+20, %ebp");
 154 asm("        movl _registers+24, %esi");
 155 asm("        movl _registers+28, %edi");
 156 asm("        movw _registers+48, %ds");
 157 asm("        movw _registers+52, %es");
 158 asm("        movw _registers+56, %fs");
 159 asm("        movw _registers+60, %gs");
 160 asm("        movl _registers+36, %eax");
 161 asm("        pushl %eax");  /* saved eflags */
 162 asm("        movl _registers+40, %eax");
 163 asm("        pushl %eax");  /* saved cs */
 164 asm("        movl _registers+32, %eax");
 165 asm("        pushl %eax");  /* saved eip */
 166 asm("        movl _registers, %eax");
 167 /* use iret to restore pc and flags together so
 168    that trace flag works right.  */
 169 asm("        iret");
 170
 171 #define BREAKPOINT() asm("   int $3");
 172
 173 /* Put the error code here just in case the user cares.  */
 174 int gdb_i386errcode;
 175 /* Likewise, the vector number here (since GDB only gets the signal
 176    number through the usual means, and that's not very specific).  */
 177 int gdb_i386vector = -1;
 178
 179 /* GDB stores segment registers in 32-bit words (that's just the way
 180    m-i386v.h is written).  So zero the appropriate areas in registers.  */
 181 #define SAVE_REGISTERS1() \
 182   asm ("movl %eax, _registers");                                          \
 183   asm ("movl %ecx, _registers+4");                                           \
 184   asm ("movl %edx, _registers+8");                                           \
 185   asm ("movl %ebx, _registers+12");                                          \
 186   asm ("movl %ebp, _registers+20");                                          \
 187   asm ("movl %esi, _registers+24");                                          \
 188   asm ("movl %edi, _registers+28");                                          \
 189   asm ("movw $0, %ax");                                                      \
 190   asm ("movw %ds, _registers+48");                                           \
 191   asm ("movw %ax, _registers+50");                                           \
 192   asm ("movw %es, _registers+52");                                           \
 193   asm ("movw %ax, _registers+54");                                           \
 194   asm ("movw %fs, _registers+56");                                           \
 195   asm ("movw %ax, _registers+58");                                           \
 196   asm ("movw %gs, _registers+60");                                           \
 197   asm ("movw %ax, _registers+62");
 198 #define SAVE_ERRCODE() \
 199   asm ("popl %ebx");                                  \
 200   asm ("movl %ebx, _gdb_i386errcode");
 201 #define SAVE_REGISTERS2() \
 202   asm ("popl %ebx"); /* old eip */                                           \
 203   asm ("movl %ebx, _registers+32");                                          \
 204   asm ("popl %ebx");     /* old cs */                                        \
 205   asm ("movl %ebx, _registers+40");                                          \
 206   asm ("movw %ax, _registers+42");                                           \
 207   asm ("popl %ebx");     /* old eflags */                                    \
 208   asm ("movl %ebx, _registers+36");                                          \
 209   /* Now that we've done the pops, we can save the stack pointer.");  */   \
 210   asm ("movw %ss, _registers+44");                                           \
 211   asm ("movw %ax, _registers+46");                                           \
 212   asm ("movl %esp, _registers+16");
 213
 214 /* See if mem_fault_routine is set, if so just IRET to that address.  */
 215 #define CHECK_FAULT() \
 216   asm ("cmpl $0, _mem_fault_routine");                                     \
 217   asm ("jne mem_fault");
 218
 219 asm (".text");
 220 asm ("mem_fault:");
 221 /* OK to clobber temp registers; we're just going to end up in set_mem_err.  */
 222 /* Pop error code from the stack and save it.  */
 223 asm ("     popl %eax");
 224 asm ("     movl %eax, _gdb_i386errcode");
 225
 226 asm ("     popl %eax"); /* eip */
 227 /* We don't want to return there, we want to return to the function
 228    pointed to by mem_fault_routine instead.  */
 229 asm ("     movl _mem_fault_routine, %eax");
 230 asm ("     popl %ecx"); /* cs (low 16 bits; junk in hi 16 bits).  */
 231 asm ("     popl %edx"); /* eflags */
 232
 233 /* Remove this stack frame; when we do the iret, we will be going to
 234    the start of a function, so we want the stack to look just like it
 235    would after a "call" instruction.  */
 236 asm ("     leave");
 237
 238 /* Push the stuff that iret wants.  */
 239 asm ("     pushl %edx"); /* eflags */
 240 asm ("     pushl %ecx"); /* cs */
 241 asm ("     pushl %eax"); /* eip */
 242
 243 /* Zero mem_fault_routine.  */
 244 asm ("     movl $0, %eax");
 245 asm ("     movl %eax, _mem_fault_routine");
 246
 247 asm ("iret");
 248
 249 #define CALL_HOOK() asm("call _remcomHandler");
 250
 251 /* This function is called when a i386 exception occurs.  It saves
 252  * all the cpu regs in the _registers array, munges the stack a bit,
 253  * and invokes an exception handler (remcom_handler).
 254  *
 255  * stack on entry:                       stack on exit:
 256  *   old eflags                          vector number
 257  *   old cs (zero-filled to 32 bits)
 258  *   old eip
 259  *
 260  */
 261 extern void _catchException3();
 262 asm(".text");
 263 asm(".globl __catchException3");
 264 asm("__catchException3:");
 265 SAVE_REGISTERS1();
 266 SAVE_REGISTERS2();
 267 asm ("pushl $3");
 268 CALL_HOOK();
 269
 270 /* Same thing for exception 1.  */
 271 extern void _catchException1();
 272 asm(".text");
 273 asm(".globl __catchException1");
 274 asm("__catchException1:");
 275 SAVE_REGISTERS1();
 276 SAVE_REGISTERS2();
 277 asm ("pushl $1");
 278 CALL_HOOK();
 279
 280 /* Same thing for exception 0.  */
 281 extern void _catchException0();
 282 asm(".text");
 283 asm(".globl __catchException0");
 284 asm("__catchException0:");
 285 SAVE_REGISTERS1();
 286 SAVE_REGISTERS2();
 287 asm ("pushl $0");
 288 CALL_HOOK();
 289
 290 /* Same thing for exception 4.  */
 291 extern void _catchException4();
 292 asm(".text");
 293 asm(".globl __catchException4");
 294 asm("__catchException4:");
 295 SAVE_REGISTERS1();
 296 SAVE_REGISTERS2();
 297 asm ("pushl $4");
 298 CALL_HOOK();
 299
 300 /* Same thing for exception 5.  */
 301 extern void _catchException5();
 302 asm(".text");
 303 asm(".globl __catchException5");
 304 asm("__catchException5:");
 305 SAVE_REGISTERS1();
 306 SAVE_REGISTERS2();
 307 asm ("pushl $5");
 308 CALL_HOOK();
 309
 310 /* Same thing for exception 6.  */
 311 extern void _catchException6();
 312 asm(".text");
 313 asm(".globl __catchException6");
 314 asm("__catchException6:");
 315 SAVE_REGISTERS1();
 316 SAVE_REGISTERS2();
 317 asm ("pushl $6");
 318 CALL_HOOK();
 319
 320 /* Same thing for exception 7.  */
 321 extern void _catchException7();
 322 asm(".text");
 323 asm(".globl __catchException7");
 324 asm("__catchException7:");
 325 SAVE_REGISTERS1();
 326 SAVE_REGISTERS2();
 327 asm ("pushl $7");
 328 CALL_HOOK();
 329
 330 /* Same thing for exception 8.  */
 331 extern void _catchException8();
 332 asm(".text");
 333 asm(".globl __catchException8");
 334 asm("__catchException8:");
 335 SAVE_REGISTERS1();
 336 SAVE_ERRCODE();
 337 SAVE_REGISTERS2();
 338 asm ("pushl $8");
 339 CALL_HOOK();
 340
 341 /* Same thing for exception 9.  */
 342 extern void _catchException9();
 343 asm(".text");
 344 asm(".globl __catchException9");
 345 asm("__catchException9:");
 346 SAVE_REGISTERS1();
 347 SAVE_REGISTERS2();
 348 asm ("pushl $9");
 349 CALL_HOOK();
 350
 351 /* Same thing for exception 10.  */
 352 extern void _catchException10();
 353 asm(".text");
 354 asm(".globl __catchException10");
 355 asm("__catchException10:");
 356 SAVE_REGISTERS1();
 357 SAVE_ERRCODE();
 358 SAVE_REGISTERS2();
 359 asm ("pushl $10");
 360 CALL_HOOK();
 361
 362 /* Same thing for exception 12.  */
 363 extern void _catchException12();
 364 asm(".text");
 365 asm(".globl __catchException12");
 366 asm("__catchException12:");
 367 SAVE_REGISTERS1();
 368 SAVE_ERRCODE();
 369 SAVE_REGISTERS2();
 370 asm ("pushl $12");
 371 CALL_HOOK();
 372
 373 /* Same thing for exception 16.  */
 374 extern void _catchException16();
 375 asm(".text");
 376 asm(".globl __catchException16");
 377 asm("__catchException16:");
 378 SAVE_REGISTERS1();
 379 SAVE_REGISTERS2();
 380 asm ("pushl $16");
 381 CALL_HOOK();
 382
 383 /* For 13, 11, and 14 we have to deal with the CHECK_FAULT stuff.  */
 384
 385 /* Same thing for exception 13.  */
 386 extern void _catchException13 ();
 387 asm (".text");
 388 asm (".globl __catchException13");
 389 asm ("__catchException13:");
 390 CHECK_FAULT();
 391 SAVE_REGISTERS1();
 392 SAVE_ERRCODE();
 393 SAVE_REGISTERS2();
 394 asm ("pushl $13");
 395 CALL_HOOK();
 396
 397 /* Same thing for exception 11.  */
 398 extern void _catchException11 ();
 399 asm (".text");
 400 asm (".globl __catchException11");
 401 asm ("__catchException11:");
 402 CHECK_FAULT();
 403 SAVE_REGISTERS1();
 404 SAVE_ERRCODE();
 405 SAVE_REGISTERS2();
 406 asm ("pushl $11");
 407 CALL_HOOK();
 408
 409 /* Same thing for exception 14.  */
 410 extern void _catchException14 ();
 411 asm (".text");
 412 asm (".globl __catchException14");
 413 asm ("__catchException14:");
 414 CHECK_FAULT();
 415 SAVE_REGISTERS1();
 416 SAVE_ERRCODE();
 417 SAVE_REGISTERS2();
 418 asm ("pushl $14");
 419 CALL_HOOK();
 420
 421 /*
 422  * remcomHandler is a front end for handle_exception.  It moves the
 423  * stack pointer into an area reserved for debugger use.
 424  */
 425 asm("_remcomHandler:");
 426 asm("           popl %eax");        /* pop off return address     */
 427 asm("           popl %eax");      /* get the exception number   */
 428 asm("           movl _stackPtr, %esp"); /* move to remcom stack area  */
 429 asm("           pushl %eax");   /* push exception onto stack  */
 430 asm("           call  _handle_exception");    /* this never returns */
 431
 432 void
 433 _returnFromException ()
 434 {
 435   return_to_prog ();
 436 }
 437
 438 int
 439 hex (ch)
 440      char ch;
 441 {
 442   if ((ch >= 'a') && (ch <= 'f'))
 443     return (ch - 'a' + 10);
 444   if ((ch >= '0') && (ch <= '9'))
 445     return (ch - '0');
 446   if ((ch >= 'A') && (ch <= 'F'))
 447     return (ch - 'A' + 10);
 448   return (-1);
 449 }
 450
 451 static char remcomInBuffer[BUFMAX];
 452 static char remcomOutBuffer[BUFMAX];
 453
 454 /* scan for the sequence $<data>#<checksum>     */
 455
 456 unsigned char *
 457 getpacket (void)
 458 {
 459   unsigned char *buffer = &remcomInBuffer[0];
 460   unsigned char checksum;
 461   unsigned char xmitcsum;
 462   int count;
 463   char ch;
 464
 465   while (1)
 466     {
 467       /* wait around for the start character, ignore all other characters */
 468       while ((ch = getDebugChar ()) != '$')
 469         ;
 470
 471     retry:
 472       checksum = 0;
 473       xmitcsum = -1;
 474       count = 0;
 475
 476       /* now, read until a # or end of buffer is found */
 477       while (count < BUFMAX)
 478         {
 479           ch = getDebugChar ();
 480           if (ch == '$')
 481             goto retry;
 482           if (ch == '#')
 483             break;
 484           checksum = checksum + ch;
 485           buffer[count] = ch;
 486           count = count + 1;
 487         }
 488       buffer[count] = 0;
 489
 490       if (ch == '#')
 491         {
 492           ch = getDebugChar ();
 493           xmitcsum = hex (ch) << 4;
 494           ch = getDebugChar ();
 495           xmitcsum += hex (ch);
 496
 497           if (checksum != xmitcsum)
 498             {
 499               if (remote_debug)
 500                 {
 501                   fprintf (stderr,
 502                            "bad checksum.  My count = 0x%x, sent=0x%x. buf=%s\n",
 503                            checksum, xmitcsum, buffer);
 504                 }
 505               putDebugChar ('-');       /* failed checksum */
 506             }
 507           else
 508             {
 509               putDebugChar ('+');       /* successful transfer */
 510
 511               /* if a sequence char is present, reply the sequence ID */
 512               if (buffer[2] == ':')
 513                 {
 514                   putDebugChar (buffer[0]);
 515                   putDebugChar (buffer[1]);
 516
 517                   return &buffer[3];
 518                 }
 519
 520               return &buffer[0];
 521             }
 522         }
 523     }
 524 }
 525
 526 /* send the packet in buffer.  */
 527
 528 void
 529 putpacket (unsigned char *buffer)
 530 {
 531   unsigned char checksum;
 532   int count;
 533   char ch;
 534
 535   /*  $<packet info>#<checksum>. */
 536   do
 537     {
 538       putDebugChar ('$');
 539       checksum = 0;
 540       count = 0;
 541
 542       while (ch = buffer[count])
 543         {
 544           putDebugChar (ch);
 545           checksum += ch;
 546           count += 1;
 547         }
 548
 549       putDebugChar ('#');
 550       putDebugChar (hexchars[checksum >> 4]);
 551       putDebugChar (hexchars[checksum % 16]);
 552
 553     }
 554   while (getDebugChar () != '+');
 555 }
 556
 557 void
 558 debug_error (format, parm)
 559      char *format;
 560      char *parm;
 561 {
 562   if (remote_debug)
 563     fprintf (stderr, format, parm);
 564 }
 565
 566 /* Address of a routine to RTE to if we get a memory fault.  */
 567 static void (*volatile mem_fault_routine) () = NULL;
 568
 569 /* Indicate to caller of mem2hex or hex2mem that there has been an
 570    error.  */
 571 static volatile int mem_err = 0;
 572
 573 void
 574 set_mem_err (void)
 575 {
 576   mem_err = 1;
 577 }
 578
 579 /* These are separate functions so that they are so short and sweet
 580    that the compiler won't save any registers (if there is a fault
 581    to mem_fault, they won't get restored, so there better not be any
 582    saved).  */
 583 int
 584 get_char (char *addr)
 585 {
 586   return *addr;
 587 }
 588
 589 void
 590 set_char (char *addr, int val)
 591 {
 592   *addr = val;
 593 }
 594
 595 /* convert the memory pointed to by mem into hex, placing result in buf */
 596 /* return a pointer to the last char put in buf (null) */
 597 /* If MAY_FAULT is non-zero, then we should set mem_err in response to
 598    a fault; if zero treat a fault like any other fault in the stub.  */
 599 char *
 600 mem2hex (mem, buf, count, may_fault)
 601      char *mem;
 602      char *buf;
 603      int count;
 604      int may_fault;
 605 {
 606   int i;
 607   unsigned char ch;
 608
 609   if (may_fault)
 610     mem_fault_routine = set_mem_err;
 611   for (i = 0; i < count; i++)
 612     {
 613       ch = get_char (mem++);
 614       if (may_fault && mem_err)
 615         return (buf);
 616       *buf++ = hexchars[ch >> 4];
 617       *buf++ = hexchars[ch % 16];
 618     }
 619   *buf = 0;
 620   if (may_fault)
 621     mem_fault_routine = NULL;
 622   return (buf);
 623 }
 624
 625 /* convert the hex array pointed to by buf into binary to be placed in mem */
 626 /* return a pointer to the character AFTER the last byte written */
 627 char *
 628 hex2mem (buf, mem, count, may_fault)
 629      char *buf;
 630      char *mem;
 631      int count;
 632      int may_fault;
 633 {
 634   int i;
 635   unsigned char ch;
 636
 637   if (may_fault)
 638     mem_fault_routine = set_mem_err;
 639   for (i = 0; i < count; i++)
 640     {
 641       ch = hex (*buf++) << 4;
 642       ch = ch + hex (*buf++);
 643       set_char (mem++, ch);
 644       if (may_fault && mem_err)
 645         return (mem);
 646     }
 647   if (may_fault)
 648     mem_fault_routine = NULL;
 649   return (mem);
 650 }
 651
 652 /* this function takes the 386 exception vector and attempts to
 653    translate this number into a unix compatible signal value */
 654 int
 655 computeSignal (int exceptionVector)
 656 {
 657   int sigval;
 658   switch (exceptionVector)
 659     {
 660     case 0:
 661       sigval = 8;
 662       break;                    /* divide by zero */
 663     case 1:
 664       sigval = 5;
 665       break;                    /* debug exception */
 666     case 3:
 667       sigval = 5;
 668       break;                    /* breakpoint */
 669     case 4:
 670       sigval = 16;
 671       break;                    /* into instruction (overflow) */
 672     case 5:
 673       sigval = 16;
 674       break;                    /* bound instruction */
 675     case 6:
 676       sigval = 4;
 677       break;                    /* Invalid opcode */
 678     case 7:
 679       sigval = 8;
 680       break;                    /* coprocessor not available */
 681     case 8:
 682       sigval = 7;
 683       break;                    /* double fault */
 684     case 9:
 685       sigval = 11;
 686       break;                    /* coprocessor segment overrun */
 687     case 10:
 688       sigval = 11;
 689       break;                    /* Invalid TSS */
 690     case 11:
 691       sigval = 11;
 692       break;                    /* Segment not present */
 693     case 12:
 694       sigval = 11;
 695       break;                    /* stack exception */
 696     case 13:
 697       sigval = 11;
 698       break;                    /* general protection */
 699     case 14:
 700       sigval = 11;
 701       break;                    /* page fault */
 702     case 16:
 703       sigval = 7;
 704       break;                    /* coprocessor error */
 705     default:
 706       sigval = 7;               /* "software generated" */
 707     }
 708   return (sigval);
 709 }
 710
 711 /**********************************************/
 712 /* WHILE WE FIND NICE HEX CHARS, BUILD AN INT */
 713 /* RETURN NUMBER OF CHARS PROCESSED           */
 714 /**********************************************/
 715 int
 716 hexToInt (char **ptr, int *intValue)
 717 {
 718   int numChars = 0;
 719   int hexValue;
 720
 721   *intValue = 0;
 722
 723   while (**ptr)
 724     {
 725       hexValue = hex (**ptr);
 726       if (hexValue >= 0)
 727         {
 728           *intValue = (*intValue << 4) | hexValue;
 729           numChars++;
 730         }
 731       else
 732         break;
 733
 734       (*ptr)++;
 735     }
 736
 737   return (numChars);
 738 }
 739
 740 /*
 741  * This function does all command procesing for interfacing to gdb.
 742  */
 743 void
 744 handle_exception (int exceptionVector)
 745 {
 746   int sigval, stepping;
 747   int addr, length;
 748   char *ptr;
 749   int newPC;
 750
 751   gdb_i386vector = exceptionVector;
 752
 753   if (remote_debug)
 754     {
 755       printf ("vector=%d, sr=0x%x, pc=0x%x\n",
 756               exceptionVector, registers[PS], registers[PC]);
 757     }
 758
 759   /* reply to host that an exception has occurred */
 760   sigval = computeSignal (exceptionVector);
 761   remcomOutBuffer[0] = 'S';
 762   remcomOutBuffer[1] = hexchars[sigval >> 4];
 763   remcomOutBuffer[2] = hexchars[sigval % 16];
 764   remcomOutBuffer[3] = 0;
 765
 766   putpacket (remcomOutBuffer);
 767
 768   stepping = 0;
 769
 770   while (1 == 1)
 771     {
 772       remcomOutBuffer[0] = 0;
 773       ptr = getpacket ();
 774
 775       switch (*ptr++)
 776         {
 777         case '?':
 778           remcomOutBuffer[0] = 'S';
 779           remcomOutBuffer[1] = hexchars[sigval >> 4];
 780           remcomOutBuffer[2] = hexchars[sigval % 16];
 781           remcomOutBuffer[3] = 0;
 782           break;
 783         case 'd':
 784           remote_debug = !(remote_debug);       /* toggle debug flag */
 785           break;
 786         case 'g':               /* return the value of the CPU registers */
 787           mem2hex ((char *) registers, remcomOutBuffer, NUMREGBYTES, 0);
 788           break;
 789         case 'G':               /* set the value of the CPU registers - return OK */
 790           hex2mem (ptr, (char *) registers, NUMREGBYTES, 0);
 791           strcpy (remcomOutBuffer, "OK");
 792           break;
 793         case 'P':               /* set the value of a single CPU register - return OK */
 794           {
 795             int regno;
 796
 797             if (hexToInt (&ptr, &regno) && *ptr++ == '=')
 798               if (regno >= 0 && regno < NUMREGS)
 799                 {
 800                   hex2mem (ptr, (char *) &registers[regno], 4, 0);
 801                   strcpy (remcomOutBuffer, "OK");
 802                   break;
 803                 }
 804
 805             strcpy (remcomOutBuffer, "E01");
 806             break;
 807           }
 808
 809           /* mAA..AA,LLLL  Read LLLL bytes at address AA..AA */
 810         case 'm':
 811           /* TRY TO READ %x,%x.  IF SUCCEED, SET PTR = 0 */
 812           if (hexToInt (&ptr, &addr))
 813             if (*(ptr++) == ',')
 814               if (hexToInt (&ptr, &length))
 815                 {
 816                   ptr = 0;
 817                   mem_err = 0;
 818                   mem2hex ((char *) addr, remcomOutBuffer, length, 1);
 819                   if (mem_err)
 820                     {
 821                       strcpy (remcomOutBuffer, "E03");
 822                       debug_error ("memory fault");
 823                     }
 824                 }
 825
 826           if (ptr)
 827             {
 828               strcpy (remcomOutBuffer, "E01");
 829             }
 830           break;
 831
 832           /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
 833         case 'M':
 834           /* TRY TO READ '%x,%x:'.  IF SUCCEED, SET PTR = 0 */
 835           if (hexToInt (&ptr, &addr))
 836             if (*(ptr++) == ',')
 837               if (hexToInt (&ptr, &length))
 838                 if (*(ptr++) == ':')
 839                   {
 840                     mem_err = 0;
 841                     hex2mem (ptr, (char *) addr, length, 1);
 842
 843                     if (mem_err)
 844                       {
 845                         strcpy (remcomOutBuffer, "E03");
 846                         debug_error ("memory fault");
 847                       }
 848                     else
 849                       {
 850                         strcpy (remcomOutBuffer, "OK");
 851                       }
 852
 853                     ptr = 0;
 854                   }
 855           if (ptr)
 856             {
 857               strcpy (remcomOutBuffer, "E02");
 858             }
 859           break;
 860
 861           /* cAA..AA    Continue at address AA..AA(optional) */
 862           /* sAA..AA   Step one instruction from AA..AA(optional) */
 863         case 's':
 864           stepping = 1;
 865         case 'c':
 866           /* try to read optional parameter, pc unchanged if no parm */
 867           if (hexToInt (&ptr, &addr))
 868             registers[PC] = addr;
 869
 870           newPC = registers[PC];
 871
 872           /* clear the trace bit */
 873           registers[PS] &= 0xfffffeff;
 874
 875           /* set the trace bit if we're stepping */
 876           if (stepping)
 877             registers[PS] |= 0x100;
 878
 879           _returnFromException ();      /* this is a jump */
 880           break;
 881
 882           /* kill the program */
 883         case 'k':               /* do nothing */
 884 #if 0
 885           /* Huh? This doesn't look like "nothing".
 886              m68k-stub.c and sparc-stub.c don't have it.  */
 887           BREAKPOINT ();
 888 #endif
 889           break;
 890         }                       /* switch */
 891
 892       /* reply to the request */
 893       putpacket (remcomOutBuffer);
 894     }
 895 }
 896
 897 /* this function is used to set up exception handlers for tracing and
 898    breakpoints */
 899 void
 900 set_debug_traps (void)
 901 {
 902   stackPtr = &remcomStack[STACKSIZE / sizeof (int) - 1];
 903
 904   exceptionHandler (0, _catchException0);
 905   exceptionHandler (1, _catchException1);
 906   exceptionHandler (3, _catchException3);
 907   exceptionHandler (4, _catchException4);
 908   exceptionHandler (5, _catchException5);
 909   exceptionHandler (6, _catchException6);
 910   exceptionHandler (7, _catchException7);
 911   exceptionHandler (8, _catchException8);
 912   exceptionHandler (9, _catchException9);
 913   exceptionHandler (10, _catchException10);
 914   exceptionHandler (11, _catchException11);
 915   exceptionHandler (12, _catchException12);
 916   exceptionHandler (13, _catchException13);
 917   exceptionHandler (14, _catchException14);
 918   exceptionHandler (16, _catchException16);
 919
 920   initialized = 1;
 921 }
 922
 923 /* This function will generate a breakpoint exception.  It is used at the
 924    beginning of a program to sync up with a debugger and can be used
 925    otherwise as a quick means to stop program execution and "break" into
 926    the debugger. */
 927
 928 void
 929 breakpoint (void)
 930 {
 931   if (initialized)
 932     BREAKPOINT ();
 933 }