diff options
Diffstat (limited to 'src/sys/sys_fault.c')
| -rw-r--r-- | src/sys/sys_fault.c | 335 |
1 files changed, 335 insertions, 0 deletions
diff --git a/src/sys/sys_fault.c b/src/sys/sys_fault.c new file mode 100644 index 00000000..14a322e2 --- /dev/null +++ b/src/sys/sys_fault.c @@ -0,0 +1,335 @@ +#include "sys.h" +#include "PR/os_internal.h" + +FaultMgr gFaultMgr; + +u8 sFaultCharIndex[0x80] = { + 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x29, 0xFF, 0xFF, 0xFF, 0x2B, + 0xFF, 0xFF, 0x25, 0x26, 0xFF, 0x2A, 0xFF, 0x27, 0x2C, 0xFF, 0x00, 0x01, 0x02, 0x03, 0x04, 0x05, 0x06, 0x07, 0x08, + 0x09, 0x24, 0xFF, 0xFF, 0xFF, 0xFF, 0x28, 0xFF, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 0x10, 0x11, 0x12, 0x13, 0x14, + 0x15, 0x16, 0x17, 0x18, 0x19, 0x1A, 0x1B, 0x1C, 0x1D, 0x1E, 0x1F, 0x20, 0x21, 0x22, 0x23, 0xFF, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0x0A, 0x0B, 0x0C, 0x0D, 0x0E, 0x0F, 0x10, 0x11, 0x12, 0x13, 0x14, 0x15, 0x16, 0x17, 0x18, 0x19, 0x1A, + 0x1B, 0x1C, 0x1D, 0x1E, 0x1F, 0x20, 0x21, 0x22, 0x23, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, +}; + +s32 sFaultCharPixelFlags[0x40] = { + 0x70871C30, 0x8988A250, 0x88808290, 0x88831C90, 0x888402F8, 0x88882210, 0x71CF9C10, 0xF9CF9C70, + 0x8228A288, 0xF200A288, 0x0BC11C78, 0x0A222208, 0x8A222288, 0x71C21C70, 0x23C738F8, 0x5228A480, + 0x8A282280, 0x8BC822F0, 0xFA282280, 0x8A28A480, 0x8BC738F8, 0xF9C89C08, 0x82288808, 0x82088808, + 0xF2EF8808, 0x82288888, 0x82288888, 0x81C89C70, 0x8A08A270, 0x920DA288, 0xA20AB288, 0xC20AAA88, + 0xA208A688, 0x9208A288, 0x8BE8A270, 0xF1CF1CF8, 0x8A28A220, 0x8A28A020, 0xF22F1C20, 0x82AA0220, + 0x82492220, 0x81A89C20, 0x8A28A288, 0x8A28A288, 0x8A289488, 0x8A2A8850, 0x894A9420, 0x894AA220, + 0x70852220, 0xF8011000, 0x08020800, 0x10840400, 0x20040470, 0x40840400, 0x80020800, 0xF8011000, + 0x70800000, 0x88822200, 0x08820400, 0x108F8800, 0x20821000, 0x00022200, 0x20800020, 0x00000000, +}; + +const char* sFaultCauses[18] = { + "Interrupt", + "TLB modification", + "TLB exception on load", + "TLB exception on store", + "Address error on load", + "Address error on store", + "Bus error on inst.", + "Bus error on data", + "System call exception", + "Breakpoint exception", + "Reserved instruction", + "Coprocessor unusable", + "Arithmetic overflow", + "Trap exception", + "Virtual coherency on inst.", + "Floating point exception", + "Watchpoint exception", + "Virtual coherency on data", +}; + +const char* sFloatExceptions[6] = { + "Unimplemented operation", "Invalid operation", "Division by zero", "Overflow", "Underflow", "Inexact operation", +}; + +void func_800073C0(s32 arg0, s32 arg1, s32 arg2, s32 arg3) { + u16* var_v0; + s32 i; + s32 j; + + var_v0 = gFaultMgr.width * arg1 + gFaultMgr.fb->data + arg0; + for (i = 0; i < arg3; i++) { + for (j = 0; j < arg2; j++, var_v0++) { + *var_v0 = ((*var_v0 & 0xE738) >> 2) | 1; + } + var_v0 += gFaultMgr.width - arg2; + } +} + +void func_800074AC(s32 arg0, s32 arg1, s32 arg2) { + s32* var_v0; + u16* var_v1; + s32 i; + s32 j; + + var_v0 = &sFaultCharPixelFlags[(arg2 / 5) * 7]; + var_v1 = gFaultMgr.width * arg1 + gFaultMgr.fb->data + arg0; + + for (i = 0; i < 7; i++) { + u32 temp_t1 = 0x80000000 >> ((arg2 % 5) * 6); + u32 temp_a3 = *var_v0++; + + for (j = 0; j < 6; j++) { + if (temp_t1 & temp_a3) { + *var_v1 = -1; + } else { + *var_v1 = 1; + } + var_v1++; + temp_t1 >>= 1; + } + var_v1 += gFaultMgr.width - 6; + } +} + +void* func_80007604(void* arg0, const char* arg1, size_t arg2) { + return (char*) memcpy(arg0, arg1, arg2) + arg2; +} + +void func_8000762C(s32 arg0, s32 arg1, const char* fmt, ...) { + u8* var_s0; + s32 i; + u8 sp40[0x100]; + s32 temp_a2; + va_list args; + va_start(args, fmt); + + for (i = 0; i < 0x100; i++) { + sp40[i] = 0; + } + + if (_Printf((outfun*) func_80007604, sp40, fmt, args) <= 0) { + return; + } + for (var_s0 = sp40; *var_s0 != 0; var_s0++) { + temp_a2 = sFaultCharIndex[*var_s0 & 0x7F]; + + if (temp_a2 != 0xFF) { + func_800074AC(arg0, arg1, temp_a2); + } + arg0 += 6; + label:; // fake, probably + } + va_end(args); +} + +void func_8000770C(s32 time) { + u64 time64 = MSEC_TO_CYCLES(time); + + osSetTime(0); + while (osGetTime() < time64) { + ; + } +} + +void func_800077F8(s32 arg0, s32 arg1, s32 arg2, f32* arg3) { + u32 temp_v0 = *(u32*) arg3; + s32 temp_v1 = ((temp_v0 & 0x7F800000) >> 0x17) - 0x7F; + + if (((-0x7F < temp_v1) && (temp_v1 < 0x80)) || (temp_v0 == 0)) { + func_8000762C(arg0, arg1, "F%02d:%.3e", arg2, *arg3); + } else { + func_8000762C(arg0, arg1, "F%02d:---------", arg2); + } +} + +void func_80007880(u32 arg0) { + s32 var_v0; + u32 var_v1 = 0x20000; + + func_8000762C(0x1E, 0xA0, "FPCSR:%08XH", arg0); + for (var_v0 = 0; var_v0 < 6; var_v0++, var_v1 >>= 1) { + if (arg0 & var_v1) { + func_8000762C(0x84, 0xA0, "(%s)", sFloatExceptions[var_v0]); + return; + } + } +} + +#define CAUSE_INDEX(cause) ((cause >> CAUSE_EXCSHIFT) & (CAUSE_EXCMASK >> CAUSE_EXCSHIFT)) + +void func_80007910(OSThread* thread) { + __OSThreadContext* context = &thread->context; + s16 var_s0 = CAUSE_INDEX(context->cause); + + if (var_s0 == CAUSE_INDEX(EXC_WATCH)) { + var_s0 = 16; + } + if (var_s0 == CAUSE_INDEX(EXC_VCED)) { + var_s0 = 17; + } + func_8000770C(3000); + func_800073C0(15, 15, 290, 210); + func_8000762C(30, 40, "THREAD:%d (%s)", thread->id, sFaultCauses[var_s0]); + func_8000762C(30, 50, "PC:%08XH SR:%08XH\tVA:%08XH", context->pc, context->sr, context->badvaddr); + osWritebackDCacheAll(); + func_8000762C(30, 60, "AT:%08XH V0:%08XH\tV1:%08XH", (s32) context->at, (s32) context->v0, (s32) context->v1); + func_8000762C(30, 70, "A0:%08XH A1:%08XH\tA2:%08XH", (s32) context->a0, (s32) context->a1, (s32) context->a2); + func_8000762C(30, 80, "A3:%08XH T0:%08XH\tT1:%08XH", (s32) context->a3, (s32) context->t0, (s32) context->t1); + func_8000762C(30, 90, "T2:%08XH T3:%08XH\tT4:%08XH", (s32) context->t2, (s32) context->t3, (s32) context->t4); + func_8000762C(30, 100, "T5:%08XH T6:%08XH\tT7:%08XH", (s32) context->t5, (s32) context->t6, (s32) context->t7); + func_8000762C(30, 110, "S0:%08XH S1:%08XH\tS2:%08XH", (s32) context->s0, (s32) context->s1, (s32) context->s2); + func_8000762C(30, 120, "S3:%08XH S4:%08XH\tS5:%08XH", (s32) context->s3, (s32) context->s4, (s32) context->s5); + func_8000762C(30, 130, "S6:%08XH S7:%08XH\tT8:%08XH", (s32) context->s6, (s32) context->s7, (s32) context->t8); + func_8000762C(30, 140, "T9:%08XH GP:%08XH\tSP:%08XH", (s32) context->t9, (s32) context->gp, (s32) context->sp); + func_8000762C(30, 150, "S8:%08XH RA:%08XH", (s32) context->s8, (s32) context->ra); + func_80007880(context->fpcsr); + osWritebackDCacheAll(); + func_800077F8(30, 170, 0, &context->fp0.f.f_even); + func_800077F8(120, 170, 2, &context->fp2.f.f_even); + func_800077F8(210, 170, 4, &context->fp4.f.f_even); + func_800077F8(30, 180, 6, &context->fp6.f.f_even); + func_800077F8(120, 180, 8, &context->fp8.f.f_even); + func_800077F8(210, 180, 10, &context->fp10.f.f_even); + func_800077F8(30, 190, 12, &context->fp12.f.f_even); + func_800077F8(120, 190, 14, &context->fp14.f.f_even); + func_800077F8(210, 190, 16, &context->fp16.f.f_even); + func_800077F8(30, 200, 18, &context->fp18.f.f_even); + func_800077F8(120, 200, 20, &context->fp20.f.f_even); + func_800077F8(210, 200, 22, &context->fp22.f.f_even); + func_800077F8(30, 210, 24, &context->fp24.f.f_even); + func_800077F8(120, 210, 26, &context->fp26.f.f_even); + func_800077F8(210, 210, 28, &context->fp28.f.f_even); + func_800077F8(30, 220, 30, &context->fp30.f.f_even); + osWritebackDCacheAll(); + osViBlack(0); + osViRepeatLine(0); + osViSwapBuffer(gFaultMgr.fb); +} + +OSThread* func_80007CEC(void) { + OSThread* var_v1; + + var_v1 = __osGetActiveQueue(); + + while (var_v1->priority != -1) { + if ((var_v1->priority > 0) && (var_v1->priority < 0x7F) && (var_v1->flags & 3)) { + return var_v1; + } + var_v1 = var_v1->tlnext; + } + return NULL; +} + +void Fault_ThreadEntry(void* arg0) { + OSMesg sp44; + OSThread* sp40; + s32 var_s2; + s32 var_s5; + u32 var_s0; + + sp44 = NULL; + var_s5 = 0; + var_s0 = 0; + var_s2 = 0; + + osSetEventMesg(OS_EVENT_CPU_BREAK, &gFaultMgr.msgQueue, (OSMesg) FAULT_MESG_BREAK); + osSetEventMesg(OS_EVENT_FAULT, &gFaultMgr.msgQueue, (OSMesg) FAULT_MESG_FAULT); + + sp40 = NULL; + while (sp40 == NULL) { + osRecvMesg(&gFaultMgr.msgQueue, &sp44, OS_MESG_BLOCK); + sp40 = func_80007CEC(); + } + + func_8000762C(300, 10, "-"); + gControllerPlugged[0] = 1; + while (var_s5 == 0) { + osSendMesg(&gSerialThreadMsgQueue, (OSMesg) SI_READ_CONTROLLER, OS_MESG_PRI_NORMAL); + osRecvMesg(&gControllerMsgQueue, NULL, OS_MESG_BLOCK); + Controller_UpdateInput(); + switch (var_s0) { + case 0: + if (gControllerHold[0].button == (R_TRIG | D_CBUTTONS | L_CBUTTONS)) { + var_s0++; + var_s2 = 4000; + } + break; + case 1: + case 2: + case 7: + if (gControllerHold[0].button & R_TRIG) { + if (gControllerPress[0].button == A_BUTTON) { + var_s0++; + var_s2 = 3000; + } else if (gControllerPress[0].button != 0) { + var_s0 = 0; + } + } + break; + case 3: + case 4: + case 8: + if (gControllerHold[0].button & R_TRIG) { + if (gControllerPress[0].button == B_BUTTON) { + var_s0++; + var_s2 = 3000; + } else if (gControllerPress[0].button != 0) { + var_s0 = 0; + } + } + break; + case 5: + case 6: + case 9: + case 10: + case 11: + case 12: + case 13: + if (gControllerHold[0].button & R_TRIG) { + if (gControllerPress[0].button == L_CBUTTONS) { + var_s0++; + var_s2 = 3000; + } else if (gControllerPress[0].button != 0) { + var_s0 = 0; + } + } + break; + case 14: + if (gControllerHold[0].button & R_TRIG) { + if (gControllerPress[0].button == START_BUTTON) { + var_s0++; + var_s2 = 3000; + } else if (gControllerPress[0].button != 0) { + var_s0 = 0; + } + } + break; + case 15: + var_s5 = 1; + break; + } + if (var_s2 != 0) { + var_s2 -= 1; + } else { + var_s0 = 0; + } + } + func_80007910(sp40); + while (1) { + ; + } +} + +void func_80007FE4(FrameBuffer* arg0, u16 arg1, u16 arg2) { + gFaultMgr.fb = arg0; + gFaultMgr.width = arg1; + gFaultMgr.height = arg2; +} + +void Fault_Init(void) { + gFaultMgr.fb = (FrameBuffer*) (PHYS_TO_K0(osMemSize) - sizeof(FrameBuffer)); + gFaultMgr.width = SCREEN_WIDTH; + gFaultMgr.height = SCREEN_HEIGHT; + osCreateMesgQueue(&gFaultMgr.msgQueue, &gFaultMgr.msg, 1); + osCreateThread(&gFaultMgr.thread, THREAD_ID_FAULT, Fault_ThreadEntry, 0, gFaultMgr.stack + sizeof(gFaultMgr.stack), + 127); + osStartThread(&gFaultMgr.thread); +} |