brain-hackers_pepepper-mirror/brainlilo
1
0
Fork 0
mirror of https://github.com/brain-hackers/brainlilo synced 2024-12-22 12:10:05 +09:00
Code Issues Projects Releases Wiki Activity

modified: BrainLILODrv.cpp

Browse Source
This commit is contained in:
Chiharu Shirasaka 2020-10-06 15:07:41 +09:00
parent 5efeb09b0f
commit 8a8fe81433
1 changed files with 43 additions and 44 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

71
BrainLILODrv.cpp
View File

@ -68,7 +68,8 @@ static FileSystemPowerFunctionProc FileSystemPowerFunction;
typedef LPVOID (*AllocPhysMemProc)(DWORD,DWORD,DWORD,DWORD,PULONG); typedef LPVOID (*AllocPhysMemProc)(DWORD,DWORD,DWORD,DWORD,PULONG);
typedef void (*NKForceCleanBootProc)(BOOL); DWORD wReadSize;
unsigned long bootloaderphysaddr;
static void disableInterrupts(){ static void disableInterrupts(){
asm volatile("mrs r0, cpsr\n" asm volatile("mrs r0, cpsr\n"
@ -111,7 +112,7 @@ static void EDNA2_physicalInvoker(){
static void EDNA2_installPhysicalInvoker(){ static void EDNA2_installPhysicalInvoker(){
void *ptr=(void *)0xa8000000; void *ptr=(void *)0xa8000000;
wchar_t buf[256]; wchar_t buf[256];
swprintf(buf, L"ResetKit: copying to 0x%08x from 0x%08x\n", swprintf(buf, L"BrainLILO: copying PhysicalInvoker to 0x%08x from 0x%08x\n",
(int)(ptr), (int)(&EDNA2_physicalInvoker)); (int)(ptr), (int)(&EDNA2_physicalInvoker));
OutputDebugString(buf); OutputDebugString(buf);
memcpy(ptr, (const void *)&EDNA2_physicalInvoker, 64*4); memcpy(ptr, (const void *)&EDNA2_physicalInvoker, 64*4);
@ -120,14 +121,16 @@ static void EDNA2_installPhysicalInvoker(){
__attribute__((noreturn)) __attribute__((noreturn))
static void EDNA2_runPhysicalInvoker(unsigned long bootloaderphysaddr,DWORD size){ static void EDNA2_runPhysicalInvoker(){
// r0=info // r0=info
asm volatile("msr cpsr_c, #211\n" // to supervisor mode asm volatile("msr cpsr_c, #211\n" // to supervisor mode
"mrc p15,0,r0,c1,c0,0\n" // read ctrl regs "mrc p15,0,r0,c1,c0,0\n" // read ctrl regs
"bic r0, r0, #8192\n" // reset vector to lower "bic r0, r0, #8192\n" // reset vector to lower
"bic r0, r0, #5\n" // disable MMU/DCache
"mcr p15,0,r0,c1,c0,0\n" // write ctrl regs "mcr p15,0,r0,c1,c0,0\n" // write ctrl regs
);
"ldr r0, =0x0000\n" for(DWORD i=0;i<wReadSize;i++)*((char*)(0x40100000+i))=*((char*)bootloaderphysaddr+i);
asm volatile("ldr r0, =0x0000\n"
"ldr r1, =0x0000\n" "ldr r1, =0x0000\n"
"ldr r2, =0x0000\n" "ldr r2, =0x0000\n"
"ldr r3, =0x0000\n" "ldr r3, =0x0000\n"
@ -135,15 +138,10 @@ static void EDNA2_runPhysicalInvoker(unsigned long bootloaderphysaddr,DWORD size
"ldr r5, =0x0000\n" "ldr r5, =0x0000\n"
"ldr r6, =0x0000\n" "ldr r6, =0x0000\n"
"ldr r7, =0x0000\n" "ldr r7, =0x0000\n"
"ldr r8, =0x40002000\n" "ldr r8, =0x40100000\n"
"ldr r9, =0x0000\n" "ldr r9, =0x0000\n"
"mrc p15,0,r10,c1,c0,0\n" // read ctrl regs "swi #0\n" // jump!
"bic r10, r10, #5\n" // disable MMU/DCache
"mcr p15,0,r10,c1,c0,0\n" // write ctrl regs
);
for(unsigned int i=0;i<size;i++)*((char *)(0x40002000+i))=*((char *)(bootloaderphysaddr+i));
asm volatile("swi #0\n" // jump!
); );
// never reach here // never reach here
@ -151,56 +149,59 @@ static void EDNA2_runPhysicalInvoker(unsigned long bootloaderphysaddr,DWORD size
} }
__attribute__((noreturn)) __attribute__((noreturn))
static DWORD EDNA2_callKernelEntryPoint(unsigned long bootloaderphysaddr,DWORD size){ static DWORD EDNA2_callKernelEntryPoint(){
OutputDebugString(L"BrainLILO: disabling interrupts"); OutputDebugString(L"BrainLILO: disabling interrupts");
disableInterrupts(); disableInterrupts();
OutputDebugString(L"BrainLILO: injecting code to internal ram"); OutputDebugString(L"BrainLILO: injecting code to internal ram");
EDNA2_installPhysicalInvoker(); EDNA2_installPhysicalInvoker();
OutputDebugString(L"BrainLILO: invoking"); OutputDebugString(L"BrainLILO: invoking");
EDNA2_runPhysicalInvoker(bootloaderphysaddr,size); EDNA2_runPhysicalInvoker();
} }
static bool doLinux(){ static bool doLinux(){
char *bootloaderdata;
TCHAR bootloaderFileName[128]=TEXT("\\Storage Card\\loader\\u-boot.bin"); TCHAR bootloaderFileName[128]=TEXT("\\Storage Card\\loader\\u-boot.bin");
HANDLE hFile; HANDLE hFile;
DWORD wReadSize; char *bootloaderptr;
unsigned long bootloaderphysaddr; wchar_t buf[256];
PULONG bootloaderptr;
HINSTANCE dll; HINSTANCE dll;
AllocPhysMemProc AllocPhysMem; AllocPhysMemProc AllocPhysMem;
dll=LoadLibrary(TEXT("COREDLL.DLL")); dll=LoadLibrary(TEXT("COREDLL.DLL"));
if (dll == NULL) { if (dll == NULL) {
OutputDebugString(L"Cant load DLL"); OutputDebugString(L"BrainLILO: Cant load COREDLL.DLL");
return false; return false;
} }
AllocPhysMem=(AllocPhysMemProc)GetProcAddress(dll,TEXT("AllocPhysMem")); AllocPhysMem=(AllocPhysMemProc)GetProcAddress(dll,TEXT("AllocPhysMem"));
if (AllocPhysMem == NULL) { if (AllocPhysMem == NULL) {
OutputDebugString(L"Cant load AllocPhysMem function"); OutputDebugString(L"BrainLILO: Cant load AllocPhysMem function");
return false; return false;
} }
OutputDebugString(L"BrainLILO: loading bootloader."); OutputDebugString(L"BrainLILO: Opening Bootloader file...");
hFile = CreateFile(bootloaderFileName , GENERIC_READ , 0 , NULL ,OPEN_EXISTING , FILE_ATTRIBUTE_NORMAL , NULL); hFile = CreateFile(bootloaderFileName , GENERIC_READ , 0 , NULL ,OPEN_EXISTING , FILE_ATTRIBUTE_NORMAL , NULL);
if (hFile == INVALID_HANDLE_VALUE) { if (hFile == INVALID_HANDLE_VALUE) {
OutputDebugString(L"Cant load bootloader"); OutputDebugString(L"Cant open bootloader");
return false; return false;
} }
bootloaderdata = (char *)malloc(GetFileSize(hFile , NULL)); swprintf(buf, L"BrainLILO: Bootloader file handle 0x%08x\n",(int)(hFile));
ReadFile(hFile , bootloaderdata , GetFileSize(hFile , NULL) , &wReadSize , NULL); OutputDebugString(buf);
bootloaderptr=(char*)AllocPhysMem(GetFileSize(hFile , NULL),PAGE_EXECUTE_READWRITE,0,0,&bootloaderphysaddr);
swprintf(buf, L"BrainLILO: Allocated preload memory Virtual:%p Physical:%p\n",bootloaderptr,bootloaderphysaddr);
OutputDebugString(buf);
OutputDebugString(L"BrainLILO: Copying bootloader to allocated virtual memory...");
ReadFile(hFile , bootloaderptr , GetFileSize(hFile , NULL) , &wReadSize , NULL);
OutputDebugString(L"BrainLILO: Bootloader copied! Closing file handle...");
CloseHandle(hFile); CloseHandle(hFile);
bootloaderptr=(PULONG)AllocPhysMem(wReadSize,PAGE_EXECUTE_READWRITE,0,0,&bootloaderphysaddr); OutputDebugString(L"BrainLILO: Notifying power off to filesystems...");
wchar_t buf[256]; if(FileSystemPowerFunction) FileSystemPowerFunction(FSNOTIFY_POWER_OFF);
swprintf(buf, L"BrainLILO: copying bootloader to 0x%08x from 0x%08x\n",(int)(bootloaderptr), (int)(bootloaderdata));
OutputDebugString(buf); OutputDebugString(L"BrainLILO: Starting bootloader call sequence...");
memcpy(bootloaderptr,bootloaderdata,wReadSize); EDNA2_callKernelEntryPoint();
OutputDebugString(L"BrainLILO: bootloader copied");
free(bootloaderdata);
FreeLibrary(dll);
Sleep(100);
EDNA2_callKernelEntryPoint(bootloaderphysaddr,wReadSize);
return true; return true;
} }
@ -210,8 +211,6 @@ extern "C" BRAINLILODRV_API BOOL LIN_IOControl(DWORD handle, DWORD dwIoControlCo
switch(dwIoControlCode){ switch(dwIoControlCode){
case IOCTL_LIN_DO_LINUX: case IOCTL_LIN_DO_LINUX:
if(FileSystemPowerFunction)
FileSystemPowerFunction(FSNOTIFY_POWER_OFF);
if(!doLinux()){ if(!doLinux()){
if(FileSystemPowerFunction) if(FileSystemPowerFunction)
FileSystemPowerFunction(FSNOTIFY_POWER_ON); FileSystemPowerFunction(FSNOTIFY_POWER_ON);