]> git.ipfire.org Git - thirdparty/binutils-gdb.git/blob - gdb/sparclet-stub.c
Protoization.
[thirdparty/binutils-gdb.git] / gdb / sparclet-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 SPARC by Stu Grossman, Cygnus Support.
33 * Based on sparc-stub.c, it's modified for SPARClite Debug Unit hardware
34 * breakpoint support to create sparclite-stub.c, by Kung Hsu, Cygnus Support.
35 *
36 * This code has been extensively tested on the Fujitsu SPARClite demo board.
37 *
38 * To enable debugger support, two things need to happen. One, a
39 * call to set_debug_traps() is necessary in order to allow any breakpoints
40 * or error conditions to be properly intercepted and reported to gdb.
41 * Two, a breakpoint needs to be generated to begin communication. This
42 * is most easily accomplished by a call to breakpoint(). Breakpoint()
43 * simulates a breakpoint by executing a trap #1.
44 *
45 *************
46 *
47 * The following gdb commands are supported:
48 *
49 * command function Return value
50 *
51 * g return the value of the CPU registers hex data or ENN
52 * G set the value of the CPU registers OK or ENN
53 * P set the value of a single CPU register OK or ENN
54 *
55 * mAA..AA,LLLL Read LLLL bytes at address AA..AA hex data or ENN
56 * MAA..AA,LLLL: Write LLLL bytes at address AA.AA OK or ENN
57 *
58 * c Resume at current address SNN ( signal NN)
59 * cAA..AA Continue at address AA..AA SNN
60 *
61 * s Step one instruction SNN
62 * sAA..AA Step one instruction from AA..AA SNN
63 *
64 * k kill
65 *
66 * ? What was the last sigval ? SNN (signal NN)
67 *
68 * All commands and responses are sent with a packet which includes a
69 * checksum. A packet consists of
70 *
71 * $<packet info>#<checksum>.
72 *
73 * where
74 * <packet info> :: <characters representing the command or response>
75 * <checksum> :: <two hex digits computed as modulo 256 sum of <packetinfo>>
76 *
77 * When a packet is received, it is first acknowledged with either '+' or '-'.
78 * '+' indicates a successful transfer. '-' indicates a failed transfer.
79 *
80 * Example:
81 *
82 * Host: Reply:
83 * $m0,10#2a +$00010203040506070809101112131415#42
84 *
85 ****************************************************************************/
86
87 #include <string.h>
88 #include <signal.h>
89
90 /************************************************************************
91 *
92 * external low-level support routines
93 */
94
95 extern void putDebugChar(); /* write a single character */
96 extern int getDebugChar(); /* read and return a single char */
97
98 /************************************************************************/
99 /* BUFMAX defines the maximum number of characters in inbound/outbound buffers*/
100 /* at least NUMREGBYTES*2 are needed for register packets */
101 #define BUFMAX 2048
102
103 static int initialized = 0; /* !0 means we've been initialized */
104 static int remote_debug = 0; /* turn on verbose debugging */
105
106 extern void breakinst();
107 void _cprint();
108 static void hw_breakpoint();
109 static void set_mem_fault_trap();
110 static void get_in_break_mode();
111 static unsigned char *mem2hex();
112
113 static const char hexchars[]="0123456789abcdef";
114
115 #define NUMREGS 121
116
117 static unsigned long saved_stack_pointer;
118
119 /* Number of bytes of registers. */
120 #define NUMREGBYTES (NUMREGS * 4)
121 enum regnames { G0, G1, G2, G3, G4, G5, G6, G7,
122 O0, O1, O2, O3, O4, O5, SP, O7,
123 L0, L1, L2, L3, L4, L5, L6, L7,
124 I0, I1, I2, I3, I4, I5, FP, I7,
125
126 F0, F1, F2, F3, F4, F5, F6, F7,
127 F8, F9, F10, F11, F12, F13, F14, F15,
128 F16, F17, F18, F19, F20, F21, F22, F23,
129 F24, F25, F26, F27, F28, F29, F30, F31,
130
131 Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR,
132 CCSR, CCPR, CCCRCR, CCOR, CCOBR, CCIBR, CCIR, UNUSED1,
133
134 ASR1, ASR15, ASR17, ASR18, ASR19, ASR20, ASR21, ASR22,
135 /* the following not actually implemented */
136 AWR0, AWR1, AWR2, AWR3, AWR4, AWR5, AWR6, AWR7,
137 AWR8, AWR9, AWR10, AWR11, AWR12, AWR13, AWR14, AWR15,
138 AWR16, AWR17, AWR18, AWR19, AWR20, AWR21, AWR22, AWR23,
139 AWR24, AWR25, AWR26, AWR27, AWR28, AWR29, AWR30, AWR31,
140 APSR
141 };
142
143 /*************************** ASSEMBLY CODE MACROS *************************/
144 /* */
145
146 extern void trap_low();
147
148 asm("
149 .reserve trapstack, 1000 * 4, \"bss\", 8
150
151 .data
152 .align 4
153
154 in_trap_handler:
155 .word 0
156
157 .text
158 .align 4
159
160 ! This function is called when any SPARC trap (except window overflow or
161 ! underflow) occurs. It makes sure that the invalid register window is still
162 ! available before jumping into C code. It will also restore the world if you
163 ! return from handle_exception.
164 !
165 ! On entry, trap_low expects l1 and l2 to contain pc and npc respectivly.
166
167 .globl _trap_low
168 _trap_low:
169 mov %psr, %l0
170 mov %wim, %l3
171
172 srl %l3, %l0, %l4 ! wim >> cwp
173 and %l4, 0xff, %l4 ! Mask off windows 28, 29
174 cmp %l4, 1
175 bne window_fine ! Branch if not in the invalid window
176 nop
177
178 ! Handle window overflow
179
180 mov %g1, %l4 ! Save g1, we use it to hold the wim
181 srl %l3, 1, %g1 ! Rotate wim right
182 and %g1, 0xff, %g1 ! Mask off windows 28, 29
183 tst %g1
184 bg good_wim ! Branch if new wim is non-zero
185 nop
186
187 ! At this point, we need to bring a 1 into the high order bit of the wim.
188 ! Since we don't want to make any assumptions about the number of register
189 ! windows, we figure it out dynamically so as to setup the wim correctly.
190
191 ! The normal way doesn't work on the sparclet as register windows
192 ! 28 and 29 are special purpose windows.
193 !not %g1 ! Fill g1 with ones
194 !mov %g1, %wim ! Fill the wim with ones
195 !nop
196 !nop
197 !nop
198 !mov %wim, %g1 ! Read back the wim
199 !inc %g1 ! Now g1 has 1 just to left of wim
200 !srl %g1, 1, %g1 ! Now put 1 at top of wim
201
202 mov 0x80, %g1 ! Hack for sparclet
203
204 ! This doesn't work on the sparclet.
205 !mov %g0, %wim ! Clear wim so that subsequent save
206 ! won't trap
207 andn %l3, 0xff, %l5 ! Clear wim but not windows 28, 29
208 mov %l5, %wim
209 nop
210 nop
211 nop
212
213 good_wim:
214 save %g0, %g0, %g0 ! Slip into next window
215 mov %g1, %wim ! Install the new wim
216
217 std %l0, [%sp + 0 * 4] ! save L & I registers
218 std %l2, [%sp + 2 * 4]
219 std %l4, [%sp + 4 * 4]
220 std %l6, [%sp + 6 * 4]
221
222 std %i0, [%sp + 8 * 4]
223 std %i2, [%sp + 10 * 4]
224 std %i4, [%sp + 12 * 4]
225 std %i6, [%sp + 14 * 4]
226
227 restore ! Go back to trap window.
228 mov %l4, %g1 ! Restore %g1
229
230 window_fine:
231 sethi %hi(in_trap_handler), %l4
232 ld [%lo(in_trap_handler) + %l4], %l5
233 tst %l5
234 bg recursive_trap
235 inc %l5
236
237 set trapstack+1000*4, %sp ! Switch to trap stack
238
239 recursive_trap:
240 st %l5, [%lo(in_trap_handler) + %l4]
241 sub %sp,(16+1+6+1+88)*4,%sp ! Make room for input & locals
242 ! + hidden arg + arg spill
243 ! + doubleword alignment
244 ! + registers[121]
245
246 std %g0, [%sp + (24 + 0) * 4] ! registers[Gx]
247 std %g2, [%sp + (24 + 2) * 4]
248 std %g4, [%sp + (24 + 4) * 4]
249 std %g6, [%sp + (24 + 6) * 4]
250
251 std %i0, [%sp + (24 + 8) * 4] ! registers[Ox]
252 std %i2, [%sp + (24 + 10) * 4]
253 std %i4, [%sp + (24 + 12) * 4]
254 std %i6, [%sp + (24 + 14) * 4]
255
256 ! FP regs (sparclet doesn't have fpu)
257
258 mov %y, %l4
259 mov %tbr, %l5
260 st %l4, [%sp + (24 + 64) * 4] ! Y
261 st %l0, [%sp + (24 + 65) * 4] ! PSR
262 st %l3, [%sp + (24 + 66) * 4] ! WIM
263 st %l5, [%sp + (24 + 67) * 4] ! TBR
264 st %l1, [%sp + (24 + 68) * 4] ! PC
265 st %l2, [%sp + (24 + 69) * 4] ! NPC
266 ! CPSR and FPSR not impl
267 or %l0, 0xf20, %l4
268 mov %l4, %psr ! Turn on traps, disable interrupts
269 nop
270 nop
271 nop
272
273 ! Save coprocessor state.
274 ! See SK/demo/hdlc_demo/ldc_swap_context.S.
275
276 mov %psr, %l0
277 sethi %hi(0x2000), %l5 ! EC bit in PSR
278 or %l5, %l0, %l5
279 mov %l5, %psr ! enable coprocessor
280 nop ! 3 nops after write to %psr (needed?)
281 nop
282 nop
283 crdcxt %ccsr, %l1 ! capture CCSR
284 mov 0x6, %l2
285 cwrcxt %l2, %ccsr ! set CCP state machine for CCFR
286 crdcxt %ccfr, %l2 ! capture CCOR
287 cwrcxt %l2, %ccfr ! tickle CCFR
288 crdcxt %ccfr, %l3 ! capture CCOBR
289 cwrcxt %l3, %ccfr ! tickle CCFR
290 crdcxt %ccfr, %l4 ! capture CCIBR
291 cwrcxt %l4, %ccfr ! tickle CCFR
292 crdcxt %ccfr, %l5 ! capture CCIR
293 cwrcxt %l5, %ccfr ! tickle CCFR
294 crdcxt %ccpr, %l6 ! capture CCPR
295 crdcxt %cccrcr, %l7 ! capture CCCRCR
296 st %l1, [%sp + (24 + 72) * 4] ! save CCSR
297 st %l2, [%sp + (24 + 75) * 4] ! save CCOR
298 st %l3, [%sp + (24 + 76) * 4] ! save CCOBR
299 st %l4, [%sp + (24 + 77) * 4] ! save CCIBR
300 st %l5, [%sp + (24 + 78) * 4] ! save CCIR
301 st %l6, [%sp + (24 + 73) * 4] ! save CCPR
302 st %l7, [%sp + (24 + 74) * 4] ! save CCCRCR
303 mov %l0, %psr ! restore original PSR
304 nop ! 3 nops after write to %psr (needed?)
305 nop
306 nop
307
308 ! End of saving coprocessor state.
309 ! Save asr regs
310
311 ! Part of this is silly -- we should not display ASR15 or ASR19 at all.
312
313 sethi %hi(0x01000000), %l6
314 st %l6, [%sp + (24 + 81) * 4] ! ASR15 == NOP
315 sethi %hi(0xdeadc0de), %l6
316 or %l6, %lo(0xdeadc0de), %l6
317 st %l6, [%sp + (24 + 84) * 4] ! ASR19 == DEADC0DE
318
319 rd %asr1, %l4
320 st %l4, [%sp + (24 + 80) * 4]
321 ! rd %asr15, %l4 ! must not read ASR15
322 ! st %l4, [%sp + (24 + 81) * 4] ! (illegal instr trap)
323 rd %asr17, %l4
324 st %l4, [%sp + (24 + 82) * 4]
325 rd %asr18, %l4
326 st %l4, [%sp + (24 + 83) * 4]
327 ! rd %asr19, %l4 ! must not read asr19
328 ! st %l4, [%sp + (24 + 84) * 4] ! (halts the CPU)
329 rd %asr20, %l4
330 st %l4, [%sp + (24 + 85) * 4]
331 rd %asr21, %l4
332 st %l4, [%sp + (24 + 86) * 4]
333 rd %asr22, %l4
334 st %l4, [%sp + (24 + 87) * 4]
335
336 ! End of saving asr regs
337
338 call _handle_exception
339 add %sp, 24 * 4, %o0 ! Pass address of registers
340
341 ! Reload all of the registers that aren't on the stack
342
343 ld [%sp + (24 + 1) * 4], %g1 ! registers[Gx]
344 ldd [%sp + (24 + 2) * 4], %g2
345 ldd [%sp + (24 + 4) * 4], %g4
346 ldd [%sp + (24 + 6) * 4], %g6
347
348 ldd [%sp + (24 + 8) * 4], %i0 ! registers[Ox]
349 ldd [%sp + (24 + 10) * 4], %i2
350 ldd [%sp + (24 + 12) * 4], %i4
351 ldd [%sp + (24 + 14) * 4], %i6
352
353 ! FP regs (sparclet doesn't have fpu)
354
355 ! Update the coprocessor registers.
356 ! See SK/demo/hdlc_demo/ldc_swap_context.S.
357
358 mov %psr, %l0
359 sethi %hi(0x2000), %l5 ! EC bit in PSR
360 or %l5, %l0, %l5
361 mov %l5, %psr ! enable coprocessor
362 nop ! 3 nops after write to %psr (needed?)
363 nop
364 nop
365
366 mov 0x6, %l2
367 cwrcxt %l2, %ccsr ! set CCP state machine for CCFR
368
369 ld [%sp + (24 + 72) * 4], %l1 ! saved CCSR
370 ld [%sp + (24 + 75) * 4], %l2 ! saved CCOR
371 ld [%sp + (24 + 76) * 4], %l3 ! saved CCOBR
372 ld [%sp + (24 + 77) * 4], %l4 ! saved CCIBR
373 ld [%sp + (24 + 78) * 4], %l5 ! saved CCIR
374 ld [%sp + (24 + 73) * 4], %l6 ! saved CCPR
375 ld [%sp + (24 + 74) * 4], %l7 ! saved CCCRCR
376
377 cwrcxt %l2, %ccfr ! restore CCOR
378 cwrcxt %l3, %ccfr ! restore CCOBR
379 cwrcxt %l4, %ccfr ! restore CCIBR
380 cwrcxt %l5, %ccfr ! restore CCIR
381 cwrcxt %l6, %ccpr ! restore CCPR
382 cwrcxt %l7, %cccrcr ! restore CCCRCR
383 cwrcxt %l1, %ccsr ! restore CCSR
384
385 mov %l0, %psr ! restore PSR
386 nop ! 3 nops after write to %psr (needed?)
387 nop
388 nop
389
390 ! End of coprocessor handling stuff.
391 ! Update asr regs
392
393 ld [%sp + (24 + 80) * 4], %l4
394 wr %l4, %asr1
395 ! ld [%sp + (24 + 81) * 4], %l4 ! can't write asr15
396 ! wr %l4, %asr15
397 ld [%sp + (24 + 82) * 4], %l4
398 wr %l4, %asr17
399 ld [%sp + (24 + 83) * 4], %l4
400 wr %l4, %asr18
401 ! ld [%sp + (24 + 84) * 4], %l4 ! can't write asr19
402 ! wr %l4, %asr19
403 ! ld [%sp + (24 + 85) * 4], %l4 ! can't write asr20
404 ! wr %l4, %asr20
405 ! ld [%sp + (24 + 86) * 4], %l4 ! can't write asr21
406 ! wr %l4, %asr21
407 ld [%sp + (24 + 87) * 4], %l4
408 wr %l4, %asr22
409
410 ! End of restoring asr regs
411
412
413 ldd [%sp + (24 + 64) * 4], %l0 ! Y & PSR
414 ldd [%sp + (24 + 68) * 4], %l2 ! PC & NPC
415
416 restore ! Ensure that previous window is valid
417 save %g0, %g0, %g0 ! by causing a window_underflow trap
418
419 mov %l0, %y
420 mov %l1, %psr ! Make sure that traps are disabled
421 ! for rett
422 nop ! 3 nops after write to %psr (needed?)
423 nop
424 nop
425
426 sethi %hi(in_trap_handler), %l4
427 ld [%lo(in_trap_handler) + %l4], %l5
428 dec %l5
429 st %l5, [%lo(in_trap_handler) + %l4]
430
431 jmpl %l2, %g0 ! Restore old PC
432 rett %l3 ! Restore old nPC
433 ");
434
435 /* Convert ch from a hex digit to an int */
436
437 static int
438 hex (unsigned char ch)
439 {
440 if (ch >= 'a' && ch <= 'f')
441 return ch-'a'+10;
442 if (ch >= '0' && ch <= '9')
443 return ch-'0';
444 if (ch >= 'A' && ch <= 'F')
445 return ch-'A'+10;
446 return -1;
447 }
448
449 static char remcomInBuffer[BUFMAX];
450 static char remcomOutBuffer[BUFMAX];
451
452 /* scan for the sequence $<data>#<checksum> */
453
454 unsigned char *
455 getpacket (void)
456 {
457 unsigned char *buffer = &remcomInBuffer[0];
458 unsigned char checksum;
459 unsigned char xmitcsum;
460 int count;
461 char ch;
462
463 while (1)
464 {
465 /* wait around for the start character, ignore all other characters */
466 while ((ch = getDebugChar ()) != '$')
467 ;
468
469 retry:
470 checksum = 0;
471 xmitcsum = -1;
472 count = 0;
473
474 /* now, read until a # or end of buffer is found */
475 while (count < BUFMAX)
476 {
477 ch = getDebugChar ();
478 if (ch == '$')
479 goto retry;
480 if (ch == '#')
481 break;
482 checksum = checksum + ch;
483 buffer[count] = ch;
484 count = count + 1;
485 }
486 buffer[count] = 0;
487
488 if (ch == '#')
489 {
490 ch = getDebugChar ();
491 xmitcsum = hex (ch) << 4;
492 ch = getDebugChar ();
493 xmitcsum += hex (ch);
494
495 if (checksum != xmitcsum)
496 {
497 putDebugChar ('-'); /* failed checksum */
498 }
499 else
500 {
501 putDebugChar ('+'); /* successful transfer */
502
503 /* if a sequence char is present, reply the sequence ID */
504 if (buffer[2] == ':')
505 {
506 putDebugChar (buffer[0]);
507 putDebugChar (buffer[1]);
508
509 return &buffer[3];
510 }
511
512 return &buffer[0];
513 }
514 }
515 }
516 }
517
518 /* send the packet in buffer. */
519
520 static void
521 putpacket (unsigned char *buffer)
522 {
523 unsigned char checksum;
524 int count;
525 unsigned char ch;
526
527 /* $<packet info>#<checksum>. */
528 do
529 {
530 putDebugChar('$');
531 checksum = 0;
532 count = 0;
533
534 while (ch = buffer[count])
535 {
536 putDebugChar(ch);
537 checksum += ch;
538 count += 1;
539 }
540
541 putDebugChar('#');
542 putDebugChar(hexchars[checksum >> 4]);
543 putDebugChar(hexchars[checksum & 0xf]);
544
545 }
546 while (getDebugChar() != '+');
547 }
548
549 /* Indicate to caller of mem2hex or hex2mem that there has been an
550 error. */
551 static volatile int mem_err = 0;
552
553 /* Convert the memory pointed to by mem into hex, placing result in buf.
554 * Return a pointer to the last char put in buf (null), in case of mem fault,
555 * return 0.
556 * If MAY_FAULT is non-zero, then we will handle memory faults by returning
557 * a 0, else treat a fault like any other fault in the stub.
558 */
559
560 static unsigned char *
561 mem2hex (unsigned char *mem, unsigned char *buf, int count, int may_fault)
562 {
563 unsigned char ch;
564
565 set_mem_fault_trap(may_fault);
566
567 while (count-- > 0)
568 {
569 ch = *mem++;
570 if (mem_err)
571 return 0;
572 *buf++ = hexchars[ch >> 4];
573 *buf++ = hexchars[ch & 0xf];
574 }
575
576 *buf = 0;
577
578 set_mem_fault_trap(0);
579
580 return buf;
581 }
582
583 /* convert the hex array pointed to by buf into binary to be placed in mem
584 * return a pointer to the character AFTER the last byte written */
585
586 static char *
587 hex2mem (unsigned char *buf, unsigned char *mem, int count, int may_fault)
588 {
589 int i;
590 unsigned char ch;
591
592 set_mem_fault_trap(may_fault);
593
594 for (i=0; i<count; i++)
595 {
596 ch = hex(*buf++) << 4;
597 ch |= hex(*buf++);
598 *mem++ = ch;
599 if (mem_err)
600 return 0;
601 }
602
603 set_mem_fault_trap(0);
604
605 return mem;
606 }
607
608 /* This table contains the mapping between SPARC hardware trap types, and
609 signals, which are primarily what GDB understands. It also indicates
610 which hardware traps we need to commandeer when initializing the stub. */
611
612 static struct hard_trap_info
613 {
614 unsigned char tt; /* Trap type code for SPARClite */
615 unsigned char signo; /* Signal that we map this trap into */
616 } hard_trap_info[] = {
617 {1, SIGSEGV}, /* instruction access exception */
618 {0x3b, SIGSEGV}, /* instruction access error */
619 {2, SIGILL}, /* illegal instruction */
620 {3, SIGILL}, /* privileged instruction */
621 {4, SIGEMT}, /* fp disabled */
622 {0x24, SIGEMT}, /* cp disabled */
623 {7, SIGBUS}, /* mem address not aligned */
624 {0x29, SIGSEGV}, /* data access exception */
625 {10, SIGEMT}, /* tag overflow */
626 {128+1, SIGTRAP}, /* ta 1 - normal breakpoint instruction */
627 {0, 0} /* Must be last */
628 };
629
630 /* Set up exception handlers for tracing and breakpoints */
631
632 void
633 set_debug_traps (void)
634 {
635 struct hard_trap_info *ht;
636
637 for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
638 exceptionHandler(ht->tt, trap_low);
639
640 initialized = 1;
641 }
642
643 asm ("
644 ! Trap handler for memory errors. This just sets mem_err to be non-zero. It
645 ! assumes that %l1 is non-zero. This should be safe, as it is doubtful that
646 ! 0 would ever contain code that could mem fault. This routine will skip
647 ! past the faulting instruction after setting mem_err.
648
649 .text
650 .align 4
651
652 _fltr_set_mem_err:
653 sethi %hi(_mem_err), %l0
654 st %l1, [%l0 + %lo(_mem_err)]
655 jmpl %l2, %g0
656 rett %l2+4
657 ");
658
659 static void
660 set_mem_fault_trap (int enable)
661 {
662 extern void fltr_set_mem_err();
663 mem_err = 0;
664
665 if (enable)
666 exceptionHandler(0x29, fltr_set_mem_err);
667 else
668 exceptionHandler(0x29, trap_low);
669 }
670
671 asm ("
672 .text
673 .align 4
674
675 _dummy_hw_breakpoint:
676 jmpl %l2, %g0
677 rett %l2+4
678 nop
679 nop
680 ");
681
682 static void
683 set_hw_breakpoint_trap (int enable)
684 {
685 extern void dummy_hw_breakpoint();
686
687 if (enable)
688 exceptionHandler(255, dummy_hw_breakpoint);
689 else
690 exceptionHandler(255, trap_low);
691 }
692
693 static void
694 get_in_break_mode (void)
695 {
696 #if 0
697 int x;
698 mesg("get_in_break_mode, sp = ");
699 phex(&x);
700 #endif
701 set_hw_breakpoint_trap(1);
702
703 asm("
704 sethi %hi(0xff10), %l4
705 or %l4, %lo(0xff10), %l4
706 sta %g0, [%l4]0x1
707 nop
708 nop
709 nop
710 ");
711
712 set_hw_breakpoint_trap(0);
713 }
714
715 /* Convert the SPARC hardware trap type code to a unix signal number. */
716
717 static int
718 computeSignal (int tt)
719 {
720 struct hard_trap_info *ht;
721
722 for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
723 if (ht->tt == tt)
724 return ht->signo;
725
726 return SIGHUP; /* default for things we don't know about */
727 }
728
729 /*
730 * While we find nice hex chars, build an int.
731 * Return number of chars processed.
732 */
733
734 static int
735 hexToInt(char **ptr, int *intValue)
736 {
737 int numChars = 0;
738 int hexValue;
739
740 *intValue = 0;
741
742 while (**ptr)
743 {
744 hexValue = hex(**ptr);
745 if (hexValue < 0)
746 break;
747
748 *intValue = (*intValue << 4) | hexValue;
749 numChars ++;
750
751 (*ptr)++;
752 }
753
754 return (numChars);
755 }
756
757 /*
758 * This function does all command procesing for interfacing to gdb. It
759 * returns 1 if you should skip the instruction at the trap address, 0
760 * otherwise.
761 */
762
763 static void
764 handle_exception (unsigned long *registers)
765 {
766 int tt; /* Trap type */
767 int sigval;
768 int addr;
769 int length;
770 char *ptr;
771 unsigned long *sp;
772 unsigned long dsr;
773
774 /* First, we must force all of the windows to be spilled out */
775
776 asm("
777 ! Ugh. sparclet has broken save
778 !save %sp, -64, %sp
779 save
780 add %fp,-64,%sp
781 !save %sp, -64, %sp
782 save
783 add %fp,-64,%sp
784 !save %sp, -64, %sp
785 save
786 add %fp,-64,%sp
787 !save %sp, -64, %sp
788 save
789 add %fp,-64,%sp
790 !save %sp, -64, %sp
791 save
792 add %fp,-64,%sp
793 !save %sp, -64, %sp
794 save
795 add %fp,-64,%sp
796 !save %sp, -64, %sp
797 save
798 add %fp,-64,%sp
799 !save %sp, -64, %sp
800 save
801 add %fp,-64,%sp
802 restore
803 restore
804 restore
805 restore
806 restore
807 restore
808 restore
809 restore
810 ");
811
812 if (registers[PC] == (unsigned long)breakinst)
813 {
814 registers[PC] = registers[NPC];
815 registers[NPC] += 4;
816 }
817 sp = (unsigned long *)registers[SP];
818
819 tt = (registers[TBR] >> 4) & 0xff;
820
821 /* reply to host that an exception has occurred */
822 sigval = computeSignal(tt);
823 ptr = remcomOutBuffer;
824
825 *ptr++ = 'T';
826 *ptr++ = hexchars[sigval >> 4];
827 *ptr++ = hexchars[sigval & 0xf];
828
829 *ptr++ = hexchars[PC >> 4];
830 *ptr++ = hexchars[PC & 0xf];
831 *ptr++ = ':';
832 ptr = mem2hex((char *)&registers[PC], ptr, 4, 0);
833 *ptr++ = ';';
834
835 *ptr++ = hexchars[FP >> 4];
836 *ptr++ = hexchars[FP & 0xf];
837 *ptr++ = ':';
838 ptr = mem2hex(sp + 8 + 6, ptr, 4, 0); /* FP */
839 *ptr++ = ';';
840
841 *ptr++ = hexchars[SP >> 4];
842 *ptr++ = hexchars[SP & 0xf];
843 *ptr++ = ':';
844 ptr = mem2hex((char *)&sp, ptr, 4, 0);
845 *ptr++ = ';';
846
847 *ptr++ = hexchars[NPC >> 4];
848 *ptr++ = hexchars[NPC & 0xf];
849 *ptr++ = ':';
850 ptr = mem2hex((char *)&registers[NPC], ptr, 4, 0);
851 *ptr++ = ';';
852
853 *ptr++ = hexchars[O7 >> 4];
854 *ptr++ = hexchars[O7 & 0xf];
855 *ptr++ = ':';
856 ptr = mem2hex((char *)&registers[O7], ptr, 4, 0);
857 *ptr++ = ';';
858
859 *ptr++ = 0;
860
861 putpacket(remcomOutBuffer);
862
863 while (1)
864 {
865 remcomOutBuffer[0] = 0;
866
867 ptr = getpacket();
868 switch (*ptr++)
869 {
870 case '?':
871 remcomOutBuffer[0] = 'S';
872 remcomOutBuffer[1] = hexchars[sigval >> 4];
873 remcomOutBuffer[2] = hexchars[sigval & 0xf];
874 remcomOutBuffer[3] = 0;
875 break;
876
877 case 'd':
878 remote_debug = !(remote_debug); /* toggle debug flag */
879 break;
880
881 case 'g': /* return the value of the CPU registers */
882 {
883 ptr = remcomOutBuffer;
884 ptr = mem2hex((char *)registers, ptr, 16 * 4, 0); /* G & O regs */
885 ptr = mem2hex(sp + 0, ptr, 16 * 4, 0); /* L & I regs */
886 memset(ptr, '0', 32 * 8); /* Floating point */
887 ptr = mem2hex((char *)&registers[Y],
888 ptr + 32 * 4 * 2,
889 8 * 4,
890 0); /* Y, PSR, WIM, TBR, PC, NPC, FPSR, CPSR */
891 ptr = mem2hex((char *)&registers[CCSR],
892 ptr,
893 8 * 4,
894 0); /* CCSR, CCPR, CCCRCR, CCOR, CCOBR, CCIBR, CCIR */
895 ptr = mem2hex((char *)&registers[ASR1],
896 ptr,
897 8 * 4,
898 0); /* ASR1,ASR15,ASR17,ASR18,ASR19,ASR20,ASR21,ASR22 */
899 #if 0 /* not implemented */
900 ptr = mem2hex((char *) &registers[AWR0],
901 ptr,
902 32 * 4,
903 0); /* Alternate Window Registers */
904 #endif
905 }
906 break;
907
908 case 'G': /* set value of all the CPU registers - return OK */
909 case 'P': /* set value of one CPU register - return OK */
910 {
911 unsigned long *newsp, psr;
912
913 psr = registers[PSR];
914
915 if (ptr[-1] == 'P') /* do a single register */
916 {
917 int regno;
918
919 if (hexToInt (&ptr, &regno)
920 && *ptr++ == '=')
921 if (regno >= L0 && regno <= I7)
922 hex2mem (ptr, sp + regno - L0, 4, 0);
923 else
924 hex2mem (ptr, (char *)&registers[regno], 4, 0);
925 else
926 {
927 strcpy (remcomOutBuffer, "E01");
928 break;
929 }
930 }
931 else
932 {
933 hex2mem(ptr, (char *)registers, 16 * 4, 0); /* G & O regs */
934 hex2mem(ptr + 16 * 4 * 2, sp + 0, 16 * 4, 0); /* L & I regs */
935 hex2mem(ptr + 64 * 4 * 2, (char *)&registers[Y],
936 8 * 4, 0); /* Y,PSR,WIM,TBR,PC,NPC,FPSR,CPSR */
937 hex2mem(ptr + 72 * 4 * 2, (char *)&registers[CCSR],
938 8 * 4, 0); /* CCSR,CCPR,CCCRCR,CCOR,CCOBR,CCIBR,CCIR */
939 hex2mem(ptr + 80 * 4 * 2, (char *)&registers[ASR1],
940 8 * 4, 0); /* ASR1 ... ASR22 */
941 #if 0 /* not implemented */
942 hex2mem(ptr + 88 * 4 * 2, (char *)&registers[AWR0],
943 8 * 4, 0); /* Alternate Window Registers */
944 #endif
945 }
946 /* See if the stack pointer has moved. If so, then copy the saved
947 locals and ins to the new location. This keeps the window
948 overflow and underflow routines happy. */
949
950 newsp = (unsigned long *)registers[SP];
951 if (sp != newsp)
952 sp = memcpy(newsp, sp, 16 * 4);
953
954 /* Don't allow CWP to be modified. */
955
956 if (psr != registers[PSR])
957 registers[PSR] = (psr & 0x1f) | (registers[PSR] & ~0x1f);
958
959 strcpy(remcomOutBuffer,"OK");
960 }
961 break;
962
963 case 'm': /* mAA..AA,LLLL Read LLLL bytes at address AA..AA */
964 /* Try to read %x,%x. */
965
966 if (hexToInt(&ptr, &addr)
967 && *ptr++ == ','
968 && hexToInt(&ptr, &length))
969 {
970 if (mem2hex((char *)addr, remcomOutBuffer, length, 1))
971 break;
972
973 strcpy (remcomOutBuffer, "E03");
974 }
975 else
976 strcpy(remcomOutBuffer,"E01");
977 break;
978
979 case 'M': /* MAA..AA,LLLL: Write LLLL bytes at address AA.AA return OK */
980 /* Try to read '%x,%x:'. */
981
982 if (hexToInt(&ptr, &addr)
983 && *ptr++ == ','
984 && hexToInt(&ptr, &length)
985 && *ptr++ == ':')
986 {
987 if (hex2mem(ptr, (char *)addr, length, 1))
988 strcpy(remcomOutBuffer, "OK");
989 else
990 strcpy(remcomOutBuffer, "E03");
991 }
992 else
993 strcpy(remcomOutBuffer, "E02");
994 break;
995
996 case 'c': /* cAA..AA Continue at address AA..AA(optional) */
997 /* try to read optional parameter, pc unchanged if no parm */
998
999 if (hexToInt(&ptr, &addr))
1000 {
1001 registers[PC] = addr;
1002 registers[NPC] = addr + 4;
1003 }
1004
1005 /* Need to flush the instruction cache here, as we may have deposited a
1006 breakpoint, and the icache probably has no way of knowing that a data ref to
1007 some location may have changed something that is in the instruction cache.
1008 */
1009
1010 flush_i_cache();
1011 return;
1012
1013 /* kill the program */
1014 case 'k' : /* do nothing */
1015 break;
1016 #if 0
1017 case 't': /* Test feature */
1018 asm (" std %f30,[%sp]");
1019 break;
1020 #endif
1021 case 'r': /* Reset */
1022 asm ("call 0
1023 nop ");
1024 break;
1025 } /* switch */
1026
1027 /* reply to the request */
1028 putpacket(remcomOutBuffer);
1029 }
1030 }
1031
1032 /* This function will generate a breakpoint exception. It is used at the
1033 beginning of a program to sync up with a debugger and can be used
1034 otherwise as a quick means to stop program execution and "break" into
1035 the debugger. */
1036
1037 void
1038 breakpoint (void)
1039 {
1040 if (!initialized)
1041 return;
1042
1043 asm(" .globl _breakinst
1044
1045 _breakinst: ta 1
1046 ");
1047 }
1048
1049 static void
1050 hw_breakpoint (void)
1051 {
1052 asm("
1053 ta 127
1054 ");
1055 }
1056
1057 #if 0 /* experimental and never finished, left here for reference */
1058 static void
1059 splet_temp(void)
1060 {
1061 asm(" sub %sp,(16+1+6+1+121)*4,%sp ! Make room for input & locals
1062 ! + hidden arg + arg spill
1063 ! + doubleword alignment
1064 ! + registers[121]
1065
1066 ! Leave a trail of breadcrumbs! (save register save area for debugging)
1067 mov %sp, %l0
1068 add %l0, 24*4, %l0
1069 sethi %hi(_debug_registers), %l1
1070 st %l0, [%lo(_debug_registers) + %l1]
1071
1072 ! Save the Alternate Register Set: (not implemented yet)
1073 ! To save the Alternate Register set, we must:
1074 ! 1) Save the current SP in some global location.
1075 ! 2) Swap the register sets.
1076 ! 3) Save the Alternate SP in the Y register
1077 ! 4) Fetch the SP that we saved in step 1.
1078 ! 5) Use that to save the rest of the regs (not forgetting ASP in Y)
1079 ! 6) Restore the Alternate SP from Y
1080 ! 7) Swap the registers back.
1081
1082 ! 1) Copy the current stack pointer to global _SAVED_STACK_POINTER:
1083 sethi %hi(_saved_stack_pointer), %l0
1084 st %sp, [%lo(_saved_stack_pointer) + %l0]
1085
1086 ! 2) Swap the register sets:
1087 mov %psr, %l1
1088 sethi %hi(0x10000), %l2
1089 xor %l1, %l2, %l1
1090 mov %l1, %psr
1091 nop ! 3 nops after write to %psr (needed?)
1092 nop
1093 nop
1094
1095 ! 3) Save Alternate L0 in Y
1096 wr %l0, 0, %y
1097
1098 ! 4) Load former SP into alternate SP, using L0
1099 sethi %hi(_saved_stack_pointer), %l0
1100 or %lo(_saved_stack_pointer), %l0, %l0
1101 swap [%l0], %sp
1102
1103 ! 4.5) Restore alternate L0
1104 rd %y, %l0
1105
1106 ! 5) Save the Alternate Window Registers
1107 st %r0, [%sp + (24 + 88) * 4] ! AWR0
1108 st %r1, [%sp + (24 + 89) * 4] ! AWR1
1109 st %r2, [%sp + (24 + 90) * 4] ! AWR2
1110 st %r3, [%sp + (24 + 91) * 4] ! AWR3
1111 st %r4, [%sp + (24 + 92) * 4] ! AWR4
1112 st %r5, [%sp + (24 + 93) * 4] ! AWR5
1113 st %r6, [%sp + (24 + 94) * 4] ! AWR6
1114 st %r7, [%sp + (24 + 95) * 4] ! AWR7
1115 st %r8, [%sp + (24 + 96) * 4] ! AWR8
1116 st %r9, [%sp + (24 + 97) * 4] ! AWR9
1117 st %r10, [%sp + (24 + 98) * 4] ! AWR10
1118 st %r11, [%sp + (24 + 99) * 4] ! AWR11
1119 st %r12, [%sp + (24 + 100) * 4] ! AWR12
1120 st %r13, [%sp + (24 + 101) * 4] ! AWR13
1121 ! st %r14, [%sp + (24 + 102) * 4] ! AWR14 (SP)
1122 st %r15, [%sp + (24 + 103) * 4] ! AWR15
1123 st %r16, [%sp + (24 + 104) * 4] ! AWR16
1124 st %r17, [%sp + (24 + 105) * 4] ! AWR17
1125 st %r18, [%sp + (24 + 106) * 4] ! AWR18
1126 st %r19, [%sp + (24 + 107) * 4] ! AWR19
1127 st %r20, [%sp + (24 + 108) * 4] ! AWR20
1128 st %r21, [%sp + (24 + 109) * 4] ! AWR21
1129 st %r22, [%sp + (24 + 110) * 4] ! AWR22
1130 st %r23, [%sp + (24 + 111) * 4] ! AWR23
1131 st %r24, [%sp + (24 + 112) * 4] ! AWR24
1132 st %r25, [%sp + (24 + 113) * 4] ! AWR25
1133 st %r26, [%sp + (24 + 114) * 4] ! AWR26
1134 st %r27, [%sp + (24 + 115) * 4] ! AWR27
1135 st %r28, [%sp + (24 + 116) * 4] ! AWR28
1136 st %r29, [%sp + (24 + 117) * 4] ! AWR29
1137 st %r30, [%sp + (24 + 118) * 4] ! AWR30
1138 st %r31, [%sp + (24 + 119) * 4] ! AWR21
1139
1140 ! Get the Alternate PSR (I hope...)
1141
1142 rd %psr, %l2
1143 st %l2, [%sp + (24 + 120) * 4] ! APSR
1144
1145 ! Don't forget the alternate stack pointer
1146
1147 rd %y, %l3
1148 st %l3, [%sp + (24 + 102) * 4] ! AWR14 (SP)
1149
1150 ! 6) Restore the Alternate SP (saved in Y)
1151
1152 rd %y, %o6
1153
1154
1155 ! 7) Swap the registers back:
1156
1157 mov %psr, %l1
1158 sethi %hi(0x10000), %l2
1159 xor %l1, %l2, %l1
1160 mov %l1, %psr
1161 nop ! 3 nops after write to %psr (needed?)
1162 nop
1163 nop
1164 ");
1165 }
1166
1167 #endif