getkernel.c

Go to the documentation of this file.

/*
# _____     ___ ____     ___ ____
#  ____|   |    ____|   |        | |____|
# |     ___|   |____ ___|    ____| |    \    PS2DEV Open Source Project.
#-----------------------------------------------------------------------
# Licenced under Academic Free License version 2.0
# Review ps2sdk README & LICENSE files for further details.
*/
 
#include <kernel.h>
 
#ifdef F_GetSyscallHandler
static u32* g_pSyscallTable = NULL;
 
static void InitSyscallTable(void)
{
    u32 oldintr, oldop;
    u32 *pAddr;
 
    oldintr = DIntr();
    oldop = ee_set_opmode(0);
    pAddr = (u32 *) 0x800002f0;
    g_pSyscallTable = (u32 *) ((pAddr[0] << 16) | (pAddr[2] & 0xFFFF));
    ee_set_opmode(oldop);
    if(oldintr) { EIntr(); }
}
 
void *GetSyscallHandler(int syscall_no)
{
    u32 oldintr, oldop;
    u32 addr = 0;
 
    if(g_pSyscallTable == NULL)
    {
        InitSyscallTable();
    }
 
    if(g_pSyscallTable != NULL)
    {
        oldintr = DIntr();
        oldop = ee_set_opmode(0);
        addr = g_pSyscallTable[syscall_no];
        ee_set_opmode(oldop);
        if(oldintr) { EIntr(); }
    }
 
    return (void *) addr;
}
#endif
 
#ifdef F_GetSyscall
void *GetSyscall(int syscall_no) { return(GetSyscallHandler(syscall_no)); }
#endif
 
#ifdef F_GetExceptionHandler
 
extern void *GetSyscallHandler(int syscall_no);
 
void *GetExceptionHandler(int ex_cause_no)
{
    u32 oldintr, oldop;
    u32 addr, table_addr;
    u16 lo16, hi16;
 
    if((ex_cause_no < 1) || (ex_cause_no > 15))
    {
        return(NULL);
    }
 
    // get address of the syscall "SetVTLBRefillHandler"
    addr = (u32)GetSyscallHandler(13);
 
    // suspend interrupts and enter "kernel" operating mode.
    oldintr = DIntr();
    oldop = ee_set_opmode(0);
 
    // harvest the address of the exception handler table.
    lo16 = ((vu32 *) addr)[0x20 / 4];
    hi16 = ((vu32 *) addr)[0x14 / 4];
    table_addr = ((u32) (hi16 << 16) | lo16);
 
    addr = ((u32 *) table_addr)[ex_cause_no];
 
    // return to the old operating mode and resume interrupts.
    ee_set_opmode(oldop);
    if(oldintr) { EIntr(); }
 
    return((void *) addr);
}
#endif
 
#ifdef F_GetInterruptHandler
 
extern void *GetSyscallHandler(int syscall_no);
 
void *GetInterruptHandler(int intr_cause_no)
{
    u32 oldintr, oldop;
    u32 addr;
    u16 lo16, hi16;
 
    // make sure intr_cause_no is between 0 and 7
    if((intr_cause_no < 0) || (intr_cause_no > 7))
    {
        return(NULL);
    }
 
    // get address of the syscall "SetVInterruptHandler"
    addr = (u32) GetSyscallHandler(15);
 
    // suspend interrupts and enter "kernel" operating mode.
    oldintr = DIntr();
    oldop = ee_set_opmode(0);
 
    // harvest the address of the corresponding exception handler table.
    hi16 = ((vu32 *) addr)[0x10 / 4];
    lo16 = ((vu32 *) addr)[0x1C / 4];
 
    addr = ((u32 *) ((u32) (hi16 << 16) | lo16))[intr_cause_no];
 
    // return to the old operating mode and resume interrupts.
    ee_set_opmode(oldop);
    if(oldintr) { EIntr(); }
 
    return (void *) addr;
}
#endif