mirror of
https://github.com/fail0verflow/mini.git
synced 2024-11-16 08:29:25 +01:00
88 lines
1.9 KiB
C
88 lines
1.9 KiB
C
#include "irq.h"
|
|
#include "hollywood.h"
|
|
#include "gecko.h"
|
|
#include "utils.h"
|
|
#include "ipc.h"
|
|
#include "memory.h"
|
|
|
|
const char *exceptions[] = {
|
|
"RESET", "UNDEFINED", "SWI", "INSTR ABORT", "DATA ABORT", "RESERVED", "IRQ", "FIQ"
|
|
};
|
|
|
|
const char *aborts[] = {
|
|
"UNDEFINED",
|
|
"Alignment",
|
|
"UNDEFINED",
|
|
"Alignment",
|
|
"UNDEFINED",
|
|
"Translation",
|
|
"UNDEFINED",
|
|
"Translation",
|
|
"External abort",
|
|
"Domain",
|
|
"External abort",
|
|
"Domain",
|
|
"External abort on translation (first level)",
|
|
"Permission",
|
|
"External abort on translation (second level)",
|
|
"Permission"
|
|
};
|
|
|
|
u8 domvalid[] = {0,0,0,0,0,0,0,1,0,1,0,1,0,1,1,1};
|
|
|
|
void exc_setup_stack(void);
|
|
|
|
void exception_initialize(void)
|
|
{
|
|
exc_setup_stack();
|
|
u32 cr = get_cr();
|
|
cr |= 0x2; // Data alignment fault checking enable
|
|
set_cr(cr);
|
|
}
|
|
|
|
void exc_handler(u32 type, u32 spsr, u32 *regs)
|
|
{
|
|
gecko_printf("\nException %d (%s):\n", type, exceptions[type]);
|
|
|
|
u32 pc;
|
|
|
|
switch(type) {
|
|
case 3:
|
|
case 7:
|
|
pc = regs[15] - 4;
|
|
break;
|
|
case 4:
|
|
pc = regs[15] - 8;
|
|
break;
|
|
default:
|
|
pc = regs[15];
|
|
break;
|
|
}
|
|
|
|
gecko_printf("Registers (%p):\n", regs);
|
|
gecko_printf(" R0-R3: %08x %08x %08x %08x\n", regs[0], regs[1], regs[2], regs[3]);
|
|
gecko_printf(" R4-R7: %08x %08x %08x %08x\n", regs[4], regs[5], regs[6], regs[7]);
|
|
gecko_printf(" R8-R11: %08x %08x %08x %08x\n", regs[8], regs[9], regs[10], regs[11]);
|
|
gecko_printf("R12-R15: %08x %08x %08x %08x\n", regs[12], regs[13], regs[14], pc);
|
|
|
|
gecko_printf("SPSR: %08x\n", spsr);
|
|
gecko_printf("CR: %08x\n", get_cr());
|
|
gecko_printf("TTBR: %08x\n", get_ttbr());
|
|
gecko_printf("DACR: %08x\n", get_dacr());
|
|
|
|
if(type == 3 || type == 4) {
|
|
u32 fsr;
|
|
if(type == 3)
|
|
fsr = get_ifsr();
|
|
else
|
|
fsr = get_dfsr();
|
|
gecko_printf("Abort type: %s\n", aborts[fsr&0xf]);
|
|
if(domvalid[fsr&0xf])
|
|
gecko_printf("Domain: %d\n", (fsr>>4)&0xf);
|
|
if(type == 4)
|
|
gecko_printf("Address: 0x%08x\n", get_far());
|
|
}
|
|
|
|
panic(0xA3);
|
|
}
|