Initial commit
This commit is contained in:
52
wiipax/stub/exception.c
Normal file
52
wiipax/stub/exception.c
Normal file
@@ -0,0 +1,52 @@
|
||||
#include "common.h"
|
||||
#include "string.h"
|
||||
|
||||
extern char exception_asm_start, exception_asm_end;
|
||||
|
||||
void exception_handler(int exception)
|
||||
{
|
||||
u32 *x;
|
||||
u32 i;
|
||||
|
||||
printf("\nException %04x occurred!\n", exception);
|
||||
|
||||
x = (u32 *)0x80003500;
|
||||
|
||||
printf("\n R0..R7 R8..R15 R16..R23 R24..R31\n");
|
||||
for (i = 0; i < 8; i++) {
|
||||
printf("%08x %08x %08x %08x\n", x[0], x[8], x[16], x[24]);
|
||||
x++;
|
||||
}
|
||||
x += 24;
|
||||
|
||||
printf("\n CR/XER LR/CTR SRR0/SRR1 DAR/DSISR\n");
|
||||
for (i = 0; i < 2; i++) {
|
||||
printf("%08x %08x %08x %08x\n", x[0], x[2], x[4], x[6]);
|
||||
x++;
|
||||
}
|
||||
|
||||
// Hang.
|
||||
for (;;)
|
||||
;
|
||||
}
|
||||
|
||||
void exception_init(void)
|
||||
{
|
||||
u32 vector;
|
||||
u32 len_asm;
|
||||
|
||||
for (vector = 0x100; vector < 0x1800; vector += 0x10) {
|
||||
u32 *insn = (u32 *)(0x80000000 + vector);
|
||||
|
||||
insn[0] = 0xbc003500; // stmw 0,0x3500(0)
|
||||
insn[1] = 0x38600000 | vector; // li 3,vector
|
||||
insn[2] = 0x48003602; // ba 0x3600
|
||||
insn[3] = 0;
|
||||
}
|
||||
sync_before_exec((void *)0x80000100, 0x1f00);
|
||||
|
||||
len_asm = &exception_asm_end - &exception_asm_start;
|
||||
memcpy((void *)0x80003600, &exception_asm_start, len_asm);
|
||||
sync_before_exec((void *)0x80003600, len_asm);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user