The ARM11 exception handlers are now working.
Refactored the exception handling code in general.
This commit is contained in:
@@ -12,7 +12,6 @@
|
||||
|
||||
#define REG_DUMP_SIZE (4*18)
|
||||
#define CODE_DUMP_SIZE 48
|
||||
#define STACK_DUMP_SIZE 0x2000
|
||||
#define OTHER_DATA_SIZE 0
|
||||
|
||||
void __attribute__((noreturn)) mainHandler(u32 regs[18], u32 type, u32 cpuId, u32 fpexc)
|
||||
@@ -29,9 +28,7 @@ void __attribute__((noreturn)) mainHandler(u32 regs[18], u32 type, u32 cpuId, u3
|
||||
dump[4] = type; //Exception type
|
||||
dump[6] = REG_DUMP_SIZE; //Register dump size (r0-r12, sp, lr, pc, cpsr, fpexc)
|
||||
dump[7] = CODE_DUMP_SIZE; //Code dump size (10 ARM instructions, up to 20 Thumb instructions).
|
||||
dump[8] = STACK_DUMP_SIZE; //Stack dump size
|
||||
dump[9] = OTHER_DATA_SIZE; //Other data size
|
||||
dump[5] = 40 + REG_DUMP_SIZE + CODE_DUMP_SIZE + STACK_DUMP_SIZE + OTHER_DATA_SIZE; //Total size
|
||||
|
||||
//Dump registers
|
||||
//Current order of saved regs: cpsr, pc, r8-r12, sp, lr, r0-r7
|
||||
@@ -50,22 +47,24 @@ void __attribute__((noreturn)) mainHandler(u32 regs[18], u32 type, u32 cpuId, u3
|
||||
for(u32 i = 0; i < 8; i++)
|
||||
regdump[i] = regs[9 + i];
|
||||
|
||||
dump[8] = 0x1000 - (regdump[13] & 0xfff); //Stack dump size (max. 0x1000 bytes)
|
||||
dump[5] = 40 + REG_DUMP_SIZE + CODE_DUMP_SIZE + dump[8] + OTHER_DATA_SIZE; //Total size
|
||||
|
||||
//Dump code
|
||||
u16 *codedump = (u16 *)(regdump + dump[6] / 4);
|
||||
u16 *instr = (u16 *)pc - dump[7] / 2 + 1;
|
||||
vu16 *instr = (vu16 *)pc - dump[7] / 2 + 1;
|
||||
for(u32 i = 0; i < dump[7] / 2; i++)
|
||||
codedump[i] = instr[i];
|
||||
|
||||
//Dump stack in place
|
||||
vu32 *sp = (vu32 *)regdump[13];
|
||||
vu32 *stackdump = (vu32 *)((vu8 *)FINAL_BUFFER + 40 + REG_DUMP_SIZE + CODE_DUMP_SIZE);
|
||||
|
||||
for(u32 i = 0; i < dump[8] / 4; i++)
|
||||
stackdump[i] = sp[i];
|
||||
|
||||
for(u32 i = 0; i < (40 + REG_DUMP_SIZE + CODE_DUMP_SIZE) / 4; i++)
|
||||
final[i] = dump[i];
|
||||
|
||||
while(final[0] != 0xDEADC0DE);
|
||||
clearDCacheAndDMB();
|
||||
mcuReboot();
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user