ioplib.c

 
/*
# _____     ___ ____     ___ ____
#  ____|   |    ____|   |        | |____|
# |     ___|   |____ ___|    ____| |    \    PS2DEV Open Source Project.
#-----------------------------------------------------------------------
# Copyright 2001-2009, ps2dev - http://www.ps2dev.org
# Licenced under Academic Free License version 2.0
# Review ps2sdk README & LICENSE files for further details.
#
# taken from MX4SIO driver for simplicity.
# all credits go to maximus32
*/
#include "ioplib.h"
#include <intrman.h>
 
iop_library_t *ioplib_getByName(const char *name)
{
    iop_library_t *libptr;
    int i;
 
    // Get first loaded library
    libptr = GetLoadcoreInternalData()->let_next;
    // Loop through all loaded libraries
    while (libptr != NULL) {
        // Compare library name only
        for (i = 0; i < 8; i++) {
            if (libptr->name[i] != name[i])
                break;
        }
 
        // Return if match
        if (i == 8)
            return libptr;
 
        // Next library
        libptr = libptr->prev;
    }
 
    return NULL;
}
 
unsigned int ioplib_getTableSize(iop_library_t *lib)
{
    void **exp;
    unsigned int size;
 
    exp = NULL;
    if (lib != NULL) {
        exp = lib->exports;
    }
    size = 0;
 
    if (exp != NULL)
        while (*exp++ != NULL)
            size++;
 
    return size;
}
 
void *ioplib_hookExportEntry(iop_library_t *lib, unsigned int entry, void *func)
{
    if (entry < ioplib_getTableSize(lib)) {
        int oldstate;
        void **exp, *temp;
 
        exp = &lib->exports[entry];
 
        CpuSuspendIntr(&oldstate);
        temp = *exp;
        *exp = func;
        func = temp;
        CpuResumeIntr(oldstate);
 
        return func;
    }
 
    return NULL;
}
 
void ioplib_relinkExports(iop_library_t *lib)
{
    struct irx_import_table *table;
    struct irx_import_stub *stub;
 
    // go through each table that imports the library
    for (table = lib->caller; table != NULL; table = table->next) {
        // go through each import in the table
        for (stub = (struct irx_import_stub *)table->stubs; stub->jump != 0; stub++) {
            // patch the stub to jump to the address specified in the library export table for "fno"
            stub->jump = 0x08000000 | (((u32)lib->exports[stub->fno] << 4) >> 6);
        }
    }
}