]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - cpu/mpc83xx/traps.c
imported Ka-Ro specific additions to U-Boot 2009.08 for TX28
[karo-tx-uboot.git] / cpu / mpc83xx / traps.c
1 /*
2  * (C) Copyright 2000
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * Copyright (C) 1995-1996  Gary Thomas (gdt@linuxppc.org)
6  *
7  * This program is free software; you can redistribute it and/or
8  * modify it under the terms of the GNU General Public License as
9  * published by the Free Software Foundation; either version 2 of
10  * the License, or (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
20  * MA 02111-1307 USA
21  */
22
23 /*
24  * This file handles the architecture-dependent parts of hardware
25  * exceptions
26  */
27
28 #include <common.h>
29 #include <command.h>
30 #include <asm/processor.h>
31 #include <asm/mpc8349_pci.h>
32
33 DECLARE_GLOBAL_DATA_PTR;
34
35 /* Returns 0 if exception not found and fixup otherwise.  */
36 extern unsigned long search_exception_table(unsigned long);
37
38 #define END_OF_MEM      (gd->bd->bi_memstart + gd->bd->bi_memsize)
39
40 /*
41  * Trap & Exception support
42  */
43
44 void
45 print_backtrace(unsigned long *sp)
46 {
47         int cnt = 0;
48         unsigned long i;
49
50         puts ("Call backtrace: ");
51         while (sp) {
52                 if ((uint)sp > END_OF_MEM)
53                         break;
54
55                 i = sp[1];
56                 if (cnt++ % 7 == 0)
57                         putc ('\n');
58                 printf("%08lX ", i);
59                 if (cnt > 32) break;
60                 sp = (unsigned long *)*sp;
61         }
62         putc ('\n');
63 }
64
65 void show_regs(struct pt_regs * regs)
66 {
67         int i;
68
69         printf("NIP: %08lX XER: %08lX LR: %08lX REGS: %p TRAP: %04lx DAR: %08lX\n",
70                regs->nip, regs->xer, regs->link, regs, regs->trap, regs->dar);
71         printf("MSR: %08lx EE: %01x PR: %01x FP: %01x ME: %01x IR/DR: %01x%01x\n",
72                regs->msr, regs->msr&MSR_EE ? 1 : 0, regs->msr&MSR_PR ? 1 : 0,
73                regs->msr & MSR_FP ? 1 : 0,regs->msr&MSR_ME ? 1 : 0,
74                regs->msr&MSR_IR ? 1 : 0,
75                regs->msr&MSR_DR ? 1 : 0);
76
77         putc ('\n');
78         for (i = 0;  i < 32;  i++) {
79                 if ((i % 8) == 0) {
80                         printf("GPR%02d: ", i);
81                 }
82
83                 printf("%08lX ", regs->gpr[i]);
84                 if ((i % 8) == 7) {
85                         putc ('\n');
86                 }
87         }
88 }
89
90
91 void
92 _exception(int signr, struct pt_regs *regs)
93 {
94         show_regs(regs);
95         print_backtrace((unsigned long *)regs->gpr[1]);
96         panic("Exception in kernel pc %lx signal %d",regs->nip,signr);
97 }
98
99 #ifdef CONFIG_PCI
100 void dump_pci (void)
101 {
102 /*
103         volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
104         printf ("PCI: err status %x err mask %x err ctrl %x\n",
105                 le32_to_cpu (immap->im_pci.pci_esr),
106                 le32_to_cpu (immap->im_pci.pci_emr),
107                 le32_to_cpu (immap->im_pci.pci_ecr));
108         printf ("     error address %x error data %x ctrl %x\n",
109                 le32_to_cpu (immap->im_pci.pci_eacr),
110                 le32_to_cpu (immap->im_pci.pci_edcr),
111                 le32_to_cpu (immap->im_pci.pci_eccr));
112 */
113 }
114 #endif
115
116 void
117 MachineCheckException(struct pt_regs *regs)
118 {
119         unsigned long fixup;
120
121         /* Probing PCI using config cycles cause this exception
122          * when a device is not present.  Catch it and return to
123          * the PCI exception handler.
124          */
125 #ifdef CONFIG_PCI
126 #if 0
127         volatile immap_t *immap  = (immap_t *)CONFIG_SYS_IMMR;
128 #ifdef DEBUG
129         dump_pci();
130 #endif
131         /* clear the error in the error status register */
132         if(immap->im_pci.pci_esr & cpu_to_le32(PCI_ERROR_PCI_NO_RSP)) {
133                 immap->im_pci.pci_esr = cpu_to_le32(PCI_ERROR_PCI_NO_RSP);
134                 return;
135         }
136 #endif
137 #endif /* CONFIG_PCI */
138         if ((fixup = search_exception_table(regs->nip)) != 0) {
139                 regs->nip = fixup;
140                 return;
141         }
142
143 #if defined(CONFIG_CMD_KGDB)
144         if (debugger_exception_handler && (*debugger_exception_handler)(regs))
145                 return;
146 #endif
147
148         puts ("Machine check in kernel mode.\n"
149                 "Caused by (from msr): ");
150         printf("regs %p ",regs);
151         switch( regs->msr & 0x000F0000) {
152         case (0x80000000>>12):
153                 puts ("Machine check signal - probably due to mm fault\n"
154                         "with mmu off\n");
155                 break;
156         case (0x80000000>>13):
157                 puts ("Transfer error ack signal\n");
158                 break;
159         case (0x80000000>>14):
160                 puts ("Data parity signal\n");
161                 break;
162         case (0x80000000>>15):
163                 puts ("Address parity signal\n");
164                 break;
165         default:
166                 puts ("Unknown values in msr\n");
167         }
168         show_regs(regs);
169         print_backtrace((unsigned long *)regs->gpr[1]);
170 #ifdef CONFIG_PCI
171         dump_pci();
172 #endif
173         panic("machine check");
174 }
175
176 void
177 AlignmentException(struct pt_regs *regs)
178 {
179 #if defined(CONFIG_CMD_KGDB)
180         if (debugger_exception_handler && (*debugger_exception_handler)(regs))
181                 return;
182 #endif
183         show_regs(regs);
184         print_backtrace((unsigned long *)regs->gpr[1]);
185         panic("Alignment Exception");
186 }
187
188 void
189 ProgramCheckException(struct pt_regs *regs)
190 {
191 #if defined(CONFIG_CMD_KGDB)
192         if (debugger_exception_handler && (*debugger_exception_handler)(regs))
193                 return;
194 #endif
195         show_regs(regs);
196         print_backtrace((unsigned long *)regs->gpr[1]);
197         panic("Program Check Exception");
198 }
199
200 void
201 SoftEmuException(struct pt_regs *regs)
202 {
203 #if defined(CONFIG_CMD_KGDB)
204         if (debugger_exception_handler && (*debugger_exception_handler)(regs))
205                 return;
206 #endif
207         show_regs(regs);
208         print_backtrace((unsigned long *)regs->gpr[1]);
209         panic("Software Emulation Exception");
210 }
211
212
213 void
214 UnknownException(struct pt_regs *regs)
215 {
216 #if defined(CONFIG_CMD_KGDB)
217         if (debugger_exception_handler && (*debugger_exception_handler)(regs))
218                 return;
219 #endif
220         printf("Bad trap at PC: %lx, SR: %lx, vector=%lx\n",
221                regs->nip, regs->msr, regs->trap);
222         _exception(0, regs);
223 }
224
225 #if defined(CONFIG_CMD_BEDBUG)
226 extern void do_bedbug_breakpoint(struct pt_regs *);
227 #endif
228
229 void
230 DebugException(struct pt_regs *regs)
231 {
232         printf("Debugger trap at @ %lx\n", regs->nip );
233         show_regs(regs);
234 #if defined(CONFIG_CMD_BEDBUG)
235         do_bedbug_breakpoint( regs );
236 #endif
237 }
238
239 /* Probe an address by reading.  If not present, return -1, otherwise
240  * return 0.
241  */
242 int
243 addr_probe(uint *addr)
244 {
245 #if 0
246         int     retval;
247
248         __asm__ __volatile__(                   \
249                 "1:     lwz %0,0(%1)\n"         \
250                 "       eieio\n"                \
251                 "       li %0,0\n"              \
252                 "2:\n"                          \
253                 ".section .fixup,\"ax\"\n"      \
254                 "3:     li %0,-1\n"             \
255                 "       b 2b\n"                 \
256                 ".section __ex_table,\"a\"\n"   \
257                 "       .align 2\n"             \
258                 "       .long 1b,3b\n"          \
259                 ".text"                         \
260                 : "=r" (retval) : "r"(addr));
261
262         return (retval);
263 #endif
264         return 0;
265 }