]> git.ipfire.org Git - thirdparty/binutils-gdb.git/blame - gdb/m68k-stub.c
import gdb-1999-08-23 snapshot
[thirdparty/binutils-gdb.git] / gdb / m68k-stub.c
CommitLineData
c906108c
SS
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 * To enable debugger support, two things need to happen. One, a
33 * call to set_debug_traps() is necessary in order to allow any breakpoints
34 * or error conditions to be properly intercepted and reported to gdb.
35 * Two, a breakpoint needs to be generated to begin communication. This
36 * is most easily accomplished by a call to breakpoint(). Breakpoint()
37 * simulates a breakpoint by executing a trap #1. The breakpoint instruction
38 * is hardwired to trap #1 because not to do so is a compatibility problem--
39 * there either should be a standard breakpoint instruction, or the protocol
40 * should be extended to provide some means to communicate which breakpoint
41 * instruction is in use (or have the stub insert the breakpoint).
42 *
43 * Some explanation is probably necessary to explain how exceptions are
44 * handled. When an exception is encountered the 68000 pushes the current
45 * program counter and status register onto the supervisor stack and then
46 * transfers execution to a location specified in it's vector table.
47 * The handlers for the exception vectors are hardwired to jmp to an address
48 * given by the relation: (exception - 256) * 6. These are decending
49 * addresses starting from -6, -12, -18, ... By allowing 6 bytes for
50 * each entry, a jsr, jmp, bsr, ... can be used to enter the exception
51 * handler. Using a jsr to handle an exception has an added benefit of
52 * allowing a single handler to service several exceptions and use the
53 * return address as the key differentiation. The vector number can be
54 * computed from the return address by [ exception = (addr + 1530) / 6 ].
55 * The sole purpose of the routine _catchException is to compute the
56 * exception number and push it on the stack in place of the return address.
57 * The external function exceptionHandler() is
58 * used to attach a specific handler to a specific m68k exception.
59 * For 68020 machines, the ability to have a return address around just
60 * so the vector can be determined is not necessary because the '020 pushes an
61 * extra word onto the stack containing the vector offset
62 *
63 * Because gdb will sometimes write to the stack area to execute function
64 * calls, this program cannot rely on using the supervisor stack so it
65 * uses it's own stack area reserved in the int array remcomStack.
66 *
67 *************
68 *
69 * The following gdb commands are supported:
70 *
71 * command function Return value
72 *
73 * g return the value of the CPU registers hex data or ENN
74 * G set the value of the CPU registers OK or ENN
75 *
76 * mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN
77 * MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN
78 *
79 * c Resume at current address SNN ( signal NN)
80 * cAA..AA Continue at address AA..AA SNN
81 *
82 * s Step one instruction SNN
83 * sAA..AA Step one instruction from AA..AA SNN
84 *
85 * k kill
86 *
87 * ? What was the last sigval ? SNN (signal NN)
88 *
89 * All commands and responses are sent with a packet which includes a
90 * checksum. A packet consists of
91 *
92 * $<packet info>#<checksum>.
93 *
94 * where
95 * <packet info> :: <characters representing the command or response>
96 * <checksum> :: < two hex digits computed as modulo 256 sum of <packetinfo>>
97 *
98 * When a packet is received, it is first acknowledged with either '+' or '-'.
99 * '+' indicates a successful transfer. '-' indicates a failed transfer.
100 *
101 * Example:
102 *
103 * Host: Reply:
104 * $m0,10#2a +$00010203040506070809101112131415#42
105 *
106 ****************************************************************************/
107
108#include <stdio.h>
109#include <string.h>
110#include <setjmp.h>
111
112/************************************************************************
113 *
114 * external low-level support routines
115 */
116typedef void (*ExceptionHook)(int); /* pointer to function with int parm */
117typedef void (*Function)(); /* pointer to a function */
118
119extern void putDebugChar(); /* write a single character */
120extern int getDebugChar(); /* read and return a single char */
121
122extern Function exceptionHandler(); /* assign an exception handler */
123extern ExceptionHook exceptionHook; /* hook variable for errors/exceptions */
124
125/************************/
126/* FORWARD DECLARATIONS */
127/************************/
128static void
129initializeRemcomErrorFrame ();
130
131/************************************************************************/
132/* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/
133/* at least NUMREGBYTES*2 are needed for register packets */
134#define BUFMAX 400
135
136static char initialized; /* boolean flag. != 0 means we've been initialized */
137
138int remote_debug;
139/* debug > 0 prints ill-formed commands in valid packets & checksum errors */
140
141static const char hexchars[]="0123456789abcdef";
142
143/* there are 180 bytes of registers on a 68020 w/68881 */
144/* many of the fpa registers are 12 byte (96 bit) registers */
145#define NUMREGBYTES 180
146enum regnames {D0,D1,D2,D3,D4,D5,D6,D7,
147 A0,A1,A2,A3,A4,A5,A6,A7,
148 PS,PC,
149 FP0,FP1,FP2,FP3,FP4,FP5,FP6,FP7,
150 FPCONTROL,FPSTATUS,FPIADDR
151 };
152
153\f
154/* We keep a whole frame cache here. "Why?", I hear you cry, "doesn't
155 GDB handle that sort of thing?" Well, yes, I believe the only
156 reason for this cache is to save and restore floating point state
157 (fsave/frestore). A cleaner way to do this would be to make the
158 fsave data part of the registers which GDB deals with like any
159 other registers. This should not be a performance problem if the
160 ability to read individual registers is added to the protocol. */
161
162typedef struct FrameStruct
163{
164 struct FrameStruct *previous;
165 int exceptionPC; /* pc value when this frame created */
166 int exceptionVector; /* cpu vector causing exception */
167 short frameSize; /* size of cpu frame in words */
168 short sr; /* for 68000, this not always sr */
169 int pc;
170 short format;
171 int fsaveHeader;
172 int morejunk[0]; /* exception frame, fp save... */
173} Frame;
174
175#define FRAMESIZE 500
176int gdbFrameStack[FRAMESIZE];
177static Frame *lastFrame;
178
179/*
180 * these should not be static cuz they can be used outside this module
181 */
182int registers[NUMREGBYTES/4];
183int superStack;
184
185#define STACKSIZE 10000
186int remcomStack[STACKSIZE/sizeof(int)];
187static int* stackPtr = &remcomStack[STACKSIZE/sizeof(int) - 1];
188
189/*
190 * In many cases, the system will want to continue exception processing
191 * when a continue command is given.
192 * oldExceptionHook is a function to invoke in this case.
193 */
194
195static ExceptionHook oldExceptionHook;
196
197#ifdef mc68020
198/* the size of the exception stack on the 68020 varies with the type of
199 * exception. The following table is the number of WORDS used
200 * for each exception format.
201 */
202const short exceptionSize[] = { 4,4,6,4,4,4,4,4,29,10,16,46,12,4,4,4 };
203#endif
204
205#ifdef mc68332
206static const short exceptionSize[] = { 4,4,6,4,4,4,4,4,4,4,4,4,16,4,4,4 };
207#endif
208
209/************* jump buffer used for setjmp/longjmp **************************/
210jmp_buf remcomEnv;
211
212/*************************** ASSEMBLY CODE MACROS *************************/
213/* */
214
215#ifdef __HAVE_68881__
216/* do an fsave, then remember the address to begin a restore from */
217#define SAVE_FP_REGS() asm(" fsave a0@-"); \
218 asm(" fmovemx fp0-fp7,_registers+72"); \
219 asm(" fmoveml fpcr/fpsr/fpi,_registers+168");
220#define RESTORE_FP_REGS() \
221asm(" \n\
222 fmoveml _registers+168,fpcr/fpsr/fpi \n\
223 fmovemx _registers+72,fp0-fp7 \n\
224 cmpl #-1,a0@ | skip frestore flag set ? \n\
225 beq skip_frestore \n\
226 frestore a0@+ \n\
227skip_frestore: \n\
228");
229
230#else
231#define SAVE_FP_REGS()
232#define RESTORE_FP_REGS()
233#endif /* __HAVE_68881__ */
234
235void return_to_super();
236void return_to_user();
237
238asm("
239.text
240.globl _return_to_super
241_return_to_super:
242 movel _registers+60,sp /* get new stack pointer */
243 movel _lastFrame,a0 /* get last frame info */
244 bra return_to_any
245
246.globl _return_to_user
247_return_to_user:
248 movel _registers+60,a0 /* get usp */
249 movel a0,usp /* set usp */
250 movel _superStack,sp /* get original stack pointer */
251
252return_to_any:
253 movel _lastFrame,a0 /* get last frame info */
254 movel a0@+,_lastFrame /* link in previous frame */
255 addql #8,a0 /* skip over pc, vector#*/
256 movew a0@+,d0 /* get # of words in cpu frame */
257 addw d0,a0 /* point to end of data */
258 addw d0,a0 /* point to end of data */
259 movel a0,a1
260#
261# copy the stack frame
262 subql #1,d0
263copyUserLoop:
264 movew a1@-,sp@-
265 dbf d0,copyUserLoop
266");
267 RESTORE_FP_REGS()
268 asm(" moveml _registers,d0-d7/a0-a6");
269 asm(" rte"); /* pop and go! */
270
271#define DISABLE_INTERRUPTS() asm(" oriw #0x0700,sr");
272#define BREAKPOINT() asm(" trap #1");
273
274/* this function is called immediately when a level 7 interrupt occurs */
275/* if the previous interrupt level was 7 then we're already servicing */
276/* this interrupt and an rte is in order to return to the debugger. */
277/* For the 68000, the offset for sr is 6 due to the jsr return address */
278asm("
279.text
280.globl __debug_level7
281__debug_level7:
282 movew d0,sp@-");
283#if defined (mc68020) || defined (mc68332)
284asm(" movew sp@(2),d0");
285#else
286asm(" movew sp@(6),d0");
287#endif
288asm(" andiw #0x700,d0
289 cmpiw #0x700,d0
290 beq _already7
291 movew sp@+,d0
292 bra __catchException
293_already7:
294 movew sp@+,d0");
295#if !defined (mc68020) && !defined (mc68332)
296asm(" lea sp@(4),sp"); /* pull off 68000 return address */
297#endif
298asm(" rte");
299
300extern void _catchException ();
301
302#if defined (mc68020) || defined (mc68332)
303/* This function is called when a 68020 exception occurs. It saves
304 * all the cpu and fpcp regs in the _registers array, creates a frame on a
305 * linked list of frames which has the cpu and fpcp stack frames needed
306 * to properly restore the context of these processors, and invokes
307 * an exception handler (remcom_handler).
308 *
309 * stack on entry: stack on exit:
310 * N bytes of junk exception # MSWord
311 * Exception Format Word exception # MSWord
312 * Program counter LSWord
313 * Program counter MSWord
314 * Status Register
315 *
316 *
317 */
318asm("
319.text
320.globl __catchException
321__catchException:");
322DISABLE_INTERRUPTS();
323asm("
324 moveml d0-d7/a0-a6,_registers /* save registers */
325 movel _lastFrame,a0 /* last frame pointer */
326");
327SAVE_FP_REGS();
328asm("
329 lea _registers,a5 /* get address of registers */
330 movew sp@,d1 /* get status register */
331 movew d1,a5@(66) /* save sr */
332 movel sp@(2),a4 /* save pc in a4 for later use */
333 movel a4,a5@(68) /* save pc in _regisers[] */
334
335#
336# figure out how many bytes in the stack frame
337 movew sp@(6),d0 /* get '020 exception format */
338 movew d0,d2 /* make a copy of format word */
339 andiw #0xf000,d0 /* mask off format type */
340 rolw #5,d0 /* rotate into the low byte *2 */
341 lea _exceptionSize,a1
342 addw d0,a1 /* index into the table */
343 movew a1@,d0 /* get number of words in frame */
344 movew d0,d3 /* save it */
345 subw d0,a0 /* adjust save pointer */
346 subw d0,a0 /* adjust save pointer(bytes) */
347 movel a0,a1 /* copy save pointer */
348 subql #1,d0 /* predecrement loop counter */
349#
350# copy the frame
351saveFrameLoop:
352 movew sp@+,a1@+
353 dbf d0,saveFrameLoop
354#
355# now that the stack has been clenaed,
356# save the a7 in use at time of exception
357 movel sp,_superStack /* save supervisor sp */
358 andiw #0x2000,d1 /* were we in supervisor mode ? */
359 beq userMode
360 movel a7,a5@(60) /* save a7 */
361 bra a7saveDone
362userMode:
363 movel usp,a1
364 movel a1,a5@(60) /* save user stack pointer */
365a7saveDone:
366
367#
368# save size of frame
369 movew d3,a0@-
370
371#
372# compute exception number
373 andl #0xfff,d2 /* mask off vector offset */
374 lsrw #2,d2 /* divide by 4 to get vect num */
375 movel d2,a0@- /* save it */
376#
377# save pc causing exception
378 movel a4,a0@-
379#
380# save old frame link and set the new value
381 movel _lastFrame,a1 /* last frame pointer */
382 movel a1,a0@- /* save pointer to prev frame */
383 movel a0,_lastFrame
384
385 movel d2,sp@- /* push exception num */
386 movel _exceptionHook,a0 /* get address of handler */
387 jbsr a0@ /* and call it */
388 clrl sp@ /* replace exception num parm with frame ptr */
389 jbsr __returnFromException /* jbsr, but never returns */
390");
391#else /* mc68000 */
392/* This function is called when an exception occurs. It translates the
393 * return address found on the stack into an exception vector # which
394 * is then handled by either handle_exception or a system handler.
395 * _catchException provides a front end for both.
396 *
397 * stack on entry: stack on exit:
398 * Program counter MSWord exception # MSWord
399 * Program counter LSWord exception # MSWord
400 * Status Register
401 * Return Address MSWord
402 * Return Address LSWord
403 */
404asm("
405.text
406.globl __catchException
407__catchException:");
408DISABLE_INTERRUPTS();
409asm("
410 moveml d0-d7/a0-a6,_registers /* save registers */
411 movel _lastFrame,a0 /* last frame pointer */
412");
413SAVE_FP_REGS();
414asm("
415 lea _registers,a5 /* get address of registers */
416 movel sp@+,d2 /* pop return address */
417 addl #1530,d2 /* convert return addr to */
418 divs #6,d2 /* exception number */
419 extl d2
420
421 moveql #3,d3 /* assume a three word frame */
422
423 cmpiw #3,d2 /* bus error or address error ? */
424 bgt normal /* if >3 then normal error */
425 movel sp@+,a0@- /* copy error info to frame buff*/
426 movel sp@+,a0@- /* these are never used */
427 moveql #7,d3 /* this is a 7 word frame */
428
429normal:
430 movew sp@+,d1 /* pop status register */
431 movel sp@+,a4 /* pop program counter */
432 movew d1,a5@(66) /* save sr */
433 movel a4,a5@(68) /* save pc in _regisers[] */
434 movel a4,a0@- /* copy pc to frame buffer */
435 movew d1,a0@- /* copy sr to frame buffer */
436
437 movel sp,_superStack /* save supervisor sp */
438
439 andiw #0x2000,d1 /* were we in supervisor mode ? */
440 beq userMode
441 movel a7,a5@(60) /* save a7 */
442 bra saveDone
443userMode:
444 movel usp,a1 /* save user stack pointer */
445 movel a1,a5@(60) /* save user stack pointer */
446saveDone:
447
448 movew d3,a0@- /* push frame size in words */
449 movel d2,a0@- /* push vector number */
450 movel a4,a0@- /* push exception pc */
451
452#
453# save old frame link and set the new value
454 movel _lastFrame,a1 /* last frame pointer */
455 movel a1,a0@- /* save pointer to prev frame */
456 movel a0,_lastFrame
457
458 movel d2,sp@- /* push exception num */
459 movel _exceptionHook,a0 /* get address of handler */
460 jbsr a0@ /* and call it */
461 clrl sp@ /* replace exception num parm with frame ptr */
462 jbsr __returnFromException /* jbsr, but never returns */
463");
464#endif
465
466
467/*
468 * remcomHandler is a front end for handle_exception. It moves the
469 * stack pointer into an area reserved for debugger use in case the
470 * breakpoint happened in supervisor mode.
471 */
472asm("_remcomHandler:");
473asm(" addl #4,sp"); /* pop off return address */
474asm(" movel sp@+,d0"); /* get the exception number */
475asm(" movel _stackPtr,sp"); /* move to remcom stack area */
476asm(" movel d0,sp@-"); /* push exception onto stack */
477asm(" jbsr _handle_exception"); /* this never returns */
478asm(" rts"); /* return */
479
480void _returnFromException( Frame *frame )
481{
482 /* if no passed in frame, use the last one */
483 if (! frame)
484 {
485 frame = lastFrame;
486 frame->frameSize = 4;
487 frame->format = 0;
488 frame->fsaveHeader = -1; /* restore regs, but we dont have fsave info*/
489 }
490
491#if !defined (mc68020) && !defined (mc68332)
492 /* a 68000 cannot use the internal info pushed onto a bus error
493 * or address error frame when doing an RTE so don't put this info
494 * onto the stack or the stack will creep every time this happens.
495 */
496 frame->frameSize=3;
497#endif
498
499 /* throw away any frames in the list after this frame */
500 lastFrame = frame;
501
502 frame->sr = registers[(int) PS];
503 frame->pc = registers[(int) PC];
504
505 if (registers[(int) PS] & 0x2000)
506 {
507 /* return to supervisor mode... */
508 return_to_super();
509 }
510 else
511 { /* return to user mode */
512 return_to_user();
513 }
514}
515
516int hex(ch)
517char ch;
518{
519 if ((ch >= 'a') && (ch <= 'f')) return (ch-'a'+10);
520 if ((ch >= '0') && (ch <= '9')) return (ch-'0');
521 if ((ch >= 'A') && (ch <= 'F')) return (ch-'A'+10);
522 return (-1);
523}
524
525
526/* scan for the sequence $<data>#<checksum> */
527void getpacket(buffer)
528char * buffer;
529{
530 unsigned char checksum;
531 unsigned char xmitcsum;
532 int i;
533 int count;
534 char ch;
535
536 do {
537 /* wait around for the start character, ignore all other characters */
538 while ((ch = (getDebugChar() & 0x7f)) != '$');
539 checksum = 0;
540 xmitcsum = -1;
541
542 count = 0;
543
544 /* now, read until a # or end of buffer is found */
545 while (count < BUFMAX) {
546 ch = getDebugChar() & 0x7f;
547 if (ch == '#') break;
548 checksum = checksum + ch;
549 buffer[count] = ch;
550 count = count + 1;
551 }
552 buffer[count] = 0;
553
554 if (ch == '#') {
555 xmitcsum = hex(getDebugChar() & 0x7f) << 4;
556 xmitcsum += hex(getDebugChar() & 0x7f);
557 if ((remote_debug ) && (checksum != xmitcsum)) {
558 fprintf (stderr,"bad checksum. My count = 0x%x, sent=0x%x. buf=%s\n",
559 checksum,xmitcsum,buffer);
560 }
561
562 if (checksum != xmitcsum) putDebugChar('-'); /* failed checksum */
563 else {
564 putDebugChar('+'); /* successful transfer */
565 /* if a sequence char is present, reply the sequence ID */
566 if (buffer[2] == ':') {
567 putDebugChar( buffer[0] );
568 putDebugChar( buffer[1] );
569 /* remove sequence chars from buffer */
570 count = strlen(buffer);
571 for (i=3; i <= count; i++) buffer[i-3] = buffer[i];
572 }
573 }
574 }
575 } while (checksum != xmitcsum);
576
577}
578
53a5351d 579/* send the packet in buffer. */
c906108c
SS
580
581
582void putpacket(buffer)
583char * buffer;
584{
585 unsigned char checksum;
586 int count;
587 char ch;
588
589 /* $<packet info>#<checksum>. */
590 do {
591 putDebugChar('$');
592 checksum = 0;
593 count = 0;
594
595 while (ch=buffer[count]) {
596 putDebugChar(ch);
597 checksum += ch;
598 count += 1;
599 }
600
601 putDebugChar('#');
602 putDebugChar(hexchars[checksum >> 4]);
603 putDebugChar(hexchars[checksum % 16]);
604
53a5351d 605 } while (getDebugChar() != '+');
c906108c
SS
606
607}
608
609char remcomInBuffer[BUFMAX];
610char remcomOutBuffer[BUFMAX];
611static short error;
612
613
614void debug_error(format, parm)
615char * format;
616char * parm;
617{
618 if (remote_debug) fprintf (stderr,format,parm);
619}
620
621/* convert the memory pointed to by mem into hex, placing result in buf */
622/* return a pointer to the last char put in buf (null) */
623char* mem2hex(mem, buf, count)
624char* mem;
625char* buf;
626int count;
627{
628 int i;
629 unsigned char ch;
630 for (i=0;i<count;i++) {
631 ch = *mem++;
632 *buf++ = hexchars[ch >> 4];
633 *buf++ = hexchars[ch % 16];
634 }
635 *buf = 0;
636 return(buf);
637}
638
639/* convert the hex array pointed to by buf into binary to be placed in mem */
640/* return a pointer to the character AFTER the last byte written */
641char* hex2mem(buf, mem, count)
642char* buf;
643char* mem;
644int count;
645{
646 int i;
647 unsigned char ch;
648 for (i=0;i<count;i++) {
649 ch = hex(*buf++) << 4;
650 ch = ch + hex(*buf++);
651 *mem++ = ch;
652 }
653 return(mem);
654}
655
656/* a bus error has occurred, perform a longjmp
657 to return execution and allow handling of the error */
658
659void handle_buserror()
660{
661 longjmp(remcomEnv,1);
662}
663
664/* this function takes the 68000 exception number and attempts to
665 translate this number into a unix compatible signal value */
666int computeSignal( exceptionVector )
667int exceptionVector;
668{
669 int sigval;
670 switch (exceptionVector) {
671 case 2 : sigval = 10; break; /* bus error */
672 case 3 : sigval = 10; break; /* address error */
673 case 4 : sigval = 4; break; /* illegal instruction */
674 case 5 : sigval = 8; break; /* zero divide */
675 case 6 : sigval = 8; break; /* chk instruction */
676 case 7 : sigval = 8; break; /* trapv instruction */
677 case 8 : sigval = 11; break; /* privilege violation */
678 case 9 : sigval = 5; break; /* trace trap */
679 case 10: sigval = 4; break; /* line 1010 emulator */
680 case 11: sigval = 4; break; /* line 1111 emulator */
681
682 /* Coprocessor protocol violation. Using a standard MMU or FPU
683 this cannot be triggered by software. Call it a SIGBUS. */
684 case 13: sigval = 10; break;
685
686 case 31: sigval = 2; break; /* interrupt */
687 case 33: sigval = 5; break; /* breakpoint */
688
689 /* This is a trap #8 instruction. Apparently it is someone's software
690 convention for some sort of SIGFPE condition. Whose? How many
691 people are being screwed by having this code the way it is?
692 Is there a clean solution? */
693 case 40: sigval = 8; break; /* floating point err */
694
695 case 48: sigval = 8; break; /* floating point err */
696 case 49: sigval = 8; break; /* floating point err */
697 case 50: sigval = 8; break; /* zero divide */
698 case 51: sigval = 8; break; /* underflow */
699 case 52: sigval = 8; break; /* operand error */
700 case 53: sigval = 8; break; /* overflow */
701 case 54: sigval = 8; break; /* NAN */
702 default:
703 sigval = 7; /* "software generated"*/
704 }
705 return (sigval);
706}
707
708/**********************************************/
709/* WHILE WE FIND NICE HEX CHARS, BUILD AN INT */
710/* RETURN NUMBER OF CHARS PROCESSED */
711/**********************************************/
712int hexToInt(char **ptr, int *intValue)
713{
714 int numChars = 0;
715 int hexValue;
716
717 *intValue = 0;
718
719 while (**ptr)
720 {
721 hexValue = hex(**ptr);
722 if (hexValue >=0)
723 {
724 *intValue = (*intValue <<4) | hexValue;
725 numChars ++;
726 }
727 else
728 break;
729
730 (*ptr)++;
731 }
732
733 return (numChars);
734}
735
736/*
737 * This function does all command procesing for interfacing to gdb.
738 */
739void handle_exception(int exceptionVector)
740{
741 int sigval;
742 int addr, length;
743 char * ptr;
744 int newPC;
745 Frame *frame;
746
747 if (remote_debug) printf("vector=%d, sr=0x%x, pc=0x%x\n",
748 exceptionVector,
749 registers[ PS ],
750 registers[ PC ]);
751
752 /* reply to host that an exception has occurred */
753 sigval = computeSignal( exceptionVector );
754 remcomOutBuffer[0] = 'S';
755 remcomOutBuffer[1] = hexchars[sigval >> 4];
756 remcomOutBuffer[2] = hexchars[sigval % 16];
757 remcomOutBuffer[3] = 0;
758
759 putpacket(remcomOutBuffer);
760
761 while (1==1) {
762 error = 0;
763 remcomOutBuffer[0] = 0;
764 getpacket(remcomInBuffer);
765 switch (remcomInBuffer[0]) {
766 case '?' : remcomOutBuffer[0] = 'S';
767 remcomOutBuffer[1] = hexchars[sigval >> 4];
768 remcomOutBuffer[2] = hexchars[sigval % 16];
769 remcomOutBuffer[3] = 0;
770 break;
771 case 'd' : remote_debug = !(remote_debug); /* toggle debug flag */
772 break;
773 case 'g' : /* return the value of the CPU registers */
774 mem2hex((char*) registers, remcomOutBuffer, NUMREGBYTES);
775 break;
776 case 'G' : /* set the value of the CPU registers - return OK */
777 hex2mem(&remcomInBuffer[1], (char*) registers, NUMREGBYTES);
778 strcpy(remcomOutBuffer,"OK");
779 break;
780
781 /* mAA..AA,LLLL Read LLLL bytes at address AA..AA */
782 case 'm' :
783 if (setjmp(remcomEnv) == 0)
784 {
785 exceptionHandler(2,handle_buserror);
786
787 /* TRY TO READ %x,%x. IF SUCCEED, SET PTR = 0 */
788 ptr = &remcomInBuffer[1];
789 if (hexToInt(&ptr,&addr))
790 if (*(ptr++) == ',')
791 if (hexToInt(&ptr,&length))
792 {
793 ptr = 0;
794 mem2hex((char*) addr, remcomOutBuffer, length);
795 }
796
797 if (ptr)
798 {
799 strcpy(remcomOutBuffer,"E01");
800 debug_error("malformed read memory command: %s",remcomInBuffer);
801 }
802 }
803 else {
804 exceptionHandler(2,_catchException);
805 strcpy(remcomOutBuffer,"E03");
806 debug_error("bus error");
807 }
808
809 /* restore handler for bus error */
810 exceptionHandler(2,_catchException);
811 break;
812
813 /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
814 case 'M' :
815 if (setjmp(remcomEnv) == 0) {
816 exceptionHandler(2,handle_buserror);
817
818 /* TRY TO READ '%x,%x:'. IF SUCCEED, SET PTR = 0 */
819 ptr = &remcomInBuffer[1];
820 if (hexToInt(&ptr,&addr))
821 if (*(ptr++) == ',')
822 if (hexToInt(&ptr,&length))
823 if (*(ptr++) == ':')
824 {
825 hex2mem(ptr, (char*) addr, length);
826 ptr = 0;
827 strcpy(remcomOutBuffer,"OK");
828 }
829 if (ptr)
830 {
831 strcpy(remcomOutBuffer,"E02");
832 debug_error("malformed write memory command: %s",remcomInBuffer);
833 }
834 }
835 else {
836 exceptionHandler(2,_catchException);
837 strcpy(remcomOutBuffer,"E03");
838 debug_error("bus error");
839 }
840
841 /* restore handler for bus error */
842 exceptionHandler(2,_catchException);
843 break;
844
845 /* cAA..AA Continue at address AA..AA(optional) */
846 /* sAA..AA Step one instruction from AA..AA(optional) */
847 case 'c' :
848 case 's' :
849 /* try to read optional parameter, pc unchanged if no parm */
850 ptr = &remcomInBuffer[1];
851 if (hexToInt(&ptr,&addr))
852 registers[ PC ] = addr;
853
854 newPC = registers[ PC];
855
856 /* clear the trace bit */
857 registers[ PS ] &= 0x7fff;
858
859 /* set the trace bit if we're stepping */
860 if (remcomInBuffer[0] == 's') registers[ PS ] |= 0x8000;
861
862 /*
863 * look for newPC in the linked list of exception frames.
864 * if it is found, use the old frame it. otherwise,
865 * fake up a dummy frame in returnFromException().
866 */
867 if (remote_debug) printf("new pc = 0x%x\n",newPC);
868 frame = lastFrame;
869 while (frame)
870 {
871 if (remote_debug)
872 printf("frame at 0x%x has pc=0x%x, except#=%d\n",
873 frame,frame->exceptionPC,
874 frame->exceptionVector);
875 if (frame->exceptionPC == newPC) break; /* bingo! a match */
876 /*
877 * for a breakpoint instruction, the saved pc may
878 * be off by two due to re-executing the instruction
879 * replaced by the trap instruction. Check for this.
880 */
881 if ((frame->exceptionVector == 33) &&
882 (frame->exceptionPC == (newPC+2))) break;
883 if (frame == frame->previous)
884 {
885 frame = 0; /* no match found */
886 break;
887 }
888 frame = frame->previous;
889 }
890
891 /*
892 * If we found a match for the PC AND we are not returning
893 * as a result of a breakpoint (33),
894 * trace exception (9), nmi (31), jmp to
895 * the old exception handler as if this code never ran.
896 */
897 if (frame)
898 {
899 if ((frame->exceptionVector != 9) &&
900 (frame->exceptionVector != 31) &&
901 (frame->exceptionVector != 33))
902 {
903 /*
904 * invoke the previous handler.
905 */
906 if (oldExceptionHook)
907 (*oldExceptionHook) (frame->exceptionVector);
908 newPC = registers[ PC ]; /* pc may have changed */
909 if (newPC != frame->exceptionPC)
910 {
911 if (remote_debug)
912 printf("frame at 0x%x has pc=0x%x, except#=%d\n",
913 frame,frame->exceptionPC,
914 frame->exceptionVector);
915 /* re-use the last frame, we're skipping it (longjump?)*/
916 frame = (Frame *) 0;
917 _returnFromException( frame ); /* this is a jump */
918 }
919 }
920 }
921
922 /* if we couldn't find a frame, create one */
923 if (frame == 0)
924 {
925 frame = lastFrame -1 ;
926
927 /* by using a bunch of print commands with breakpoints,
928 it's possible for the frame stack to creep down. If it creeps
929 too far, give up and reset it to the top. Normal use should
930 not see this happen.
931 */
932 if ((unsigned int) (frame-2) < (unsigned int) &gdbFrameStack)
933 {
934 initializeRemcomErrorFrame();
935 frame = lastFrame;
936 }
937 frame->previous = lastFrame;
938 lastFrame = frame;
939 frame = 0; /* null so _return... will properly initialize it */
940 }
941
942 _returnFromException( frame ); /* this is a jump */
943
944 break;
945
946 /* kill the program */
947 case 'k' : /* do nothing */
948 break;
949 } /* switch */
950
951 /* reply to the request */
952 putpacket(remcomOutBuffer);
953 }
954}
955
956
957void
958initializeRemcomErrorFrame()
959{
960 lastFrame = ((Frame *) &gdbFrameStack[FRAMESIZE-1]) - 1;
961 lastFrame->previous = lastFrame;
962}
963
964/* this function is used to set up exception handlers for tracing and
965 breakpoints */
966void set_debug_traps()
967{
968 extern void _debug_level7();
969 extern void remcomHandler();
970 int exception;
971
972 initializeRemcomErrorFrame();
973 stackPtr = &remcomStack[STACKSIZE/sizeof(int) - 1];
974
975 for (exception = 2; exception <= 23; exception++)
976 exceptionHandler(exception,_catchException);
977
978 /* level 7 interrupt */
979 exceptionHandler(31,_debug_level7);
980
981 /* breakpoint exception (trap #1) */
982 exceptionHandler(33,_catchException);
983
984 /* This is a trap #8 instruction. Apparently it is someone's software
985 convention for some sort of SIGFPE condition. Whose? How many
986 people are being screwed by having this code the way it is?
987 Is there a clean solution? */
988 exceptionHandler(40,_catchException);
989
990 /* 48 to 54 are floating point coprocessor errors */
991 for (exception = 48; exception <= 54; exception++)
992 exceptionHandler(exception,_catchException);
993
994 if (oldExceptionHook != remcomHandler)
995 {
996 oldExceptionHook = exceptionHook;
997 exceptionHook = remcomHandler;
998 }
999
1000 initialized = 1;
1001
1002}
1003
1004/* This function will generate a breakpoint exception. It is used at the
1005 beginning of a program to sync up with a debugger and can be used
1006 otherwise as a quick means to stop program execution and "break" into
1007 the debugger. */
1008
1009void breakpoint()
1010{
1011 if (initialized) BREAKPOINT();
1012}
1013