71 lines
No EOL
1.8 KiB
C
71 lines
No EOL
1.8 KiB
C
#include "common.h"
|
|
#include "sdmmc.h"
|
|
struct FIRM_sect {
|
|
u32 offset;
|
|
u32 physical;
|
|
u32 size;
|
|
u32 arm11;
|
|
u8 SHA256[0x20]; //Implement later.
|
|
}__attribute__((packed));
|
|
struct FIRM_header {
|
|
char magic[4];
|
|
int reserved1;
|
|
u32 arm11Entry;
|
|
u32 arm9Entry;
|
|
u8 reserved2[0x30];
|
|
struct FIRM_sect sections[4];
|
|
u8 RSA2048[0x100]; //I'd need to find out big N's private key to do that!
|
|
}__attribute__((packed));
|
|
struct chs {
|
|
u8 head;
|
|
u8 sector;
|
|
u8 cylinder;
|
|
}__attribute__((packed));
|
|
struct partition {
|
|
u8 status;
|
|
struct chs start_chs;
|
|
u8 parttype;
|
|
struct chs end_chs;
|
|
u32 start;
|
|
u32 length;
|
|
}__attribute__((packed));
|
|
struct MBR {
|
|
u8 bootstrap[0x1BE];
|
|
struct partition partition[4];
|
|
u16 signature;
|
|
}__attribute__((packed));
|
|
void main() {
|
|
// start up SD-Card controller
|
|
sdmmc_sdcard_init();
|
|
|
|
struct MBR drive;
|
|
sdmmc_sdcard_readsectors(0,1, (u8*)&drive);
|
|
if(drive.partition[3].status==0) {
|
|
//Found the partition
|
|
struct FIRM_header firm;
|
|
sdmmc_sdcard_readsectors(drive.partition[3].start,1, (u8*)&firm);
|
|
char* magic="FIRM";
|
|
for(int i=0;i<4;i++) {
|
|
if(magic[i]!=firm.magic[i]) {
|
|
return; //Check magic
|
|
}
|
|
}
|
|
//Load segments into memory
|
|
int i;
|
|
for(i=0;i<4;i++) {
|
|
u32 startsector=firm.sections[i].offset/512;
|
|
u32 length=firm.sections[i].size/512+1;
|
|
u8* buf=(u8*)firm.sections[i].physical;
|
|
sdmmc_sdcard_readsectors(startsector,length,buf);
|
|
}
|
|
*((u32*)0x1FFFFFF8)=firm.arm11Entry;
|
|
((void(*)())firm.arm9Entry)(); //Kill me
|
|
}
|
|
}
|
|
void init() {
|
|
main();
|
|
u8 *lfb=(u8*)0x18300000;
|
|
for(int i=0;i<500;i++)
|
|
lfb[i]=0xFF; //Output simple error
|
|
for(;;);
|
|
} |