123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172 |
- /*
- * (C) Copyright 2011, Stefan Kristiansson <stefan.kristiansson@saunalahti.fi>
- * (C) Copyright 2011, Julius Baxter <julius@opencores.org>
- *
- * SPDX-License-Identifier: GPL-2.0+
- */
- #include <common.h>
- #include <stdio_dev.h>
- #include <asm/system.h>
- static const char * const excp_table[] = {
- "Unknown exception",
- "Reset",
- "Bus Error",
- "Data Page Fault",
- "Instruction Page Fault",
- "Tick Timer",
- "Alignment",
- "Illegal Instruction",
- "External Interrupt",
- "D-TLB Miss",
- "I-TLB Miss",
- "Range",
- "System Call",
- "Floating Point",
- "Trap",
- };
- static void (*handlers[32])(void);
- void exception_install_handler(int exception, void (*handler)(void))
- {
- if (exception < 0 || exception > 31)
- return;
- handlers[exception] = handler;
- }
- void exception_free_handler(int exception)
- {
- if (exception < 0 || exception > 31)
- return;
- handlers[exception] = 0;
- }
- static void exception_hang(int vect)
- {
- printf("Unhandled exception at 0x%x ", vect & 0xff00);
- vect = ((vect >> 8) & 0xff);
- if (vect < ARRAY_SIZE(excp_table))
- printf("(%s)\n", excp_table[vect]);
- else
- printf("(%s)\n", excp_table[0]);
- printf("EPCR: 0x%08lx\n", mfspr(SPR_EPCR_BASE));
- printf("EEAR: 0x%08lx\n", mfspr(SPR_EEAR_BASE));
- printf("ESR: 0x%08lx\n", mfspr(SPR_ESR_BASE));
- hang();
- }
- void exception_handler(int vect)
- {
- int exception = vect >> 8;
- if (handlers[exception])
- handlers[exception]();
- else
- exception_hang(vect);
- }
|