mirror of
https://github.com/wiiu-env/WUMSLoader.git
synced 2024-06-02 16:48:48 +02:00
92 lines
2.4 KiB
C
92 lines
2.4 KiB
C
#include "kernel_utils.h"
|
|
#include "kernel_defs.h"
|
|
#include <coreinit/cache.h>
|
|
#include <coreinit/memorymap.h>
|
|
|
|
|
|
extern void SCKernelCopyData(uint32_t dst, uint32_t src, uint32_t len);
|
|
|
|
void KernelWrite(uint32_t addr, const void *data, uint32_t length) {
|
|
uint32_t dst = (uint32_t) OSEffectiveToPhysical(addr);
|
|
uint32_t src = (uint32_t) OSEffectiveToPhysical((uint32_t) data);
|
|
KernelCopyData(dst, src, length);
|
|
DCFlushRange((void *) addr, length);
|
|
ICInvalidateRange((void *) addr, length);
|
|
}
|
|
|
|
void KernelWriteU32(uint32_t addr, uint32_t value) {
|
|
uint32_t dst = (uint32_t) OSEffectiveToPhysical(addr);
|
|
uint32_t src = (uint32_t) OSEffectiveToPhysical((uint32_t) &value);
|
|
KernelCopyData(dst, src, 4);
|
|
DCFlushRange((void *) addr, 4);
|
|
ICInvalidateRange((void *) addr, 4);
|
|
}
|
|
|
|
/* Write a 32-bit word with kernel permissions */
|
|
void __attribute__ ((noinline)) kern_write(void *addr, uint32_t value) {
|
|
asm volatile (
|
|
"li 3,1\n"
|
|
"li 4,0\n"
|
|
"mr 5,%1\n"
|
|
"li 6,0\n"
|
|
"li 7,0\n"
|
|
"lis 8,1\n"
|
|
"mr 9,%0\n"
|
|
"mr %1,1\n"
|
|
"li 0,0x3500\n"
|
|
"sc\n"
|
|
"nop\n"
|
|
"mr 1,%1\n"
|
|
:
|
|
: "r"(addr), "r"(value)
|
|
: "memory", "ctr", "lr", "0", "3", "4", "5", "6", "7", "8", "9", "10",
|
|
"11", "12"
|
|
);
|
|
}
|
|
|
|
/* Read a 32-bit word with kernel permissions */
|
|
uint32_t __attribute__ ((noinline)) kern_read(const void *addr) {
|
|
uint32_t result;
|
|
asm volatile (
|
|
"li 3,1\n"
|
|
"li 4,0\n"
|
|
"li 5,0\n"
|
|
"li 6,0\n"
|
|
"li 7,0\n"
|
|
"lis 8,1\n"
|
|
"mr 9,%1\n"
|
|
"li 0,0x3400\n"
|
|
"mr %0,1\n"
|
|
"sc\n"
|
|
"nop\n"
|
|
"mr 1,%0\n"
|
|
"mr %0,3\n"
|
|
: "=r"(result)
|
|
: "b"(addr)
|
|
: "memory", "ctr", "lr", "0", "3", "4", "5", "6", "7", "8", "9", "10",
|
|
"11", "12"
|
|
);
|
|
|
|
return result;
|
|
}
|
|
|
|
void PatchSyscall(int index, uint32_t addr) {
|
|
//DEBUG_FUNCTION_LINE("Patching Syscall 0x%02X\n",index);
|
|
kern_write((void *) (KERN_SYSCALL_TBL1 + index * 4), addr);
|
|
kern_write((void *) (KERN_SYSCALL_TBL2 + index * 4), addr);
|
|
kern_write((void *) (KERN_SYSCALL_TBL3 + index * 4), addr);
|
|
kern_write((void *) (KERN_SYSCALL_TBL4 + index * 4), addr);
|
|
kern_write((void *) (KERN_SYSCALL_TBL5 + index * 4), addr);
|
|
}
|
|
|
|
void kernelInitialize() {
|
|
static uint8_t ucSyscallsSetupRequired = 1;
|
|
if (!ucSyscallsSetupRequired) {
|
|
return;
|
|
}
|
|
|
|
ucSyscallsSetupRequired = 0;
|
|
|
|
PatchSyscall(0x25, (uint32_t) SCKernelCopyData);
|
|
}
|