mirror of
https://github.com/rvtr/TwlIPL.git
synced 2025-10-31 06:01:12 -04:00
9774cca464
メインメモリチェックルーチンにチップタイプとJTAGのチェックコードを追加 (しかしこのルーチン自体呼んでいない) ARM7側だけオートロードルーチンを呼んでいたのでコメントアウト リセットチェックルーチンのコメントアウト git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@71 b08762b0-b915-fc4b-9d8c-17b2551a87ff
685 lines
26 KiB
C
685 lines
26 KiB
C
/*---------------------------------------------------------------------------*
|
||
Project: TwlIPL - libraries - init
|
||
File: crt0.c
|
||
|
||
Copyright 2007 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:: $
|
||
$Rev$
|
||
$Author$
|
||
*---------------------------------------------------------------------------*/
|
||
#include <nitro/code32.h>
|
||
#include <firm.h>
|
||
|
||
extern void TwlMain(void);
|
||
extern void OS_IrqHandler(void);
|
||
static void do_autoload(void);
|
||
static void INITi_InitCoprocessor(void);
|
||
static void INITi_InitRegion(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 unsigned long SDK_IRQ_STACKSIZE[];
|
||
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 <nitro/version.h>
|
||
#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
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
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]
|
||
|
||
//---- 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 // 4byte for stack check code
|
||
tst sp, #4
|
||
subeq sp, sp, #4 // for 8byte-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 // 4byte for stack check code
|
||
|
||
//---- read reset flag from pmic
|
||
#ifdef TWL_PLATFORM_TS
|
||
#if 0
|
||
@0: bl PXI_RecvByIntf
|
||
cmp r0, #FIRM_PXI_ID_COLDBOOT
|
||
cmpne r0, #FIRM_PXI_ID_WARMBOOT
|
||
bne @0
|
||
#endif
|
||
//---- initialize Main Memory
|
||
cmp r0, #FIRM_PXI_ID_COLDBOOT
|
||
moveq r0, #TRUE
|
||
movne r0, #FALSE
|
||
bl MIi_InitMainMemCR
|
||
|
||
mov r0, #FIRM_PXI_ID_INIT_MMEM
|
||
bl PXI_SendByIntf
|
||
|
||
#else // TWL_PLATFORM_BB
|
||
//---- initialize Main Memory
|
||
bl MIi_InitMainMemCR
|
||
|
||
#endif // TWL_PLATFORM_BB
|
||
|
||
/* <20>V<EFBFBD>X<EFBFBD>e<EFBFBD><65><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>R<EFBFBD>v<EFBFBD><76><EFBFBD>Z<EFBFBD>b<EFBFBD>T<EFBFBD><54><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
bl INITi_InitCoprocessor
|
||
|
||
/* <20><><EFBFBD>[<5B>W<EFBFBD><57><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݒ<EFBFBD> */
|
||
bl INITi_InitRegion
|
||
|
||
//---- 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 TwlStartUp
|
||
bl __call_static_initializers
|
||
#endif
|
||
//---- start (to 16bit code)
|
||
ldr r1, =TwlMain
|
||
ldr lr, =HW_RESET_VECTOR
|
||
|
||
tst sp, #4
|
||
subne sp, sp, #4 // for 8byte-alignment
|
||
bx r1
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: INITi_CpuClear32
|
||
|
||
Description: fill memory with specified data.
|
||
32bit version
|
||
|
||
Arguments: data : fill data
|
||
destp : destination address
|
||
size : size (byte)
|
||
|
||
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
|
||
};
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
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 // reach to 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
|
||
#if 1
|
||
mov dest, dest_end
|
||
#else
|
||
@1:
|
||
cmp dest, dest_end
|
||
ldrmi tmp, [src], #4 // [dest++] <- [src++]
|
||
strmi tmp, [dest], #4
|
||
bmi @1
|
||
#endif
|
||
|
||
//---- 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, 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
|
||
|
||
// wait writebuffer empty
|
||
mcr p15, 0, tmp, c7, c10, 4
|
||
|
||
@skipout:
|
||
// r0 = _start_ModuleParams
|
||
b _start_AutoloadDoneCallback // Jump into the callback
|
||
}
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: _start_AutoloadDoneCallback
|
||
|
||
Description: hook for end of autoload (This is 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
|
||
}
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: INITi_InitCoprocessor
|
||
Description: <20>V<EFBFBD>X<EFBFBD>e<EFBFBD><65><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>R<EFBFBD>v<EFBFBD><76><EFBFBD>Z<EFBFBD>b<EFBFBD>T<EFBFBD><54><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>B
|
||
<20><><EFBFBD><EFBFBD><EFBFBD>ɁAI-TCM <20>y<EFBFBD><79> D-TCM <20><><EFBFBD>g<EFBFBD>p<EFBFBD>\<5C>ȏ<EFBFBD><C88F>Ԃɂ<D482><C982><EFBFBD><EFBFBD>B
|
||
Arguments: <20>Ȃ<EFBFBD><C882>B
|
||
Returns: <20>Ȃ<EFBFBD><C882>B
|
||
*---------------------------------------------------------------------------*/
|
||
static asm void
|
||
INITi_InitCoprocessor(void)
|
||
{
|
||
/* <20>R<EFBFBD>v<EFBFBD><76><EFBFBD>Z<EFBFBD>b<EFBFBD>T<EFBFBD>̏<EFBFBD><CC8F>Ԏ擾 */
|
||
mrc p15, 0, r0, c1, c0, 0
|
||
|
||
tst r0, #HW_C1_PROTECT_UNIT_ENABLE
|
||
beq @010
|
||
tst r0, #HW_C1_DCACHE_ENABLE
|
||
beq @003
|
||
|
||
/* D-Cache <20><><EFBFBD>e<EFBFBD><65><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>Ƀ<EFBFBD><C983>C<EFBFBD>g<EFBFBD>o<EFBFBD>b<EFBFBD>N */
|
||
mov r1, #0
|
||
@001: mov r2, #0
|
||
@002: orr r3, r1, r2
|
||
mcr p15, 0, r3, c7, c10, 2
|
||
add r2, r2, #HW_CACHE_LINE_SIZE
|
||
cmp r2, #HW_DCACHE_SIZE / 4
|
||
blt @002
|
||
adds r1, r1, #1 << HW_C7_CACHE_SET_NO_SHIFT
|
||
bne @001
|
||
|
||
@003: /* <20><><EFBFBD>C<EFBFBD>g<EFBFBD>o<EFBFBD>b<EFBFBD>t<EFBFBD>@<40><><EFBFBD><EFBFBD><EFBFBD>ɂȂ<C982><C882>̂<EFBFBD><CC82>҂<EFBFBD> */
|
||
mov r1, #0
|
||
mcr p15, 0, r1, c7, c10, 4
|
||
|
||
@010: /* <20>R<EFBFBD>v<EFBFBD><76><EFBFBD>Z<EFBFBD>b<EFBFBD>T<EFBFBD>̏<EFBFBD><CC8F>Ԃ<EFBFBD><D482><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
ldr r1, = HW_C1_ITCM_LOAD_MODE \
|
||
| HW_C1_DTCM_LOAD_MODE \
|
||
| HW_C1_ITCM_ENABLE \
|
||
| HW_C1_DTCM_ENABLE \
|
||
| HW_C1_LD_INTERWORK_DISABLE \
|
||
| HW_C1_ICACHE_ENABLE \
|
||
| HW_C1_DCACHE_ENABLE \
|
||
| HW_C1_PROTECT_UNIT_ENABLE
|
||
bic r0, r0, r1
|
||
ldr r1, = HW_C1_SB1_BITSET \
|
||
| HW_C1_EXCEPT_VEC_UPPER
|
||
orr r0, r0, r1
|
||
mcr p15, 0, r0, c1, c0, 0
|
||
|
||
/* I-TCM <20>̃T<CC83>C<EFBFBD>Y<EFBFBD><59><EFBFBD>ݒ<EFBFBD> */
|
||
mov r1, #HW_C9_TCMR_32MB
|
||
mcr p15, 0, r1, c9, c1, 1
|
||
/* D-TCM <20>̃T<CC83>C<EFBFBD>Y<EFBFBD>y<EFBFBD>ї̈<D197><CC88>x<EFBFBD>[<5B>X<EFBFBD>A<EFBFBD>h<EFBFBD><68><EFBFBD>X<EFBFBD><58><EFBFBD>ݒ<EFBFBD> */
|
||
ldr r1, =SDK_AUTOLOAD_DTCM_START
|
||
orr r1, r1, #HW_C9_TCMR_16KB
|
||
mcr p15, 0, r1, c9, c1, 0
|
||
|
||
/* I-TCM / D-TCM <20>g<EFBFBD>p<EFBFBD><70><EFBFBD>ݒ<C290> */
|
||
mov r1, #HW_C1_ITCM_ENABLE | HW_C1_DTCM_ENABLE
|
||
orr r0, r0, r1
|
||
mcr p15, 0, r0, c1, c0, 0
|
||
|
||
bx lr
|
||
}
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: INITi_InitRegion
|
||
Description: <20><><EFBFBD>[<5B>W<EFBFBD><57><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>ݒ<EFBFBD><DD92><EFBFBD><EFBFBD>s<EFBFBD><73><EFBFBD>B
|
||
Arguments: <20>Ȃ<EFBFBD><C882>B
|
||
Returns: <20>Ȃ<EFBFBD><C882>B
|
||
*---------------------------------------------------------------------------*/
|
||
/* When hardware is TWL
|
||
; 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 1: MAINMEM_WRAM: Base = 0x02000000, Size = 32MB, I:Cach Buf / D:Cach Buf, I:RW / D:RW
|
||
; Region 2: ARM7_RESERVE: Base = 0x02f80000, Size = 512KB, I:NC NB / D:NC NB, I:NA / D:NA
|
||
; Region 3: EX_MAINMEM: Base = 0x0d000000, Size = 16MB, I:Cach Buf / D:Cach Buf, I:RW / D:RW
|
||
; Region 4: DTCM: Base = 0x02fe0000, 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: SHARED_WORK: Base = 0x02ffc000, Size = 16KB, I:NC NB / D:NC NB, I:NA / D:RW
|
||
*/
|
||
/* When hardware is NITRO
|
||
; 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 1: MAIN_MEM: Base = 0x02000000, Size = 8MB*, I:Cach Buf / D:Cach Buf, I:RW / D:RW
|
||
; (* When hardware is not debugger, size will be reduced to 4MB in OS_InitArena() )
|
||
; Region 2: ARM7_RESERVE: Base = 0x027e0000, Size = 128KB, I:NC NB / D:NC NB, I:NA / D:NA
|
||
; (* When hardware is not debugger, base will be moved to 0x023e0000 in OS_InitArena() )
|
||
; Region 3: CARTRIDGE: Base = 0x08000000, Size = 128MB, I:NC NB / D:NC NB, I:NA / D:RW
|
||
; Region 4: DTCM: Base = 0x02fe0000, 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: SHARED_WORK: Base = 0x02fff000, Size = 4KB, I:NC NB / D:NC NB, I:NA / D:RW
|
||
*/
|
||
|
||
static asm void
|
||
INITi_InitRegion(void)
|
||
{
|
||
#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
|
||
|
||
/* (0) I/O <20><><EFBFBD>W<EFBFBD>X<EFBFBD>^<5E>y<EFBFBD><79> VRAM <20><> */
|
||
SET_PROTECTION_A(c0, HW_IOREG, 64MB)
|
||
SET_PROTECTION_B(c0, HW_IOREG, 64MB)
|
||
|
||
/* (4) D-TCM */
|
||
ldr r0, =SDK_AUTOLOAD_DTCM_START
|
||
orr r0, r0, #HW_C6_PR_16KB | HW_C6_PR_ENABLE
|
||
SET_PROTECTION_B(c4, SDK_AUTOLOAD_DTCM_START, 16KB)
|
||
|
||
/* (5) I-TCM */
|
||
SET_PROTECTION_A(c5, HW_ITCM_IMAGE, 16MB)
|
||
SET_PROTECTION_B(c5, HW_ITCM_IMAGE, 16MB)
|
||
|
||
/* (6) <20>V<EFBFBD>X<EFBFBD>e<EFBFBD><65><EFBFBD>R<EFBFBD>[<5B><> ROM */
|
||
SET_PROTECTION_A(c6, HW_BIOS, 32KB)
|
||
SET_PROTECTION_B(c6, HW_BIOS, 32KB)
|
||
|
||
/* TWL <20>n<EFBFBD>[<5B>h<EFBFBD>E<EFBFBD>F<EFBFBD>A<EFBFBD><41><EFBFBD>œ<EFBFBD><C593>삵<EFBFBD>Ă<EFBFBD><C482>邩<EFBFBD>ǂ<EFBFBD><C782><EFBFBD><EFBFBD><EFBFBD> */
|
||
ldr r1, =REG_CLK_ADDR
|
||
ldrh r0, [r1]
|
||
tst r0, #REG_SCFG_CLK_WRAMHCLK_MASK
|
||
beq @002
|
||
|
||
@001: /* <20>n<EFBFBD>[<5B>h<EFBFBD>E<EFBFBD>F<EFBFBD>A<EFBFBD><41> TWL <20>̏ꍇ */
|
||
/* (1) <20><><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>y<EFBFBD><79> WRAM */
|
||
SET_PROTECTION_A(c1, HW_TWL_MAIN_MEM_MAIN, 32MB)
|
||
SET_PROTECTION_B(c1, HW_TWL_MAIN_MEM_MAIN, 32MB)
|
||
|
||
/* (2) ARM7 <20><><EFBFBD>p<EFBFBD><70><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c2, HW_TWL_MAIN_MEM_SUB, 512KB)
|
||
SET_PROTECTION_B(c2, HW_TWL_MAIN_MEM_SUB, 512KB)
|
||
|
||
/* (3) <20>g<EFBFBD><67><EFBFBD><EFBFBD><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c3, HW_TWL_MAIN_MEM_EX, 16MB)
|
||
SET_PROTECTION_B(c3, HW_TWL_MAIN_MEM_EX, 16MB)
|
||
|
||
/* (7) ARM9/ARM7 <20><><EFBFBD>L<EFBFBD><4C><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c7, HW_TWL_MAIN_MEM_SHARED, 16KB)
|
||
SET_PROTECTION_B(c7, HW_TWL_MAIN_MEM_SHARED, 16KB)
|
||
|
||
/* <20><><EFBFBD>߃L<DF83><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
mov r0, #REGION_BIT(0, 1, 0, 1, 0, 0, 1, 0)
|
||
mcr p15, 0, r0, c2, c0, 1
|
||
|
||
/* <20>f<EFBFBD>[<5B>^<5E>L<EFBFBD><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
// mov r0, #REGION_BIT(0, 1, 0, 1, 0, 0, 1, 0)
|
||
mov r0, #REGION_BIT(0, 1, 1, 1, 0, 0, 1, 0)
|
||
mcr p15, 0, r0, c2, c0, 0
|
||
|
||
/* <20><><EFBFBD>C<EFBFBD>g<EFBFBD>o<EFBFBD>b<EFBFBD>t<EFBFBD>@<40><><EFBFBD><EFBFBD> */
|
||
// mov r0, #REGION_BIT(0, 1, 0, 1, 0, 0, 0, 0)
|
||
mov r0, #REGION_BIT(0, 1, 1, 1, 0, 0, 0, 0)
|
||
mcr p15, 0, r0, c3, c0, 0
|
||
|
||
/* <20><><EFBFBD>߃A<DF83>N<EFBFBD>Z<EFBFBD>X<EFBFBD><58><EFBFBD><EFBFBD> */
|
||
ldr r0, =REGION_ACC(RW, RW, NA, RW, NA, RW, RO, NA)
|
||
mcr p15, 0, r0, c5, c0, 3
|
||
|
||
/* <20>f<EFBFBD>[<5B>^<5E>A<EFBFBD>N<EFBFBD>Z<EFBFBD>X<EFBFBD><58><EFBFBD><EFBFBD> */
|
||
// 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
|
||
// b @003
|
||
|
||
@002: /* <20>n<EFBFBD>[<5B>h<EFBFBD>E<EFBFBD>F<EFBFBD>A<EFBFBD><41> NITRO <20>̏ꍇ */
|
||
#if 0
|
||
/* (1) <20><><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c1, HW_MAIN_MEM_MAIN, 8MB)
|
||
SET_PROTECTION_B(c1, HW_MAIN_MEM_MAIN, 8MB)
|
||
/* Size will be arranged in OS_InitArena(). */
|
||
|
||
/* (2) ARM7 <20><><EFBFBD>p<EFBFBD><70><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c2, (HW_MAIN_MEM_EX_END - HW_MAIN_MEM_SHARED_SIZE - HW_MAIN_MEM_SUB_SIZE), 128KB)
|
||
SET_PROTECTION_B(c2, (HW_MAIN_MEM_EX_END - HW_MAIN_MEM_SHARED_SIZE - HW_MAIN_MEM_SUB_SIZE), 128KB)
|
||
/* Base address will be moved in OS_InitArena(). */
|
||
|
||
/* (3) <20>J<EFBFBD>[<5B>g<EFBFBD><67><EFBFBD>b<EFBFBD>W */
|
||
SET_PROTECTION_A(c3, HW_CTRDG_ROM, 128MB)
|
||
SET_PROTECTION_B(c3, HW_CTRDG_ROM, 128MB)
|
||
|
||
/* (7) ARM9/ARM7 <20><><EFBFBD>L<EFBFBD><4C><EFBFBD>C<EFBFBD><43><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
SET_PROTECTION_A(c7, HW_MAIN_MEM_SHARED, 4KB)
|
||
SET_PROTECTION_B(c7, HW_MAIN_MEM_SHARED, 4KB)
|
||
|
||
/* <20><><EFBFBD>߃L<DF83><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
mov r0, #REGION_BIT(0, 1, 0, 0, 0, 0, 1, 0)
|
||
mcr p15, 0, r0, c2, c0, 1
|
||
|
||
/* <20>f<EFBFBD>[<5B>^<5E>L<EFBFBD><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD><EFBFBD><EFBFBD><EFBFBD> */
|
||
mov r0, #REGION_BIT(0, 1, 0, 0, 0, 0, 1, 0)
|
||
mcr p15, 0, r0, c2, c0, 0
|
||
|
||
/* <20><><EFBFBD>C<EFBFBD>g<EFBFBD>o<EFBFBD>b<EFBFBD>t<EFBFBD>@<40><><EFBFBD><EFBFBD> */
|
||
mov r0, #REGION_BIT(0, 1, 0, 0, 0, 0, 0, 0)
|
||
mcr p15, 0, r0, c3, c0, 0
|
||
|
||
/* <20><><EFBFBD>߃A<DF83>N<EFBFBD>Z<EFBFBD>X<EFBFBD><58><EFBFBD><EFBFBD> */
|
||
ldr r0, =REGION_ACC(RW, RW, NA, NA, NA, RW, RO, NA)
|
||
mcr p15, 0, r0, c5, c0, 3
|
||
|
||
/* <20>f<EFBFBD>[<5B>^<5E>A<EFBFBD>N<EFBFBD>Z<EFBFBD>X<EFBFBD><58><EFBFBD><EFBFBD> */
|
||
ldr r0, =REGION_ACC(RW, RW, NA, RW, RW, RW, RO, RW)
|
||
mcr p15, 0, r0, c5, c0, 2
|
||
#endif
|
||
@003: /* <20>v<EFBFBD><76><EFBFBD>e<EFBFBD>N<EFBFBD>V<EFBFBD><56><EFBFBD><EFBFBD><EFBFBD><EFBFBD><EFBFBD>j<EFBFBD>b<EFBFBD>g<EFBFBD>y<EFBFBD>уL<D183><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD>g<EFBFBD>p<EFBFBD><70><EFBFBD>ݒ<C290> */
|
||
mrc p15, 0, r0, c1, c0, 0
|
||
ldr r1, = HW_C1_ICACHE_ENABLE \
|
||
| HW_C1_DCACHE_ENABLE \
|
||
| HW_C1_CACHE_ROUND_ROBIN \
|
||
| HW_C1_PROTECT_UNIT_ENABLE
|
||
orr r0, r0, r1
|
||
mcr p15, 0, r0, c1, c0, 0
|
||
|
||
/* <20>L<EFBFBD><4C><EFBFBD>b<EFBFBD>V<EFBFBD><56><EFBFBD>̓<EFBFBD><CC93>e<EFBFBD><65><EFBFBD>j<EFBFBD><6A> */
|
||
mov r1, #0
|
||
mcr p15, 0, r1, c7, c6, 0
|
||
mcr p15, 0, r1, c7, c5, 0
|
||
|
||
bx lr
|
||
}
|
||
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: TwlStartUp
|
||
|
||
Description: hook for user start up
|
||
|
||
Arguments: None
|
||
|
||
Returns: None.
|
||
*---------------------------------------------------------------------------*/
|
||
SDK_WEAK_SYMBOL void TwlStartUp(void)
|
||
{
|
||
}
|
||
|
||
/*---------------------------------------------------------------------------*
|
||
Name: OSi_ReferSymbol
|
||
|
||
Description: used by SDK_REFER_SYMBOL macro to avoid dead-strip.
|
||
|
||
Arguments: symbol unused
|
||
|
||
Returns: None.
|
||
*---------------------------------------------------------------------------*/
|
||
void OSi_ReferSymbol(void *symbol)
|
||
{
|
||
#pragma unused(symbol)
|
||
}
|