mirror of
https://github.com/wiiu-env/MochaLite.git
synced 2024-10-31 18:15:08 +01:00
119 lines
4.1 KiB
C
119 lines
4.1 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2016
|
|
* by Dimok
|
|
*
|
|
* This software is provided 'as-is', without any express or implied
|
|
* warranty. In no event will the authors be held liable for any
|
|
* damages arising from the use of this software.
|
|
*
|
|
* Permission is granted to anyone to use this software for any
|
|
* purpose, including commercial applications, and to alter it and
|
|
* redistribute it freely, subject to the following restrictions:
|
|
*
|
|
* 1. The origin of this software must not be misrepresented; you
|
|
* must not claim that you wrote the original software. If you use
|
|
* this software in a product, an acknowledgment in the product
|
|
* documentation would be appreciated but is not required.
|
|
*
|
|
* 2. Altered source versions must be plainly marked as such, and
|
|
* must not be misrepresented as being the original software.
|
|
*
|
|
* 3. This notice may not be removed or altered from any source
|
|
* distribution.
|
|
***************************************************************************/
|
|
#include "types.h"
|
|
#include "../../common/kernel_commands.h"
|
|
#include "elf_patcher.h"
|
|
#include "ios_mcp_patches.h"
|
|
#include "kernel_patches.h"
|
|
#include "exception_handler.h"
|
|
#include "fsa.h"
|
|
#include "utils.h"
|
|
|
|
extern void __KERNEL_CODE_START(void);
|
|
extern void __KERNEL_CODE_END(void);
|
|
|
|
extern const patch_table_t kernel_patches_table[];
|
|
extern const patch_table_t kernel_patches_table_end[];
|
|
|
|
static const u32 mcpIoMappings_patch[] =
|
|
{
|
|
// vaddr paddr size ? ? ?
|
|
0x0D000000, 0x0D000000, 0x001C0000, 0x00000000, 0x00000003, 0x00000000, // mapping 1
|
|
0x0D800000, 0x0D800000, 0x001C0000, 0x00000000, 0x00000003, 0x00000000, // mapping 2
|
|
0x0C200000, 0x0C200000, 0x00100000, 0x00000000, 0x00000003, 0x00000000 // mapping 3
|
|
};
|
|
|
|
static const u32 KERNEL_MCP_IOMAPPINGS_STRUCT[] =
|
|
{
|
|
(u32)mcpIoMappings_patch, // ptr to iomapping structs
|
|
0x00000003, // number of iomappings
|
|
0x00000001 // pid (MCP)
|
|
};
|
|
|
|
static int kernel_syscall_0x81(u32 command, u32 arg1, u32 arg2, u32 arg3)
|
|
{
|
|
switch(command)
|
|
{
|
|
case KERNEL_READ32:
|
|
{
|
|
return *(volatile u32*)arg1;
|
|
}
|
|
case KERNEL_WRITE32:
|
|
{
|
|
*(volatile u32*)arg1 = arg2;
|
|
break;
|
|
}
|
|
case KERNEL_MEMCPY:
|
|
{
|
|
//set_domain_register(0xFFFFFFFF);
|
|
kernel_memcpy((void*)arg1, (void*) arg2, arg3);
|
|
break;
|
|
}
|
|
default:
|
|
return -1;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
void kernel_launch_ios(u32 launch_address, u32 L, u32 C, u32 H)
|
|
{
|
|
void (*kernel_launch_bootrom)(u32 launch_address, u32 L, u32 C, u32 H) = (void*)0x0812A050;
|
|
|
|
if(*(u32*)(launch_address - 0x300 + 0x1AC) == 0x00DFD000)
|
|
{
|
|
int level = disable_interrupts();
|
|
unsigned int control_register = disable_mmu();
|
|
|
|
u32 ios_elf_start = launch_address + 0x804 - 0x300;
|
|
|
|
//! try to keep the order of virt. addresses to reduce the memmove amount
|
|
mcp_run_patches(ios_elf_start);
|
|
kernel_run_patches(ios_elf_start);
|
|
|
|
restore_mmu(control_register);
|
|
enable_interrupts(level);
|
|
}
|
|
|
|
kernel_launch_bootrom(launch_address, L, C, H);
|
|
}
|
|
|
|
void kernel_run_patches(u32 ios_elf_start)
|
|
{
|
|
section_write(ios_elf_start, (u32)__KERNEL_CODE_START, __KERNEL_CODE_START, __KERNEL_CODE_END - __KERNEL_CODE_START);
|
|
//section_write_word(ios_elf_start, 0x0812A120, ARM_BL(0x0812A120, kernel_launch_ios));
|
|
|
|
section_write(ios_elf_start, 0x08140DE0, KERNEL_MCP_IOMAPPINGS_STRUCT, sizeof(KERNEL_MCP_IOMAPPINGS_STRUCT));
|
|
|
|
section_write_word(ios_elf_start, 0x0812A134, ARM_BL(0x0812A134, crash_handler_prefetch));
|
|
section_write_word(ios_elf_start, 0x0812A1AC, ARM_BL(0x0812A1AC, crash_handler_data));
|
|
section_write_word(ios_elf_start, 0x08129E50, ARM_BL(0x08129E50, crash_handler_undef_instr));
|
|
|
|
section_write_word(ios_elf_start, 0x0812CD2C, ARM_B(0x0812CD2C, kernel_syscall_0x81));
|
|
|
|
u32 patch_count = (u32)(((u8*)kernel_patches_table_end) - ((u8*)kernel_patches_table)) / sizeof(patch_table_t);
|
|
patch_table_entries(ios_elf_start, kernel_patches_table, patch_count);
|
|
}
|
|
|