mirror of https://github.com/PCSX2/pcsx2.git
171 lines
4.5 KiB
C
171 lines
4.5 KiB
C
/*********************************************************************
|
|
* Copyright (C) 2003 Tord Lindstrom (pukko@home.se)
|
|
* Copyright (C) 2004 adresd (adresd_ps2dev@yahoo.com)
|
|
* This file is subject to the terms and conditions of the PS2Link License.
|
|
* See the file LICENSE in the main directory of this distribution for more
|
|
* details.
|
|
*/
|
|
|
|
#include "stdio.h"
|
|
#include <tamtypes.h>
|
|
#include <kernel.h>
|
|
#include "excepHandler.h"
|
|
#include "debug.h"
|
|
|
|
extern int _gp;
|
|
int userThreadID;
|
|
int excepscrdump;
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
typedef union
|
|
{
|
|
unsigned int uint128 __attribute__(( mode(TI) ));
|
|
unsigned long uint64[2];
|
|
} eeReg __attribute((packed));
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
// Prototypes
|
|
void pkoDebug(int cause, int badvaddr, int status, int epc, eeReg *regs);
|
|
|
|
extern void pkoExceptionHandler(void);
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
static const unsigned char regName[32][5] =
|
|
{
|
|
"zero", "at", "v0", "v1", "a0", "a1", "a2", "a3",
|
|
"t0", "t1", "t2", "t3", "t4", "t5", "t6", "t7",
|
|
"t8", "t9", "s0", "s1", "s2", "s3", "s4", "s5",
|
|
"s6", "s7", "k0", "k1", "gp", "sp", "fp", "ra"
|
|
};
|
|
|
|
static char codeTxt[14][24] =
|
|
{
|
|
"Interrupt", "TLB modification", "TLB load/inst fetch", "TLB store",
|
|
"Address load/inst fetch", "Address store", "Bus error (instr)",
|
|
"Bus error (data)", "Syscall", "Breakpoint", "Reserved instruction",
|
|
"Coprocessor unusable", "Arithmetic overflow", "Trap"
|
|
};
|
|
|
|
char _exceptionStack[8*1024] __attribute__((aligned(16)));
|
|
eeReg _savedRegs[32+4] __attribute__((aligned(16)));
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
// The 'ee exception handler', only dumps registers to console or screen atm
|
|
void
|
|
pkoDebug(int cause, int badvaddr, int status, int epc, eeReg *regs)
|
|
{
|
|
int i;
|
|
int code;
|
|
// extern void printf(char *, ...);
|
|
static void (* excpPrintf)(const char *, ...);
|
|
|
|
FlushCache(0);
|
|
FlushCache(2);
|
|
|
|
#if 1
|
|
if (userThreadID) {
|
|
TerminateThread(userThreadID);
|
|
DeleteThread(userThreadID);
|
|
}
|
|
#endif
|
|
|
|
code = cause & 0x7c;
|
|
|
|
if (excepscrdump)
|
|
{
|
|
init_scr();
|
|
excpPrintf = scr_printf;
|
|
}
|
|
else excpPrintf = (void*)printf;
|
|
|
|
excpPrintf("\n\n EE Exception handler: %s exception\n\n",
|
|
codeTxt[code>>2]);
|
|
|
|
excpPrintf(" Cause %08X BadVAddr %08X Status %08X EPC %08X\n\n",
|
|
cause, badvaddr, status, epc);
|
|
|
|
for(i = 0; i < 32/2; i++) {
|
|
excpPrintf("%4s: %016lX%016lX %4s: %016lX%016lX\n",
|
|
regName[i], regs[i].uint64[1], regs[i].uint64[0],
|
|
regName[i+16], regs[i+16].uint64[1], regs[i+16].uint64[0]);
|
|
}
|
|
excpPrintf("\n");
|
|
SleepThread();
|
|
}
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
// The 'iop exception handler', only dumps registers to console or screen atm
|
|
|
|
void iopException(int cause, int badvaddr, int status, int epc, u32 *regs, int repc, char* name)
|
|
{
|
|
int i;
|
|
int code;
|
|
// extern void printf(char *, ...);
|
|
static void (* excpPrintf)(const char *, ...);
|
|
|
|
FlushCache(0);
|
|
FlushCache(2);
|
|
|
|
#if 1
|
|
if (userThreadID) {
|
|
TerminateThread(userThreadID);
|
|
DeleteThread(userThreadID);
|
|
}
|
|
#endif
|
|
|
|
code = cause & 0x7c;
|
|
|
|
if(excepscrdump)
|
|
{
|
|
init_scr();
|
|
excpPrintf = scr_printf;
|
|
}
|
|
else excpPrintf = (void*)printf;
|
|
|
|
excpPrintf("\n\n IOP Exception handler: %s exception\n\n",
|
|
codeTxt[code>>2]);
|
|
|
|
excpPrintf(" Module Name \"%s\" Relative EPC %08X\n\n",
|
|
name, repc);
|
|
|
|
|
|
excpPrintf(" Cause %08X BadVAddr %08X Status %08X EPC %08X\n\n",
|
|
cause, badvaddr, status, epc);
|
|
|
|
for(i = 0; i < 32/4; i++)
|
|
{
|
|
excpPrintf(" %4s: %08X %4s: %08X %4s: %08X %4s: %08X\n",
|
|
regName[i], regs[i], regName[i+8], regs[i+8],
|
|
regName[i+16], regs[i+16], regName[i+24], regs[i+24]);
|
|
}
|
|
|
|
excpPrintf("\n");
|
|
|
|
|
|
|
|
SleepThread();
|
|
}
|
|
|
|
|
|
////////////////////////////////////////////////////////////////////////
|
|
// Installs ee exception handlers for the 'usual' exceptions and iop
|
|
// exception callback
|
|
void
|
|
installExceptionHandlers(void)
|
|
{
|
|
int i;
|
|
|
|
// Skip exception #8 (syscall) & 9 (breakpoint)
|
|
for (i = 1; i < 4; i++) {
|
|
SetVTLBRefillHandler(i, pkoExceptionHandler);
|
|
}
|
|
for (i = 4; i < 8; i++) {
|
|
SetVCommonHandler(i, pkoExceptionHandler);
|
|
}
|
|
for (i = 10; i < 14; i++) {
|
|
SetVCommonHandler(i, pkoExceptionHandler);
|
|
}
|
|
|
|
}
|
|
|