1a47a12beSStefan Roese #include <common.h>
2a47a12beSStefan Roese #include <command.h>
3a47a12beSStefan Roese #include <kgdb.h>
4a47a12beSStefan Roese #include <asm/signal.h>
5a47a12beSStefan Roese #include <asm/processor.h>
6a47a12beSStefan Roese
7a47a12beSStefan Roese #define PC_REGNUM 64
8a47a12beSStefan Roese #define SP_REGNUM 1
9a47a12beSStefan Roese
10a47a12beSStefan Roese void breakinst(void);
11a47a12beSStefan Roese
12a47a12beSStefan Roese int
kgdb_setjmp(long * buf)13a47a12beSStefan Roese kgdb_setjmp(long *buf)
14a47a12beSStefan Roese {
1596805a52STimur Tabi unsigned long temp;
1696805a52STimur Tabi
1796805a52STimur Tabi asm volatile("mflr %0; stw %0,0(%1);"
1896805a52STimur Tabi "stw %%r1,4(%1); stw %%r2,8(%1);"
1996805a52STimur Tabi "mfcr %0; stw %0,12(%1);"
2096805a52STimur Tabi "stmw %%r13,16(%1)"
2196805a52STimur Tabi : "=&r"(temp) : "r" (buf));
22a47a12beSStefan Roese /* XXX should save fp regs as well */
23a47a12beSStefan Roese return 0;
24a47a12beSStefan Roese }
25a47a12beSStefan Roese
26a47a12beSStefan Roese void
kgdb_longjmp(long * buf,int val)27a47a12beSStefan Roese kgdb_longjmp(long *buf, int val)
28a47a12beSStefan Roese {
2996805a52STimur Tabi unsigned long temp;
3096805a52STimur Tabi
31a47a12beSStefan Roese if (val == 0)
32a47a12beSStefan Roese val = 1;
3396805a52STimur Tabi
3496805a52STimur Tabi asm volatile("lmw %%r13,16(%1);"
3596805a52STimur Tabi "lwz %0,12(%1); mtcrf 0x38,%0;"
3696805a52STimur Tabi "lwz %0,0(%1); lwz %%r1,4(%1); lwz %%r2,8(%1);"
3796805a52STimur Tabi "mtlr %0; mr %%r3,%2"
3896805a52STimur Tabi : "=&r"(temp) : "r" (buf), "r" (val));
39a47a12beSStefan Roese }
40a47a12beSStefan Roese
41a47a12beSStefan Roese /* Convert the SPARC hardware trap type code to a unix signal number. */
42a47a12beSStefan Roese /*
43a47a12beSStefan Roese * This table contains the mapping between PowerPC hardware trap types, and
44a47a12beSStefan Roese * signals, which are primarily what GDB understands.
45a47a12beSStefan Roese */
46a47a12beSStefan Roese static struct hard_trap_info
47a47a12beSStefan Roese {
48a47a12beSStefan Roese unsigned int tt; /* Trap type code for powerpc */
49a47a12beSStefan Roese unsigned char signo; /* Signal that we map this trap into */
50a47a12beSStefan Roese } hard_trap_info[] = {
51a47a12beSStefan Roese { 0x200, SIGSEGV }, /* machine check */
52a47a12beSStefan Roese { 0x300, SIGSEGV }, /* address error (store) */
53a47a12beSStefan Roese { 0x400, SIGBUS }, /* instruction bus error */
54a47a12beSStefan Roese { 0x500, SIGINT }, /* interrupt */
55*b60cfb6aSHeinrich Schuchardt { 0x600, SIGBUS }, /* alignment */
56a47a12beSStefan Roese { 0x700, SIGTRAP }, /* breakpoint trap */
57a47a12beSStefan Roese { 0x800, SIGFPE }, /* fpu unavail */
58a47a12beSStefan Roese { 0x900, SIGALRM }, /* decrementer */
59a47a12beSStefan Roese { 0xa00, SIGILL }, /* reserved */
60a47a12beSStefan Roese { 0xb00, SIGILL }, /* reserved */
61a47a12beSStefan Roese { 0xc00, SIGCHLD }, /* syscall */
62a47a12beSStefan Roese { 0xd00, SIGTRAP }, /* single-step/watch */
63a47a12beSStefan Roese { 0xe00, SIGFPE }, /* fp assist */
64a47a12beSStefan Roese { 0, 0} /* Must be last */
65a47a12beSStefan Roese };
66a47a12beSStefan Roese
67a47a12beSStefan Roese static int
computeSignal(unsigned int tt)68a47a12beSStefan Roese computeSignal(unsigned int tt)
69a47a12beSStefan Roese {
70a47a12beSStefan Roese struct hard_trap_info *ht;
71a47a12beSStefan Roese
72a47a12beSStefan Roese for (ht = hard_trap_info; ht->tt && ht->signo; ht++)
73a47a12beSStefan Roese if (ht->tt == tt)
74a47a12beSStefan Roese return ht->signo;
75a47a12beSStefan Roese
76a47a12beSStefan Roese return SIGHUP; /* default for things we don't know about */
77a47a12beSStefan Roese }
78a47a12beSStefan Roese
79a47a12beSStefan Roese void
kgdb_enter(struct pt_regs * regs,kgdb_data * kdp)80a47a12beSStefan Roese kgdb_enter(struct pt_regs *regs, kgdb_data *kdp)
81a47a12beSStefan Roese {
82a47a12beSStefan Roese unsigned long msr;
83a47a12beSStefan Roese
84a47a12beSStefan Roese kdp->private[0] = msr = get_msr();
85a47a12beSStefan Roese set_msr(msr & ~MSR_EE); /* disable interrupts */
86a47a12beSStefan Roese
87a47a12beSStefan Roese if (regs->nip == (unsigned long)breakinst) {
88a47a12beSStefan Roese /* Skip over breakpoint trap insn */
89a47a12beSStefan Roese regs->nip += 4;
90a47a12beSStefan Roese }
91a47a12beSStefan Roese regs->msr &= ~MSR_SE;
92a47a12beSStefan Roese
93a47a12beSStefan Roese /* reply to host that an exception has occurred */
94a47a12beSStefan Roese kdp->sigval = computeSignal(regs->trap);
95a47a12beSStefan Roese
96a47a12beSStefan Roese kdp->nregs = 2;
97a47a12beSStefan Roese
98a47a12beSStefan Roese kdp->regs[0].num = PC_REGNUM;
99a47a12beSStefan Roese kdp->regs[0].val = regs->nip;
100a47a12beSStefan Roese
101a47a12beSStefan Roese kdp->regs[1].num = SP_REGNUM;
102a47a12beSStefan Roese kdp->regs[1].val = regs->gpr[SP_REGNUM];
103a47a12beSStefan Roese }
104a47a12beSStefan Roese
105a47a12beSStefan Roese void
kgdb_exit(struct pt_regs * regs,kgdb_data * kdp)106a47a12beSStefan Roese kgdb_exit(struct pt_regs *regs, kgdb_data *kdp)
107a47a12beSStefan Roese {
108a47a12beSStefan Roese unsigned long msr = kdp->private[0];
109a47a12beSStefan Roese
110a47a12beSStefan Roese if (kdp->extype & KGDBEXIT_WITHADDR)
111a47a12beSStefan Roese regs->nip = kdp->exaddr;
112a47a12beSStefan Roese
113a47a12beSStefan Roese switch (kdp->extype & KGDBEXIT_TYPEMASK) {
114a47a12beSStefan Roese
115a47a12beSStefan Roese case KGDBEXIT_KILL:
116a47a12beSStefan Roese case KGDBEXIT_CONTINUE:
117a47a12beSStefan Roese set_msr(msr);
118a47a12beSStefan Roese break;
119a47a12beSStefan Roese
120a47a12beSStefan Roese case KGDBEXIT_SINGLE:
121a47a12beSStefan Roese regs->msr |= MSR_SE;
122a47a12beSStefan Roese #if 0
123a47a12beSStefan Roese set_msr(msr | MSR_SE);
124a47a12beSStefan Roese #endif
125a47a12beSStefan Roese break;
126a47a12beSStefan Roese }
127a47a12beSStefan Roese }
128a47a12beSStefan Roese
129a47a12beSStefan Roese int
kgdb_trap(struct pt_regs * regs)130a47a12beSStefan Roese kgdb_trap(struct pt_regs *regs)
131a47a12beSStefan Roese {
132a47a12beSStefan Roese return (regs->trap);
133a47a12beSStefan Roese }
134a47a12beSStefan Roese
135a47a12beSStefan Roese /* return the value of the CPU registers.
136a47a12beSStefan Roese * some of them are non-PowerPC names :(
137a47a12beSStefan Roese * they are stored in gdb like:
138a47a12beSStefan Roese * struct {
139a47a12beSStefan Roese * u32 gpr[32];
140a47a12beSStefan Roese * f64 fpr[32];
141a47a12beSStefan Roese * u32 pc, ps, cnd, lr; (ps=msr)
142a47a12beSStefan Roese * u32 cnt, xer, mq;
143a47a12beSStefan Roese * }
144a47a12beSStefan Roese */
145a47a12beSStefan Roese
146a47a12beSStefan Roese #define SPACE_REQUIRED ((32*4)+(32*8)+(6*4))
147a47a12beSStefan Roese
148a47a12beSStefan Roese int
kgdb_getregs(struct pt_regs * regs,char * buf,int max)149a47a12beSStefan Roese kgdb_getregs(struct pt_regs *regs, char *buf, int max)
150a47a12beSStefan Roese {
151a47a12beSStefan Roese int i;
152a47a12beSStefan Roese unsigned long *ptr = (unsigned long *)buf;
153a47a12beSStefan Roese
154a47a12beSStefan Roese if (max < SPACE_REQUIRED)
155a47a12beSStefan Roese kgdb_error(KGDBERR_NOSPACE);
156a47a12beSStefan Roese
157a47a12beSStefan Roese if ((unsigned long)ptr & 3)
158a47a12beSStefan Roese kgdb_error(KGDBERR_ALIGNFAULT);
159a47a12beSStefan Roese
160a47a12beSStefan Roese /* General Purpose Regs */
161a47a12beSStefan Roese for (i = 0; i < 32; i++)
162a47a12beSStefan Roese *ptr++ = regs->gpr[i];
163a47a12beSStefan Roese
164a47a12beSStefan Roese /* Floating Point Regs */
165a47a12beSStefan Roese for (i = 0; i < 32; i++) {
166a47a12beSStefan Roese *ptr++ = 0;
167a47a12beSStefan Roese *ptr++ = 0;
168a47a12beSStefan Roese }
169a47a12beSStefan Roese
170a47a12beSStefan Roese /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
171a47a12beSStefan Roese *ptr++ = regs->nip;
172a47a12beSStefan Roese *ptr++ = regs->msr;
173a47a12beSStefan Roese *ptr++ = regs->ccr;
174a47a12beSStefan Roese *ptr++ = regs->link;
175a47a12beSStefan Roese *ptr++ = regs->ctr;
176a47a12beSStefan Roese *ptr++ = regs->xer;
177a47a12beSStefan Roese
178a47a12beSStefan Roese return (SPACE_REQUIRED);
179a47a12beSStefan Roese }
180a47a12beSStefan Roese
181a47a12beSStefan Roese /* set the value of the CPU registers */
182a47a12beSStefan Roese void
kgdb_putreg(struct pt_regs * regs,int regno,char * buf,int length)183a47a12beSStefan Roese kgdb_putreg(struct pt_regs *regs, int regno, char *buf, int length)
184a47a12beSStefan Roese {
185a47a12beSStefan Roese unsigned long *ptr = (unsigned long *)buf;
186a47a12beSStefan Roese
187a47a12beSStefan Roese if (regno < 0 || regno >= 70)
188a47a12beSStefan Roese kgdb_error(KGDBERR_BADPARAMS);
189a47a12beSStefan Roese else if (regno >= 32 && regno < 64) {
190a47a12beSStefan Roese if (length < 8)
191a47a12beSStefan Roese kgdb_error(KGDBERR_NOSPACE);
192a47a12beSStefan Roese }
193a47a12beSStefan Roese else {
194a47a12beSStefan Roese if (length < 4)
195a47a12beSStefan Roese kgdb_error(KGDBERR_NOSPACE);
196a47a12beSStefan Roese }
197a47a12beSStefan Roese
198a47a12beSStefan Roese if ((unsigned long)ptr & 3)
199a47a12beSStefan Roese kgdb_error(KGDBERR_ALIGNFAULT);
200a47a12beSStefan Roese
201a47a12beSStefan Roese if (regno >= 0 && regno < 32)
202a47a12beSStefan Roese regs->gpr[regno] = *ptr;
203a47a12beSStefan Roese else switch (regno) {
204a47a12beSStefan Roese case 64: regs->nip = *ptr; break;
205a47a12beSStefan Roese case 65: regs->msr = *ptr; break;
206a47a12beSStefan Roese case 66: regs->ccr = *ptr; break;
207a47a12beSStefan Roese case 67: regs->link = *ptr; break;
208a47a12beSStefan Roese case 68: regs->ctr = *ptr; break;
209a47a12beSStefan Roese case 69: regs->ctr = *ptr; break;
210a47a12beSStefan Roese
211a47a12beSStefan Roese default:
212a47a12beSStefan Roese kgdb_error(KGDBERR_BADPARAMS);
213a47a12beSStefan Roese }
214a47a12beSStefan Roese }
215a47a12beSStefan Roese
216a47a12beSStefan Roese void
kgdb_putregs(struct pt_regs * regs,char * buf,int length)217a47a12beSStefan Roese kgdb_putregs(struct pt_regs *regs, char *buf, int length)
218a47a12beSStefan Roese {
219a47a12beSStefan Roese int i;
220a47a12beSStefan Roese unsigned long *ptr = (unsigned long *)buf;
221a47a12beSStefan Roese
222a47a12beSStefan Roese if (length < SPACE_REQUIRED)
223a47a12beSStefan Roese kgdb_error(KGDBERR_NOSPACE);
224a47a12beSStefan Roese
225a47a12beSStefan Roese if ((unsigned long)ptr & 3)
226a47a12beSStefan Roese kgdb_error(KGDBERR_ALIGNFAULT);
227a47a12beSStefan Roese
228a47a12beSStefan Roese /*
229a47a12beSStefan Roese * If the stack pointer has moved, you should pray.
230a47a12beSStefan Roese * (cause only god can help you).
231a47a12beSStefan Roese */
232a47a12beSStefan Roese
233a47a12beSStefan Roese /* General Purpose Regs */
234a47a12beSStefan Roese for (i = 0; i < 32; i++)
235a47a12beSStefan Roese regs->gpr[i] = *ptr++;
236a47a12beSStefan Roese
237a47a12beSStefan Roese /* Floating Point Regs */
238a47a12beSStefan Roese ptr += 32*2;
239a47a12beSStefan Roese
240a47a12beSStefan Roese /* pc, msr, cr, lr, ctr, xer, (mq is unused) */
241a47a12beSStefan Roese regs->nip = *ptr++;
242a47a12beSStefan Roese regs->msr = *ptr++;
243a47a12beSStefan Roese regs->ccr = *ptr++;
244a47a12beSStefan Roese regs->link = *ptr++;
245a47a12beSStefan Roese regs->ctr = *ptr++;
246a47a12beSStefan Roese regs->xer = *ptr++;
247a47a12beSStefan Roese }
248a47a12beSStefan Roese
249a47a12beSStefan Roese /* This function will generate a breakpoint exception. It is used at the
250a47a12beSStefan Roese beginning of a program to sync up with a debugger and can be used
251a47a12beSStefan Roese otherwise as a quick means to stop program execution and "break" into
252a47a12beSStefan Roese the debugger. */
253a47a12beSStefan Roese
254a47a12beSStefan Roese void
kgdb_breakpoint(int argc,char * const argv[])25554841ab5SWolfgang Denk kgdb_breakpoint(int argc, char * const argv[])
256a47a12beSStefan Roese {
257a47a12beSStefan Roese asm(" .globl breakinst\n\
258a47a12beSStefan Roese breakinst: .long 0x7d821008\n\
259a47a12beSStefan Roese ");
260a47a12beSStefan Roese }
261