/*---------------------------------------------------------------------------* Project: TwlSDK File: crt0.c Copyright 2007-2008 Nintendo. All rights reserved. These coded instructions, statements, and computer programs contain proprietary information of Nintendo of America Inc. and/or Nintendo Company Ltd., and are protected by Federal copyright law. They may not be disclosed to third parties or copied or duplicated in any form, in whole or in part, without the prior written consent of Nintendo. $Date:: 2008-12-05#$ $Rev: 9534 $ $Author: sasaki_yu $ *---------------------------------------------------------------------------*/ #include #include extern void NitroMain(void); extern void OS_IrqHandler(void); static void do_autoload(void); static void init_cp15(void); void _start(void); static void INITi_CpuClear32(register u32 data, register void *destp, register u32 size); extern void *const _start_ModuleParams[]; void _start_AutoloadDoneCallback(void *argv[]); extern void __call_static_initializers(void); extern void _fp_init(void); // From LCF extern void SDK_IRQ_STACKSIZE(void); extern void SDK_AUTOLOAD_START(void); // Autoload data will start from here extern void SDK_AUTOLOAD_LIST(void); // Start pointer to autoload information extern void SDK_AUTOLOAD_LIST_END(void); // End pointer to autoload information extern void SDK_STATIC_BSS_START(void); // Static bss start address extern void SDK_STATIC_BSS_END(void); // Static bss end address #include #define SDK_VERSION_ID ((u32)SDK_VERSION_MAJOR<<24|\ (u32)SDK_VERSION_MINOR<<16|\ (u32)SDK_VERSION_RELSTEP) #define SDK_NITROCODE_LE 0x2106c0de #define SDK_NITROCODE_BE 0xdec00621 #define SDK_BUILDCODE_LE 0x3381c0de #define SDK_BUILDCODE_BE 0xdec08133 /* For embedding build type */ #if defined(SDK_DEBUG) #define SDK_BUILDCODE 2 #elif defined(SDK_RELEASE) #define SDK_BUILDCODE 1 #elif defined(SDK_FINALROM) #define SDK_BUILDCODE 0 #else #define SDK_BUILDCODE 255 // Error #endif #if defined(SDK_ARM9) #define SDK_TARGET 9 #elif defined(SDK_ARM7) #define SDK_TARGET 7 #else #define SDK_TARGET 255 // Error #endif /*---------------------------------------------------------------------------* Name: _start Description: Start up Arguments: None. Returns: None. *---------------------------------------------------------------------------*/ #define INITi_HW_DTCM SDK_AUTOLOAD_DTCM_START SDK_WEAK_SYMBOL asm void _start( void ) { //---- Set IME = 0 // (Use that LSB of HW_REG_BASE equal to 0) mov r12, #HW_REG_BASE str r12, [r12, #REG_IME_OFFSET] //---- Adjust VCOUNT @wait_vcount_0: ldrh r0, [r12, #REG_VCOUNT_OFFSET] cmp r0, #0 bne @wait_vcount_0 //---- Initialize cp15 bl init_cp15 //---- Initialize stack pointer // SVC mode mov r0, #HW_PSR_SVC_MODE msr cpsr_c, r0 ldr r0, =INITi_HW_DTCM add r0, r0, #0x3fc0 mov sp, r0 // IRQ mode mov r0, #HW_PSR_IRQ_MODE msr cpsr_c, r0 ldr r0, =INITi_HW_DTCM add r0, r0, #0x3fc0 sub r0, r0, #HW_SVC_STACK_SIZE sub sp, r0, #4 // 4 bytes for stack check code tst sp, #4 subeq sp, sp, #4 // For 8-byte alignment // System mode ldr r1, =SDK_IRQ_STACKSIZE sub r1, r0, r1 mov r0, #HW_PSR_SYS_MODE msr cpsr_csfx, r0 sub sp, r1, #4 // 4 bytes for stack check code tst sp, #4 subne sp, sp, #4 // For 8-byte alignment //---- Clear memory // DTCM (16KB) mov r0, #0 ldr r1, =INITi_HW_DTCM mov r2, #HW_DTCM_SIZE bl INITi_CpuClear32 // BG/OBJ palette (1KB) mov r0, #0 ldr r1, =HW_PLTT mov r2, #HW_PLTT_SIZE bl INITi_CpuClear32 // OAM (1KB) mov r0, #0x0200 ldr r1, =HW_OAM mov r2, #HW_OAM_SIZE bl INITi_CpuClear32 //---- Load autoload block and initialize bss ldr r1, =_start_ModuleParams ldr r0, [r1, #20] // r0 = bottom of compressed data bl MIi_UncompressBackward bl do_autoload //---- Fill static static bss with 0 ldr r0, =_start_ModuleParams ldr r1, [r0, #12] // BSS segment start ldr r2, [r0, #16] // BSS segment end mov r3, r1 // For next step (flush bss) mov r0, #0 @1: cmp r1, r2 strcc r0, [r1], #4 bcc @1 //---- Flush static bss region // (r0 == #0, r3 == _start_ModuleParams::BSS_segment_start) bic r1, r3, #HW_CACHE_LINE_SIZE - 1 @cacheflush: mcr p15, 0, r0, c7, c10, 4 // Wait writebuffer empty mcr p15, 0, r1, c7, c5, 1 // ICache mcr p15, 0, r1, c7, c14, 1 // DCache add r1, r1, #HW_CACHE_LINE_SIZE cmp r1, r2 blt @cacheflush // Print buffer (used for ARM7's printing) ldr r1, =HW_COMPONENT_PARAM str r0, [r1, #0] //---- Set interrupt vector ldr r1, =INITi_HW_DTCM add r1, r1, #0x3fc0 add r1, r1, #HW_DTCM_SYSRV_OFS_INTR_VECTOR ldr r0, =OS_IrqHandler str r0, [r1, #0] #ifndef SDK_NOINIT //---- For C++ bl _fp_init bl NitroStartUp bl __call_static_initializers #endif //---- Start (to 16-bit code) ldr r1, =NitroMain ldr lr, =HW_RESET_VECTOR bx r1 } /*---------------------------------------------------------------------------* Name: INITi_CpuClear32 Description: Fill memory with specified data. 32-bit version. Arguments: data: Fill data destp: Destination address size: Size (bytes) Returns: None. *---------------------------------------------------------------------------*/ static asm void INITi_CpuClear32( register u32 data, register void *destp, register u32 size ) { add r12, r1, r2 // r12: destEndp = destp + size @20: cmp r1, r12 // while (destp < destEndp) stmltia r1!, {r0} // *((vu32 *)(destp++)) = data blt @20 bx lr } /*---------------------------------------------------------------------------* Name: _start_ModuleParams Description: Autoload/compress/arguments data block. Arguments: None. Returns: None. *---------------------------------------------------------------------------*/ void *const _start_ModuleParams[] = { (void *)SDK_AUTOLOAD_LIST, (void *)SDK_AUTOLOAD_LIST_END, (void *)SDK_AUTOLOAD_START, (void *)SDK_STATIC_BSS_START, (void *)SDK_STATIC_BSS_END, (void *)0, // CompressedStaticEnd (void *)SDK_VERSION_ID, // SDK version info (void *)SDK_NITROCODE_BE, // Checker 1 (void *)SDK_NITROCODE_LE, // Checker 2 }; /* Allocate 32 bytes for storage of build information */ #pragma force_active on void* const _start_BuildParams[] = { (void*)0, // Reserved (void*)0, // Reserved (void*)0, // Reserved (void*)0, // Reserved (void*)(SDK_BUILDCODE | (SDK_TARGET << 8)), // Build target and build type (void*)1, // Version(1byte) Reserved(3byte) (void*)SDK_BUILDCODE_BE, (void*)SDK_BUILDCODE_LE, }; /* When built for NITRO, not to link on the force_active */ #ifdef SDK_NITRO static void* DUMMY = (void*)&_start_BuildParams[0]; #endif /*---------------------------------------------------------------------------* Name: MIi_UncompressBackward Description: Uncompress special archive for module compression. Arguments: bottom = Bottom adrs of packed archive + 1 bottom[-8..-6] = offset for top of compressed data inp_top = bottom - bottom[-8..-6] bottom[ -5] = offset for bottom of compressed data inp = bottom - bottom[-5] bottom[-4..-1] = offset for bottom of original data outp = bottom + bottom[-4..-1] typedef struct { u32 bufferTop:24; u32 compressBottom:8; u32 originalBottom; } CompFooter; Returns: None. *---------------------------------------------------------------------------*/ asm void MIi_UncompressBackward( register void* bottom ) { #define data r0 #define inp_top r1 #define outp r2 #define inp r3 #define outp_save r4 #define flag r5 #define count8 r6 #define index r7 #define len r12 cmp bottom, #0 beq @exit stmfd sp!, {r4-r7} ldmdb bottom, {r1-r2} add outp, bottom, outp sub inp, bottom, inp_top, LSR #24 bic inp_top, inp_top, #0xff000000 sub inp_top, bottom, inp_top mov outp_save, outp @loop: cmp inp, inp_top // Exit if inp==inp_top ble @end_loop ldrb flag, [inp, #-1]! // r4 = compress_flag = *--inp mov count8, #8 @loop8: subs count8, count8, #1 blt @loop tst flag, #0x80 bne @blockcopy @bytecopy: ldrb data, [inp, #-1]! #ifdef SDK_TEG sub outp, outp, #1 swpb data, data, [outp] #else strb data, [outp, #-1]! // Copy 1 byte #endif b @joinhere @blockcopy: ldrb len, [inp, #-1]! ldrb index, [inp, #-1]! orr index, index, len, LSL #8 bic index, index, #0xf000 add index, index, #0x0002 add len, len, #0x0020 @patterncopy: ldrb data, [outp, index] #ifdef SDK_TEG sub outp, outp, #1 swpb data, data, [outp] #else strb data, [outp, #-1]! #endif subs len, len, #0x0010 bge @patterncopy @joinhere: cmp inp, inp_top mov flag, flag, LSL #1 bgt @loop8 @end_loop: // DC_FlushRange & IC_InvalidateRange mov r0, #0 bic inp, inp_top, #HW_CACHE_LINE_SIZE - 1 @cacheflush: mcr p15, 0, r0, c7, c10, 4 // Wait writebuffer empty mcr p15, 0, inp, c7, c5, 1 // ICache mcr p15, 0, inp, c7, c14, 1 // DCache add inp, inp, #HW_CACHE_LINE_SIZE cmp inp, outp_save blt @cacheflush ldmfd sp!, {r4-r7} @exit bx lr } /*---------------------------------------------------------------------------* Name: do_autoload Description: Put autoload data block according to autoload information, and clear static bss by filling with 0. Arguments: None. Returns: None. *---------------------------------------------------------------------------*/ static asm void do_autoload( void ) { #define ptable r0 #define infop r1 #define infop_end r2 #define src r3 #define dest r4 #define dest_begin r5 #define dest_end r6 #define tmp r7 ldr ptable, =_start_ModuleParams ldr infop, [ptable, #0] // r1 = start pointer to autoload_info ldr infop_end, [ptable, #4] // r2 = end pointer to autoload_info ldr src, [ptable, #8] // r3 = autoload block @2: cmp infop, infop_end // Does it get to the end? beq @skipout ldr dest_begin,[infop], #4 // dest_begin ldr tmp, [infop], #4 // size add dest_end, dest_begin, tmp // dest_end mov dest, dest_begin // dest working pointer @1: cmp dest, dest_end ldrmi tmp, [src], #4 // [dest++] <- [src++] strmi tmp, [dest], #4 bmi @1 //---- fill bss with 0 ldr tmp, [infop], #4 // size add dest_end, dest, tmp // bss end mov tmp, #0 @3: cmp dest, dest_end strcc tmp, [dest], #4 bcc @3 //---- cache work (DC_FlushRange & IC_InvalidateRange) bic dest, dest_begin, #HW_CACHE_LINE_SIZE - 1 @cacheflush: mcr p15, 0, tmp, c7, c10, 4 /* Wait writebuffer empty */ mcr p15, 0, dest, c7, c5, 1 // ICache mcr p15, 0, dest, c7, c14, 1 // DCache add dest, dest, #HW_CACHE_LINE_SIZE cmp dest, dest_end blt @cacheflush b @2 @skipout: // r0 = _start_ModuleParams b _start_AutoloadDoneCallback // Jump into the callback } /*---------------------------------------------------------------------------* Name: _start_AutoloadDoneCallback Description: Hook for end of autoload (This is a dummy target for DEBUGGER). Arguments: argv: Pointer for autoload parameters. argv[0] = SDK_AUTOLOAD_LIST argv[1] = SDK_AUTOLOAD_LIST_END argv[2] = SDK_AUTOLOAD_START argv[3] = SDK_STATIC_BSS_START argv[4] = SDK_STATIC_BSS_END Returns: None. *---------------------------------------------------------------------------*/ SDK_WEAK_SYMBOL asm void _start_AutoloadDoneCallback( void* argv[] ) { bx lr } //----------------------------------------------------------------------- // Initialize system control coprocessor //----------------------------------------------------------------------- static asm void init_cp15(void) { // Protection unit / Cache / TCM disable mrc p15, 0, r0, c1, c0, 0 ldr r1, =HW_C1_ICACHE_ENABLE | HW_C1_DCACHE_ENABLE \ | HW_C1_ITCM_ENABLE | HW_C1_DTCM_ENABLE \ | HW_C1_ITCM_LOAD_MODE | HW_C1_DTCM_LOAD_MODE \ | HW_C1_LD_INTERWORK_DISABLE \ | HW_C1_PROTECT_UNIT_ENABLE bic r0, r0, r1 mcr p15, 0, r0, c1, c0, 0 // Invalidate cache mov r0, #0 mcr p15, 0, r0, c7, c5, 0 // Instruction cache mcr p15, 0, r0, c7, c6, 0 // Data cache // Wait for the write buffer to empty. mcr p15, 0, r0, c7, c10, 4 /* ; Region G: BACK_GROUND: Base = 0x0, Size = 4GB, I:NC NB / D:NC NB, I:NA / D:NA ; Region 0: IO_VRAM : Base = 0x04000000, Size = 64MB, I:NC NB / D:NC NB, I:RW / D:RW ; Region 1Rel: MAIN_MEM+W: Base = 0x02000000, Size = 32MB*, I:Cach Buf / D:Cach Buf, I:RW / D:RW ; Region 1Dbg: MAIN_MEM+W: Base = 0x02000000, Size = 32MB, I:Cach Buf / D:Cach Buf, I:RW / D:RW ; (* Size will be arranged in OS_InitArena(). ) ; Region 2Rel: SOUND_DATA: Base = 0x02380000, Size = 512KB, I:NC NB / D:NC NB, I:NA / D:NA ; Region 2D4M: SOUND_DATA: Base = 0x02300000, Size = 1MB, I:NC NB / D:NC NB, I:NA / D:NA ; Region 2D8M: SOUND_DATA: Base = 0x02600000, Size = 2MB, I:NC NB / D:NC NB, I:NA / D:NA ; Region 2: SHARE_WORK: Base = 0x027ff000, Size = 4KB, I:NC NB / D:NC NB, I:NA / D:RW ; Region 3: MAIN_MEM_HI: Base = 0x08000000, Size = 128MB, I:NC NB / D:NC NB, I:NA / D:RW ; Region 4: DTCM : Base = SOUND_DATA, Size = 16KB, I:NC NB / D:NC NB, I:NA / D:RW ; Region 5: ITCM : Base = 0x01000000, Size = 16MB, I:NC NB / D:NC NB, I:RW / D:RW ; Region 6: BIOS : Base = 0xffff0000, Size = 32KB, I:Cach NB / D:Cach NB, I:RO / D:RO ; Region 7: SHARE_WORK: Base = 0x02fff000, Size = 4KB, I:NC NB / D:NC NB, I:NA / D:RW ;(Region 7: DBG_RESERVE: Base = 0x02700000, Size = 1MB, I:NC NB / D:NC NB, I:RW / D:RW) */ #define SET_PROTECTION_A( id, adr, siz ) ldr r0, =(adr|HW_C6_PR_##siz|HW_C6_PR_ENABLE) #define SET_PROTECTION_B( id, adr, siz ) mcr p15, 0, r0, c6, id, 0 #define REGION_BIT(a,b,c,d,e,f,g,h) (((a)<<0)|((b)<<1)|((c)<<2)|((d)<<3)|((e)<<4)|((f)<<5)|((g)<<6)|((h)<<7)) #define REGION_ACC(a,b,c,d,e,f,g,h) (((a)<<0)|((b)<<4)|((c)<<8)|((d)<<12)|((e)<<16)|((f)<<20)|((g)<<24)|((h)<<28)) #define NA 0 #define RW 1 #define RO 5 // // Initialize memory region // //---- I/O registers and VRAM, etc. SET_PROTECTION_A( c0, HW_IOREG, 64MB ) SET_PROTECTION_B( c0, HW_IOREG, 64MB ) //---- Main memory SET_PROTECTION_A( c1, HW_MAIN_MEM_MAIN, 32MB ) SET_PROTECTION_B( c1, HW_MAIN_MEM_MAIN, 32MB ) //---- SHARED (image) SET_PROTECTION_A( c2, HW_MAIN_MEM_IM_SHARED, 4KB ) SET_PROTECTION_B( c2, HW_MAIN_MEM_IM_SHARED, 4KB ) //---- Game Pak or other use // CPU internal work RAM etc. SET_PROTECTION_A( c3, HW_CTRDG_ROM, 128MB ) SET_PROTECTION_B( c3, HW_CTRDG_ROM, 128MB ) //---- Data TCM // + There is sometimes CPU internal work RAM //#if (HW_DTCM & 0x3FFF) != 0 //#pragma message(ERROR: HW_DTCM need to be aligned 16KB!) //#endif // SET_PROTECTION_A( c4, HW_DTCM, 16KB ) ldr r0, =SDK_AUTOLOAD_DTCM_START orr r0, r0, #HW_C6_PR_16KB orr r0, r0, #HW_C6_PR_ENABLE SET_PROTECTION_B( c4, HW_DTCM, 16KB ) //---- Instruction TCM // Image up to the main memory region that has a higher priority than the data TCM. SET_PROTECTION_A( c5, HW_ITCM_IMAGE, 16MB ) SET_PROTECTION_B( c5, HW_ITCM_IMAGE, 16MB ) //---- BIOS SET_PROTECTION_A( c6, HW_BIOS, 32KB ) SET_PROTECTION_B( c6, HW_BIOS, 32KB ) //---- SHARED communication work area between CPUs SET_PROTECTION_A( c7, HW_MAIN_MEM_SHARED, 4KB ) SET_PROTECTION_B( c7, HW_MAIN_MEM_SHARED, 4KB ) #if HW_MAIN_MEM_SHARED_SIZE != 0x1000 #pragma message(ERROR: Size unmatch HW_MAIN_MEM_SHARED_SIZE) #endif // // Instruction TCM settings // mov r0, #HW_C9_TCMR_32MB mcr p15, 0, r0, c9, c1, 1 // // Data TCM settings // ldr r0, =INITi_HW_DTCM orr r0, r0, #HW_C9_TCMR_16KB mcr p15, 0, r0, c9, c1, 0 // // Instruction cache enable (Region settings) // 1: MAIN_MEM + WRAM // 3: MAIN_MEM_HI (or CTRDG) // 6: BIOS // mov r0, #REGION_BIT(0,1,0,1,0,0,1,0) mcr p15, 0, r0, c2, c0, 1 // // Data cache enable (Region settings) // 1: MAIN_MEM + WRAM // 3: MAIN_MEM_HI (or CTRDG) // 6: BIOS // mov r0, #REGION_BIT(0,1,0,1,0,0,1,0) mcr p15, 0, r0, c2, c0, 0 // // Write buffer enable (Region settings) // 1: MAIN_MEM + WRAM // 3: MAIN_MEM (or CTRDG) // mov r0, #REGION_BIT(0,1,0,1,0,0,0,0) mcr p15, 0, r0, c3, c0, 0 // // Instruction access permissions (Region settings) // IO_VRAM : RW // MAIN_MEM_MAIN : RW // MAIN_MEM_SUB : NA // MAIN_MEM_HI: RW // DTCM : NA // ITCM : RW // BIOS : RO // SHARED : NA // // ldr r0, =REGION_ACC(RW,RW,NA,RW,NA,RW,RO,NA) ldr r0, =REGION_ACC(RW,RW,NA,RW,NA,RW,RO,NA) mcr p15, 0, r0, c5, c0, 3 // // Data access permissions (Region settings) // IO_VRAM : RW // MAIN_MEM_MAIN : RW // MAIN_MEM_SUB : NA // MAIN_MEM_HI: RW // DTCM : RW // ITCM : RW // BIOS : RO // SHARED : RW // // ldr r0, =REGION_ACC(RW,RW,NA,RW,RW,RW,RO,RW) ldr r0, =REGION_ACC(RW,RW,RW,RW,RW,RW,RO,RW) mcr p15, 0, r0, c5, c0, 2 // // System control coprocessor master settings // mrc p15, 0, r0, c1, c0, 0 ldr r1,=HW_C1_ICACHE_ENABLE | HW_C1_DCACHE_ENABLE | HW_C1_CACHE_ROUND_ROBIN \ | HW_C1_ITCM_ENABLE | HW_C1_DTCM_ENABLE \ | HW_C1_SB1_BITSET | HW_C1_EXCEPT_VEC_UPPER \ | HW_C1_PROTECT_UNIT_ENABLE orr r0, r0, r1 mcr p15, 0, r0, c1, c0, 0 bx lr } /*---------------------------------------------------------------------------* Name: NitroStartUp Description: Hook for user start-up. Arguments: None. Returns: None. *---------------------------------------------------------------------------*/ SDK_WEAK_SYMBOL void NitroStartUp(void) { } /*---------------------------------------------------------------------------* Name: OSi_ReferSymbol Description: Used by SDK_REFER_SYMBOL macro to avoid deadstripping. Arguments: symbol: Unused Returns: None. *---------------------------------------------------------------------------*/ void OSi_ReferSymbol(void *symbol) { #pragma unused(symbol) }