1 /****************************************************************************
3 THIS SOFTWARE IS NOT COPYRIGHTED
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.
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.
13 ****************************************************************************/
15 /****************************************************************************
16 * Header: remcom.c,v 1.34 91/03/09 12:29:49 glenne Exp $
18 * Module name: remcom.c $
20 * Date: 91/03/09 12:29:49 $
21 * Contributor: Lake Stevens Instrument Division$
23 * Description: low level support for gdb debugger. $
25 * Considerations: only works on target hardware $
27 * Written by: Glenn Engel $
28 * ModuleState: Experimental $
32 * Modified for SPARC by Stu Grossman, Cygnus Support.
34 * This code has been extensively tested on the Fujitsu SPARClite demo board.
36 * To enable debugger support, two things need to happen. One, a
37 * call to set_debug_traps() is necessary in order to allow any breakpoints
38 * or error conditions to be properly intercepted and reported to gdb.
39 * Two, a breakpoint needs to be generated to begin communication. This
40 * is most easily accomplished by a call to breakpoint(). Breakpoint()
41 * simulates a breakpoint by executing a trap #1.
45 * The following gdb commands are supported:
47 * command function Return value
49 * g return the value of the CPU registers hex data or ENN
50 * G set the value of the CPU registers OK or ENN
52 * mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN
53 * MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN
55 * c Resume at current address SNN ( signal NN)
56 * cAA..AA Continue at address AA..AA SNN
58 * s Step one instruction SNN
59 * sAA..AA Step one instruction from AA..AA SNN
63 * ? What was the last sigval ? SNN (signal NN)
65 * All commands and responses are sent with a packet which includes a
66 * checksum. A packet consists of
68 * $<packet info>#<checksum>.
71 * <packet info> :: <characters representing the command or response>
72 * <checksum> :: < two hex digits computed as modulo 256 sum of <packetinfo>>
74 * When a packet is received, it is first acknowledged with either '+' or '-'.
75 * '+' indicates a successful transfer. '-' indicates a failed transfer.
80 * $m0,10#2a +$00010203040506070809101112131415#42
82 ****************************************************************************/
87 /************************************************************************
89 * external low-level support routines
92 extern void putDebugChar(); /* write a single character */
93 extern int getDebugChar(); /* read and return a single char */
95 /************************************************************************/
96 /* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/
97 /* at least NUMREGBYTES*2 are needed for register packets */
100 static int initialized = 0; /* !0 means we've been initialized */
102 static void set_mem_fault_trap();
104 static const char hexchars[]="0123456789abcdef";
108 /* Number of bytes of registers. */
109 #define NUMREGBYTES (NUMREGS * 4)
110 enum regnames {G0, G1, G2, G3, G4, G5, G6, G7,
111 O0, O1, O2, O3, O4, O5, SP, O7,
112 L0, L1, L2, L3, L4, L5, L6, L7,
113 I0, I1, I2, I3, I4, I5, FP, I7,
115 F0, F1, F2, F3, F4, F5, F6, F7,
116 F8, F9, F10, F11, F12, F13, F14, F15,
117 F16, F17, F18, F19, F20, F21, F22, F23,
118 F24, F25, F26, F27, F28, F29, F30, F31,
119 Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR };
121 /*************************** ASSEMBLY CODE MACROS *************************/
124 extern void trap_low();
127 .reserve trapstack, 1000 * 4, \"bss\", 8
138 ! This function is called when any SPARC trap (except window overflow or
139 ! underflow) occurs. It makes sure that the invalid register window is still
140 ! available before jumping into C code. It will also restore the world if you
141 ! return from handle_exception.
148 srl %l3, %l0, %l4 ! wim >> cwp
150 bne window_fine ! Branch if not in the invalid window
153 ! Handle window overflow
155 mov %g1, %l4 ! Save g1, we use it to hold the wim
156 srl %l3, 1, %g1 ! Rotate wim right
158 bg good_wim ! Branch if new wim is non-zero
161 ! At this point, we need to bring a 1 into the high order bit of the wim.
162 ! Since we don't want to make any assumptions about the number of register
163 ! windows, we figure it out dynamically so as to setup the wim correctly.
165 not %g1 ! Fill g1 with ones
166 mov %g1, %wim ! Fill the wim with ones
170 mov %wim, %g1 ! Read back the wim
171 inc %g1 ! Now g1 has 1 just to left of wim
172 srl %g1, 1, %g1 ! Now put 1 at top of wim
173 mov %g0, %wim ! Clear wim so that subsequent save
179 save %g0, %g0, %g0 ! Slip into next window
180 mov %g1, %wim ! Install the new wim
182 std %l0, [%sp + 0 * 4] ! save L & I registers
183 std %l2, [%sp + 2 * 4]
184 std %l4, [%sp + 4 * 4]
185 std %l6, [%sp + 6 * 4]
187 std %i0, [%sp + 8 * 4]
188 std %i2, [%sp + 10 * 4]
189 std %i4, [%sp + 12 * 4]
190 std %i6, [%sp + 14 * 4]
192 restore ! Go back to trap window.
193 mov %l4, %g1 ! Restore %g1
196 sethi %hi(in_trap_handler), %l4
197 ld [%lo(in_trap_handler) + %l4], %l5
202 set trapstack+1000*4, %sp ! Switch to trap stack
205 st %l5, [%lo(in_trap_handler) + %l4]
206 sub %sp,(16+1+6+1+72)*4,%sp ! Make room for input & locals
207 ! + hidden arg + arg spill
208 ! + doubleword alignment
209 ! + registers[72] local var
211 std %g0, [%sp + (24 + 0) * 4] ! registers[Gx]
212 std %g2, [%sp + (24 + 2) * 4]
213 std %g4, [%sp + (24 + 4) * 4]
214 std %g6, [%sp + (24 + 6) * 4]
216 std %i0, [%sp + (24 + 8) * 4] ! registers[Ox]
217 std %i2, [%sp + (24 + 10) * 4]
218 std %i4, [%sp + (24 + 12) * 4]
219 std %i6, [%sp + (24 + 14) * 4]
220 ! F0->F31 not implemented
223 st %l4, [%sp + (24 + 64) * 4] ! Y
224 st %l0, [%sp + (24 + 65) * 4] ! PSR
225 st %l3, [%sp + (24 + 66) * 4] ! WIM
226 st %l5, [%sp + (24 + 67) * 4] ! TBR
227 st %l1, [%sp + (24 + 68) * 4] ! PC
228 st %l2, [%sp + (24 + 69) * 4] ! NPC
230 ! CPSR and FPSR not impl
233 mov %l4, %psr ! Turn on traps, disable interrupts
235 call _handle_exception
236 add %sp, 24 * 4, %o0 ! Pass address of registers
238 ! Reload all of the registers that aren't on the stack
240 ld [%sp + (24 + 1) * 4], %g1 ! registers[Gx]
241 ldd [%sp + (24 + 2) * 4], %g2
242 ldd [%sp + (24 + 4) * 4], %g4
243 ldd [%sp + (24 + 6) * 4], %g6
245 ldd [%sp + (24 + 8) * 4], %i0 ! registers[Ox]
246 ldd [%sp + (24 + 10) * 4], %i2
247 ldd [%sp + (24 + 12) * 4], %i4
248 ldd [%sp + (24 + 14) * 4], %i6
250 ldd [%sp + (24 + 64) * 4], %l0 ! Y & PSR
251 ldd [%sp + (24 + 68) * 4], %l2 ! PC & NPC
253 restore ! Ensure that previous window is valid
254 save %g0, %g0, %g0 ! by causing a window_underflow trap
257 mov %l1, %psr ! Make sure that traps are disabled
260 sethi %hi(in_trap_handler), %l4
261 ld [%lo(in_trap_handler) + %l4], %l5
263 st %l5, [%lo(in_trap_handler) + %l4]
265 jmpl %l2, %g0 ! Restore old PC
266 rett %l3 ! Restore old nPC
269 /* Convert ch from a hex digit to an int */
272 hex (unsigned char ch)
274 if (ch >= 'a' && ch <= 'f')
276 if (ch >= '0' && ch <= '9')
278 if (ch >= 'A' && ch <= 'F')
283 static char remcomInBuffer[BUFMAX];
284 static char remcomOutBuffer[BUFMAX];
286 /* scan for the sequence $<data>#<checksum> */
291 unsigned char *buffer = &remcomInBuffer[0];
292 unsigned char checksum;
293 unsigned char xmitcsum;
299 /* wait around for the start character, ignore all other characters */
300 while ((ch = getDebugChar ()) != '$')
308 /* now, read until a # or end of buffer is found */
309 while (count < BUFMAX)
311 ch = getDebugChar ();
316 checksum = checksum + ch;
324 ch = getDebugChar ();
325 xmitcsum = hex (ch) << 4;
326 ch = getDebugChar ();
327 xmitcsum += hex (ch);
329 if (checksum != xmitcsum)
331 putDebugChar ('-'); /* failed checksum */
335 putDebugChar ('+'); /* successful transfer */
337 /* if a sequence char is present, reply the sequence ID */
338 if (buffer[2] == ':')
340 putDebugChar (buffer[0]);
341 putDebugChar (buffer[1]);
352 /* send the packet in buffer. */
355 putpacket (unsigned char *buffer)
357 unsigned char checksum;
361 /* $<packet info>#<checksum>. */
368 while (ch = buffer[count])
376 putDebugChar(hexchars[checksum >> 4]);
377 putDebugChar(hexchars[checksum & 0xf]);
380 while (getDebugChar() != '+');
383 /* Indicate to caller of mem2hex or hex2mem that there has been an
385 static volatile int mem_err = 0;
387 /* Convert the memory pointed to by mem into hex, placing result in buf.
388 * Return a pointer to the last char put in buf (null), in case of mem fault,
390 * If MAY_FAULT is non-zero, then we will handle memory faults by returning
391 * a 0, else treat a fault like any other fault in the stub.
394 static unsigned char *
395 mem2hex (unsigned char *mem, unsigned char *buf, int count, int may_fault)
399 set_mem_fault_trap(may_fault);
406 *buf++ = hexchars[ch >> 4];
407 *buf++ = hexchars[ch & 0xf];
412 set_mem_fault_trap(0);
417 /* convert the hex array pointed to by buf into binary to be placed in mem
418 * return a pointer to the character AFTER the last byte written */
421 hex2mem (unsigned char *buf, unsigned char *mem, int count, int may_fault)
426 set_mem_fault_trap(may_fault);
428 for (i=0; i<count; i++)
430 ch = hex(*buf++) << 4;
437 set_mem_fault_trap(0);
442 /* This table contains the mapping between SPARC hardware trap types, and
443 signals, which are primarily what GDB understands. It also indicates
444 which hardware traps we need to commandeer when initializing the stub. */
446 static struct hard_trap_info
448 unsigned char tt; /* Trap type code for SPARClite */
449 unsigned char signo; /* Signal that we map this trap into */
450 } hard_trap_info[] = {
451 {1, SIGSEGV}, /* instruction access error */
452 {2, SIGILL}, /* privileged instruction */
453 {3, SIGILL}, /* illegal instruction */
454 {4, SIGEMT}, /* fp disabled */
455 {36, SIGEMT}, /* cp disabled */
456 {7, SIGBUS}, /* mem address not aligned */
457 {9, SIGSEGV}, /* data access exception */
458 {10, SIGEMT}, /* tag overflow */
459 {128+1, SIGTRAP}, /* ta 1 - normal breakpoint instruction */
460 {0, 0} /* Must be last */
463 /* Set up exception handlers for tracing and breakpoints */
466 set_debug_traps (void)
468 struct hard_trap_info *ht;
470 for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
471 exceptionHandler(ht->tt, trap_low);
477 ! Trap handler for memory errors. This just sets mem_err to be non-zero. It
478 ! assumes that %l1 is non-zero. This should be safe, as it is doubtful that
479 ! 0 would ever contain code that could mem fault. This routine will skip
480 ! past the faulting instruction after setting mem_err.
486 sethi %hi(_mem_err), %l0
487 st %l1, [%l0 + %lo(_mem_err)]
493 set_mem_fault_trap (int enable)
495 extern void fltr_set_mem_err();
499 exceptionHandler(9, fltr_set_mem_err);
501 exceptionHandler(9, trap_low);
504 /* Convert the SPARC hardware trap type code to a unix signal number. */
507 computeSignal (int tt)
509 struct hard_trap_info *ht;
511 for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
515 return SIGHUP; /* default for things we don't know about */
519 * While we find nice hex chars, build an int.
520 * Return number of chars processed.
524 hexToInt(char **ptr, int *intValue)
533 hexValue = hex(**ptr);
537 *intValue = (*intValue << 4) | hexValue;
547 * This function does all command procesing for interfacing to gdb. It
548 * returns 1 if you should skip the instruction at the trap address, 0
552 extern void breakinst();
555 handle_exception (unsigned long *registers)
557 int tt; /* Trap type */
564 /* First, we must force all of the windows to be spilled out */
566 asm(" save %sp, -64, %sp
584 if (registers[PC] == (unsigned long)breakinst)
586 registers[PC] = registers[NPC];
590 sp = (unsigned long *)registers[SP];
592 tt = (registers[TBR] >> 4) & 0xff;
594 /* reply to host that an exception has occurred */
595 sigval = computeSignal(tt);
596 ptr = remcomOutBuffer;
599 *ptr++ = hexchars[sigval >> 4];
600 *ptr++ = hexchars[sigval & 0xf];
602 *ptr++ = hexchars[PC >> 4];
603 *ptr++ = hexchars[PC & 0xf];
605 ptr = mem2hex((char *)®isters[PC], ptr, 4, 0);
608 *ptr++ = hexchars[FP >> 4];
609 *ptr++ = hexchars[FP & 0xf];
611 ptr = mem2hex(sp + 8 + 6, ptr, 4, 0); /* FP */
614 *ptr++ = hexchars[SP >> 4];
615 *ptr++ = hexchars[SP & 0xf];
617 ptr = mem2hex((char *)&sp, ptr, 4, 0);
620 *ptr++ = hexchars[NPC >> 4];
621 *ptr++ = hexchars[NPC & 0xf];
623 ptr = mem2hex((char *)®isters[NPC], ptr, 4, 0);
626 *ptr++ = hexchars[O7 >> 4];
627 *ptr++ = hexchars[O7 & 0xf];
629 ptr = mem2hex((char *)®isters[O7], ptr, 4, 0);
634 putpacket(remcomOutBuffer);
638 remcomOutBuffer[0] = 0;
644 remcomOutBuffer[0] = 'S';
645 remcomOutBuffer[1] = hexchars[sigval >> 4];
646 remcomOutBuffer[2] = hexchars[sigval & 0xf];
647 remcomOutBuffer[3] = 0;
650 case 'd': /* toggle debug flag */
653 case 'g': /* return the value of the CPU registers */
655 ptr = remcomOutBuffer;
656 ptr = mem2hex((char *)registers, ptr, 16 * 4, 0); /* G & O regs */
657 ptr = mem2hex(sp + 0, ptr, 16 * 4, 0); /* L & I regs */
658 memset(ptr, '0', 32 * 8); /* Floating point */
659 mem2hex((char *)®isters[Y],
662 0); /* Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR */
666 case 'G': /* set the value of the CPU registers - return OK */
668 unsigned long *newsp, psr;
670 psr = registers[PSR];
672 hex2mem(ptr, (char *)registers, 16 * 4, 0); /* G & O regs */
673 hex2mem(ptr + 16 * 4 * 2, sp + 0, 16 * 4, 0); /* L & I regs */
674 hex2mem(ptr + 64 * 4 * 2, (char *)®isters[Y],
675 8 * 4, 0); /* Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR */
677 /* See if the stack pointer has moved. If so, then copy the saved
678 locals and ins to the new location. This keeps the window
679 overflow and underflow routines happy. */
681 newsp = (unsigned long *)registers[SP];
683 sp = memcpy(newsp, sp, 16 * 4);
685 /* Don't allow CWP to be modified. */
687 if (psr != registers[PSR])
688 registers[PSR] = (psr & 0x1f) | (registers[PSR] & ~0x1f);
690 strcpy(remcomOutBuffer,"OK");
694 case 'm': /* mAA..AA,LLLL Read LLLL bytes at address AA..AA */
695 /* Try to read %x,%x. */
697 if (hexToInt(&ptr, &addr)
699 && hexToInt(&ptr, &length))
701 if (mem2hex((char *)addr, remcomOutBuffer, length, 1))
704 strcpy (remcomOutBuffer, "E03");
707 strcpy(remcomOutBuffer,"E01");
710 case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
711 /* Try to read '%x,%x:'. */
713 if (hexToInt(&ptr, &addr)
715 && hexToInt(&ptr, &length)
718 if (hex2mem(ptr, (char *)addr, length, 1))
719 strcpy(remcomOutBuffer, "OK");
721 strcpy(remcomOutBuffer, "E03");
724 strcpy(remcomOutBuffer, "E02");
727 case 'c': /* cAA..AA Continue at address AA..AA(optional) */
728 /* try to read optional parameter, pc unchanged if no parm */
730 if (hexToInt(&ptr, &addr))
732 registers[PC] = addr;
733 registers[NPC] = addr + 4;
736 /* Need to flush the instruction cache here, as we may have deposited a
737 breakpoint, and the icache probably has no way of knowing that a data ref to
738 some location may have changed something that is in the instruction cache.
744 /* kill the program */
745 case 'k' : /* do nothing */
748 case 't': /* Test feature */
749 asm (" std %f30,[%sp]");
752 case 'r': /* Reset */
758 /* reply to the request */
759 putpacket(remcomOutBuffer);
763 /* This function will generate a breakpoint exception. It is used at the
764 beginning of a program to sync up with a debugger and can be used
765 otherwise as a quick means to stop program execution and "break" into
774 asm(" .globl _breakinst