rvtr/TwlIPL
1
Fork 0
mirror of https://github.com/rvtr/TwlIPL.git synced 2025-10-31 06:01:12 -04:00
Code Issues Actions Packages Projects Releases Wiki Activity
7d6286c4da
TwlIPL/build/tests/HashCheckTemplate/crt/ARM7/src/crt0_hct.HYB.c
yoshida_teruhisa 66bf53361e TestMaker 
・ArchGen の指定および ARM7 コンポーネントの指定 (ARM7Base) 機能を追加
 ・ArchGen 指定なしの場合は LIMITED 扱い
HashCheckTemplate
 ・HYBRID 版を作成

git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@2184 b08762b0-b915-fc4b-9d8c-17b2551a87ff
2008-08-19 02:35:04 +00:00

919 lines
34 KiB
C
Raw Blame History

/*---------------------------------------------------------------------------*
Project: TwlSDK - libraries - init - ARM7.TWL
File: crt0.HYB.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/types.h>
#include <nitro/hw/common/armArch.h>
#include <nitro/os/common/emulator.h>
#include <nitro/os/common/printf.h>
#include <twl/init/crt0.h>
#include <twl/memorymap_sp.h>
#include <twl/hw/common/mmap_wramEnv.h>
#include <twl/os/common/format_rom.h>
#include <nitro/os/common/systemWork.h>
#include <twl/version.h>
#include "boot_sync.h"
/*---------------------------------------------------------------------------*/
void _start(void);
void _start_AutoloadDoneCallback(void* argv[]);
void WVR_ShelterExtWram(void);
void INIT_InitializeScfg(void);
#define SDK_NITROCODE_LE 0x2106c0de
#define SDK_NITROCODE_BE 0xdec00621
#define SDK_TWLCODE_LE 0x6314c0de
#define SDK_TWLCODE_BE 0xdec01463
/* 外部関数参照定義 */
extern void OS_IrqHandler(void);
extern void _fp_init(void);
extern void __call_static_initializers(void);
/* 内部関数プロトタイプ定義 */
static void INITi_SetHMACSHA1ToAppParam(void);
static void INITi_DoAutoload(void);
static void INITi_ShelterLtdBinary(void);
static BOOL INITi_IsRunOnTwl( void );
static void INITi_CopySysConfig( void );
static void INITi_DetectMainMemorySize(void);
#ifndef SDK_NOINIT
static void INITi_ShelterStaticInitializer(u32* ptr);
static void INITi_CallStaticInitializers(void);
#endif
static void* INITi_Copy32(void* dst, void* src, u32 size);
static void* INITi_Fill32(void* dst, u32 value, u32 size);
/* リンカスクリプトにより定義されるシンボル参照 */
extern void SDK_WRAM_ARENA_LO(void);
extern void SDK_AUTOLOAD_LIST(void);
extern void SDK_AUTOLOAD_LIST_END(void);
extern void SDK_AUTOLOAD_START(void);
extern void SDK_STATIC_BSS_START(void);
extern void SDK_STATIC_BSS_END(void);
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. This fixed number will be updated by compstatic tool.
(void*)SDK_CURRENT_VERSION_NUMBER,
(void*)SDK_NITROCODE_BE,
(void*)SDK_NITROCODE_LE,
};
extern void SDK_LTDAUTOLOAD_LIST(void);
extern void SDK_LTDAUTOLOAD_LIST_END(void);
extern void SDK_LTDAUTOLOAD_START(void);
void* const _start_LtdModuleParams[] =
{
(void*)SDK_LTDAUTOLOAD_LIST,
(void*)SDK_LTDAUTOLOAD_LIST_END,
(void*)SDK_LTDAUTOLOAD_START,
(void*)0, // CompressedLtdautoloadEnd. This fixed number will be updated by compstatic tool.
(void*)SDK_TWLCODE_BE,
(void*)SDK_TWLCODE_LE,
};
extern void SDK_LTDAUTOLOAD_LTDMAIN_START(void);
void* const _start_LtdMainParams[] =
{
(void*)SDK_LTDAUTOLOAD_LTDMAIN_START,
};
#ifdef DEBUG_WRAM_SETTING
u32 const wramMapping[12] = {
0x8d898581, 0x8c888480, 0x9c989490, 0x8c888480,
0x9c989490, 0x00000000, 0x09403900, 0x09803940,
0x00403000, 0x09403900, 0x09803940, 0x0300000f
};
#endif
#define DIGEST_HASH_BLOCK_SIZE_SHA1 (512/8)
static const u8 s_digestDefaultKey[ DIGEST_HASH_BLOCK_SIZE_SHA1 ] =
{
0x21, 0x06, 0xc0, 0xde,
0xba, 0x98, 0xce, 0x3f,
0xa6, 0x92, 0xe3, 0x9d,
0x46, 0xf2, 0xed, 0x01,
0x76, 0xe3, 0xcc, 0x08,
0x56, 0x23, 0x63, 0xfa,
0xca, 0xd4, 0xec, 0xdf,
0x9a, 0x62, 0x78, 0x34,
0x8f, 0x6d, 0x63, 0x3c,
0xfe, 0x22, 0xca, 0x92,
0x20, 0x88, 0x97, 0x23,
0xd2, 0xcf, 0xae, 0xc2,
0x32, 0x67, 0x8d, 0xfe,
0xca, 0x83, 0x64, 0x98,
0xac, 0xfd, 0x3e, 0x37,
0x87, 0x46, 0x58, 0x24,
};
/* IPL によってメインメモリ上に展開される情報のアドレス定義 */
#define IPL_PARAM_DOWNLOAD_PARAMETER 0x023fe904
#define IPL_PARAM_CARD_ROM_HEADER 0x023fe940
/*---------------------------------------------------------------------------*
Name: ShakeHand
Description: ARM9 の ShakeHand 関数と同期を取る。
メインメモリでないメモリ空間で実行される必要がある。
Arguments: r0 - ARM9 同期用変数へのポインタ。
r1 - ARM7 同期用変数へのポインタ。
Returns: なし。
*---------------------------------------------------------------------------*/
static const u32 microcode_ShakeHand[10] =
{
0xe1d020b0, /* ldrh r2, [r0] ; 同期変数９を共有メモリから読む */
0xe1d130b0, /* ldrh r3, [r1] ; 同期変数７を共有メモリから読む */
0xe2833001, /* @1: add r3, r3, #1 ; 同期変数７ ++ */
0xe1c130b0, /* strh r3, [r1] ; 同期変数７を共有メモリに書く */
0xe1d0c0b0, /* ldrh r12, [r0] ; 同期変数９の現状を共有メモリから読む */
0xe152000c, /* cmp r2, r12 ; 同期変数９の変化を判定する */
0x0afffffa, /* beq @1 ; 変化していなければループ */
0xe2833001, /* add r3, r3, #1 ; 同期変数７ ++ */
0xe1c130b0, /* strh r3, [r1] ; 同期変数７を共有メモリに書く */
0xe12fff1e /* bx lr ; ハンドシェイク完了 */
};
#ifdef DEBUG_WRAM_SETTING
/*---------------------------------------------------------------------------*
Name: WaitAgreement
Description: ARM9 の起動ベクタが特定の状態になるまで待つ。
メインメモリでないメモリ空間で実行される必要がある。
Arguments: r0 - 同期用フェーズ管理変数へのポインタ。
r1 - 待機するフェーズ番号。
Returns: なし。
*---------------------------------------------------------------------------*/
static const u32 microcode_WaitAgreement[7] =
{
0xe1d020b0, /* @1: ldrh r2, [r0] ; フェーズ管理変数を共有メモリから読む */
0xe1510002, /* cmp r1, r2 ; 待機フェーズ番号と比較 */
0x012fff1e, /* bxeq lr ; 一致していれば待機完了 */
0xe3a03010, /* mov r3, #16 ; 空ループ回数初期化 */
0xe2533001, /* @2: subs r3, r3, #1 ; 空ループ回数 -- */
0x1afffffd, /* bne @2 ; 16 回ループ */
0xeafffff8 /* b @1 ; 先頭に戻る */
};
#endif
/*---------------------------------------------------------------------------*
Name: GotoMain
Description: ARM9 に特定の状態になったことを伝えた上で、Main 関数へジャンプ
する。メインメモリでないメモリ空間で実行される必要がある。
Arguments: r0 - Main 関数のポインタ。Main 関数が Thumb コードである場合
には、bx 命令でジャンプするため最下位ビットが 1 になって
いる必要がある。
r1 - 同期用フェーズ管理変数へのポインタ。
r2 - ARM9 に伝えるフェーズ番号。
Returns: なし。
*---------------------------------------------------------------------------*/
static const u32 microcode_GotoMain[2] =
{
0xe1c120b0, /* strh r2, [r1] ; フェーズ管理変数を更新 */
0xe12fff10 /* bx r0 ; Main 関数へジャンプ */
};
/*---------------------------------------------------------------------------*/
#include <twl/code32.h>
/*---------------------------------------------------------------------------*
Name: _start
Description: 起動ベクタ。
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
SDK_WEAK_SYMBOL asm void
_start(void)
{
@000:
/* 割り込み禁止 */
mov r12, #HW_REG_BASE
str r12, [r12, #REG_IME_OFFSET] // Use that LSB of HW_REG_BASE is 0b0
/* ハンドシェイク用マイクロコードを専用 WRAM にコピー */
ldr r1, =microcode_ShakeHand
ldr r2, =HW_PRV_WRAM
add r3, r2, #40
@001: ldr r0, [r1], #4
str r0, [r2], #4
cmp r2, r3
blt @001
/* 専用 WRAM 上のコードで ARM9 とハンドシェイク */
ldr r0, =HW_BOOT_SHAKEHAND_9
ldr r1, =HW_BOOT_SHAKEHAND_7
ldr r2, =HW_PRV_WRAM
mov lr, pc
bx r2
// ロードされたアプリのダイジェストを計算してアプリ間パラメータに格納
bl INITi_SetHMACSHA1ToAppParam
@010:
/* スタックポインタ設定 */
mov r0, #HW_PSR_SVC_MODE // SuperVisor mode
msr cpsr_c, r0
ldr sp, =HW_PRV_WRAM_SVC_STACK_END
mov r0, #HW_PSR_IRQ_MODE // IRQ mode
msr cpsr_c, r0
ldr sp, =HW_PRV_WRAM_IRQ_STACK_END
ldr r1, =SDK_IRQ_STACKSIZE
sub r1, sp, r1
sub sp, sp, #4 // 4 bytes for stack check code
mov r0, #HW_PSR_SYS_MODE // System mode
msr cpsr_csfx, r0
sub sp, r1, #4 // 4 bytes for stack check code
/* スタック領域をクリア */
ldr r0, =SDK_SYS_STACKSIZE
sub r1, r1, r0
ldr r2, =HW_PRV_WRAM_IRQ_STACK_END
mov r0, #0
@011: cmp r1, r2
strlt r0, [r1], #4
blt @011
/* SCFG を HW_SYS_CONF_BUF へコピー */
bl INIT_InitializeScfg
bl INITi_CopySysConfig
/* TWL ハードウェア上で動作しているかどうかを調査 */
bl INITi_IsRunOnTwl
bne @013
/* TWL ハードウェア上で動作している場合 */
/* プリロードパラメータアドレスが格納されていない場合は、デフォルト値をセット */
ldr r0, =HW_PRELOAD_PARAMETER_ADDR
ldr r1, [r0]
cmp r1, #0
ldreq r1, =HW_PARAM_TWL_SETTINGS_DATA_DEFAULT
streq r1, [r0]
b @020
@013: /* NTR ハードウェア上で動作している場合 */
/* ブートタイプが MB の場合のみ、ROM ヘッダ情報を所定位置にコピー */
ldr r0, =HW_WM_BOOT_BUF
ldrh r0, [r0]
cmp r0, #OS_BOOTTYPE_DOWNLOAD_MB
bne @020
/* カードの ROM ヘッダ情報を共有エリアに退避 */
ldr r0, =HW_CARD_ROM_HEADER
ldr r1, =IPL_PARAM_CARD_ROM_HEADER
mov r2, #HW_CARD_ROM_HEADER_SIZE
bl INITi_Copy32
/* ダウンロードパラメータ情報を共有エリアに退避 */
ldr r0, =HW_DOWNLOAD_PARAMETER
ldr r1, =IPL_PARAM_DOWNLOAD_PARAMETER
mov r2, #HW_DOWNLOAD_PARAMETER_SIZE
bl INITi_Copy32
@020:
/* Autoload を実施 */
bl INITi_DoAutoload
/* STATIC ブロックの .bss セクションを 0 クリア */
mov r1, #0 // r1 = clear value for STATIC bss section
ldr r3, =_start_ModuleParams
ldr r0, [r3, #12] // r0 = start address of STATIC bss section
ldr r2, [r3, #16]
subs r2, r2, r0 // r2 = size of STATIC bss section
blgt INITi_Fill32
//---- detect main memory size
bl INITi_DetectMainMemorySize
#ifndef SDK_FINALROM
//---- set debug print window
ldr r1, =HW_PRINT_OUTPUT_ARM9
mov r0, #OS_PRINT_OUTPUT_DEFAULT_ARM9
orr r0, r0, #(OS_PRINT_OUTPUT_DEFAULT_ARM7<<8)
strh r0, [r1]
mov r0, #OS_PRINT_OUTPUT_DEFAULT_ARM9ERR
orr r0, r0, #(OS_PRINT_OUTPUT_DEFAULT_ARM7ERR<<8)
strh r0, [r1, #2]
#endif
/* 割り込みベクタ設定 */
ldr r1, =HW_INTR_VECTOR_BUF
ldr r0, =OS_IrqHandler
str r0, [r1]
#ifndef SDK_NOINIT
/* c++ 用初期化 */
bl _fp_init
bl TwlSpStartUp
bl __call_static_initializers
bl INITi_CallStaticInitializers
#endif
@030:
/* Main 関数へのジャンプ用マイクロコードをスタックの底にコピー */
ldr r1, =microcode_GotoMain
ldr r0, [r1], #4
str r0, [sp, #-4]
ldr r0, [r1]
str r0, [sp]
/* マイクロコードを経由して Main 関数へジャンプ */
ldr r0, =TwlSpMain
ldr r1, =HW_BOOT_SYNC_PHASE
mov r2, #BOOT_SYNC_PHASE_4
ldr lr, =HW_RESET_VECTOR
sub r3, sp, #4
bx r3
}
#include <nitro/mi/stream.h>
#include <twl/os/common/systemCall.h>
#include <nitro/mi.h>
/*---------------------------------------------------------------------------*
Name: INITi_SetHMACSHA1ToAppParam
Description: ROMがロードされた各アプリ領域のHMACSHA1を計算し、特定のアドレ
スに保存
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
#define UNDEF_CODE 0xe7ffdeff
#define ENCRYPT_DEF_SIZE 0x800
#define DGT_TGT_ADDR ( HW_MAIN_MEM + 0x0100 )
static void INITi_SetHMACSHA1ToAppParam(void)
{
SVCHMACSHA1Context *pCon = ( SVCHMACSHA1Context * ) (0x2000300 - sizeof(SVCHMACSHA1Context));
ROM_Header_Short *pROMH = (ROM_Header_Short *)HW_TWL_ROM_HEADER_BUF;
u32 bak;
// arm9_flx
bak = *(u32 *)pROMH->main_autoload_done;
*(u32 *)pROMH->main_autoload_done = 0xE12FFF1E;
SVC_HMACSHA1Init(pCon, (void *)s_digestDefaultKey, DIGEST_HASH_BLOCK_SIZE_SHA1);
SVC_HMACSHA1Update(pCon, pROMH->main_ram_address, pROMH->main_size);
SVC_HMACSHA1GetHash(pCon, (void *)DGT_TGT_ADDR);
*(u32 *)pROMH->main_autoload_done = bak;
// arm7_flx
bak = *(u32 *)pROMH->sub_autoload_done;
*(u32 *)pROMH->sub_autoload_done = 0xE12FFF1E;
SVC_HMACSHA1Init(pCon, (void *)s_digestDefaultKey, DIGEST_HASH_BLOCK_SIZE_SHA1);
SVC_HMACSHA1Update(pCon, pROMH->sub_ram_address, pROMH->sub_size);
SVC_HMACSHA1GetHash(pCon, (void *)(DGT_TGT_ADDR + 32));
*(u32 *)pROMH->sub_autoload_done = bak;
// arm9_ltd
SVC_HMACSHA1Init(pCon, (void *)s_digestDefaultKey, DIGEST_HASH_BLOCK_SIZE_SHA1);
SVC_HMACSHA1Update(pCon, pROMH->main_ltd_ram_address, pROMH->main_ltd_size);
SVC_HMACSHA1GetHash(pCon, (void *)(DGT_TGT_ADDR + 2 * 32));
// arm7_ltd
SVC_HMACSHA1Init(pCon, (void *)s_digestDefaultKey, DIGEST_HASH_BLOCK_SIZE_SHA1);
SVC_HMACSHA1Update(pCon, pROMH->sub_ltd_ram_address, pROMH->sub_ltd_size);
SVC_HMACSHA1GetHash(pCon, (void *)(DGT_TGT_ADDR + 3 * 32));
}
/*---------------------------------------------------------------------------*
Name: INITi_DoAutoload
Description: リンク情報に沿って、各オートロードブロックの固定データ部の展開
及び変数部の 0 クリアを行う。
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
/*
* < 二段階オートロード >
* 0x02380000 に crt0 及び一段目ロード元バイナリが配置されている。
* NITRO と共有可能な WRAM 上に配置されるべきバイナリデータを 0x037f8000 にロードする。
* NITRO と共有可能な MAIN 上に配置されるべきバイナリデータを 0x02fe0000 にロードする。
* NITRO と共有可能な VRAM 上に配置されるべきバイナリデータがある場合は WVR ライブラリのローダ関数を呼び出す。
* 0x02400000 に ARM9 の二段目ロード元バイナリが配置されている。
* 0x04000 バイト分はカード ROM から再読み出し不可なので、0x02f80000 - 0x02f84000 に退避する。
* 0x02e80000 に二段目ロード元バイナリが配置されている。
* 0x04000 バイト分はカード ROM から再読み出し不可なので、0x02f84000 - 0x02f88000 に退避する。
* TWL でしか動作しない WRAM 上に配置されるべきバイナリデータを 0x03000000 にロードする。
* TWL でしか動作しない MAIN 上に配置されるべきバイナリデータを 0x02f88000 にロードする。
*/
static asm void
INITi_DoAutoload(void)
{
stmfd sp!, {lr}
@01_autoload:
/* NITRO 共用ブロックをオートロード */
ldr r0, =_start_ModuleParams
ldr r12, [r0] // r12 = SDK_AUTOLOAD_LIST
ldr r3, [r0, #4] // r3 = SDK_AUTOLOAD_LIST_END
ldr r1, [r0, #8] // r1 = SDK_AUTOLOAD_START
@01_segments_loop:
cmp r12, r3
bge @02_start
/* VRAM へのオートロードブロックかどうかを調査 */
ldr r0, [r12], #4 // r0 = start address of destination range of fixed section
ldr r2, =HW_EXT_WRAM
cmp r0, r2
beq @01_shelter_vram_segment
/* 固定セクション */
ldr r2, [r12], #4 // r2 = size of fixed section
bl INITi_Copy32
stmfd sp!, {r0, r1}
/* static initializer テーブル */
ldr r0, [r12], #4 // r0 = start address of source range of static initializers table
#ifndef SDK_NOINIT
stmfd sp!, {r3, r12}
bl INITi_ShelterStaticInitializer
ldmfd sp!, {r3, r12}
#endif
/* bss セクション */
ldmfd sp!, {r0} // r0 = start address of destination range of bss section
mov r1, #0 // r1 = clear value for bss section
ldr r2, [r12], #4 // r2 = size of bss section
bl INITi_Fill32
ldmfd sp!, {r1} // r1 = end address of source range of the autoload segment
b @01_segments_loop
@01_shelter_vram_segment:
ldr r2, [r12], #12 // r2 = size of fixed section
add r1, r1, r2 // r1 = end address of source range of the autoload segment
/* VRAM へのオートロードブロックをバックアップ */
stmfd sp!, {r1, r3, r12}
bl WVR_ShelterExtWram
ldmfd sp!, {r1, r3, r12}
b @01_segments_loop
@02_start:
/* TWL ハードウェア上で動作しているかどうか調査 */
bl INITi_IsRunOnTwl
bne @03_start
/* 再読み出し不可部分を退避 */
bl INITi_ShelterLtdBinary
/* TWL 専用オートロードブロックの存在を確認 */
ldr r1, =HW_TWL_ROM_HEADER_BUF
ldr r0, [r1, #ROM_Header.s.sub_ltd_size]
cmp r0, #0
beq @03_start
@02_autoload:
/* TWL 専用ブロックをオートロード */
ldr r0, =_start_LtdModuleParams
ldr r12, [r0] // r12 = SDK_LTDAUTOLOAD_LIST
ldr r3, [r0, #4] // r3 = SDK_LTDAUTOLOAD_LIST_END
ldr r1, [r0, #8] // r1 = SDK_LTDAUTOLOAD_START
@02_segments_loop:
cmp r12, r3
bge @03_start
/* 固定セクション */
ldr r0, [r12], #4 // r0 = start address of destination range of fixed section
ldr r2, [r12], #4 // r2 = size of fixed section
bl INITi_Copy32
stmfd sp!, {r0, r1}
/* static initializer テーブル */
ldr r0, [r12], #4
#ifndef SDK_NOINIT
stmfd sp!, {r3, r12}
bl INITi_ShelterStaticInitializer
ldmfd sp!, {r3, r12}
#endif
/* bss セクション */
ldmfd sp!, {r0} // r0 = start address of destination range of bss section
mov r1, #0 // r1 = clear value for bss section
ldr r2, [r12], #4 // r2 = size of bss section
bl INITi_Fill32
ldmfd sp!, {r1} // r1 = end address of source range of the ltdautoload segment
b @02_segments_loop
@03_start:
/* オートロード完了コールバック関数呼び出し */
ldr r0, =_start_ModuleParams
ldr r1, =_start_LtdModuleParams
ldmfd sp!, {lr}
b _start_AutoloadDoneCallback
}
/*---------------------------------------------------------------------------*
Name: INITi_ShelterLtdBinary
Description: TWL 専用のオートロード元バイナリデータの内、カード ROM から
再読み出しできない領域のデータを退避エリアに退避する。
再読み出しできない領域のデータは ARM7 用と ARM9 用の拡張常駐
モジュールの２つに分かれている可能性があるので、冗長ではあるが
両方の先頭から 0x4000 分をそれぞれ退避する。
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
static asm void
INITi_ShelterLtdBinary(void)
{
stmfd sp!, {lr}
/* NAND からブートした場合には退避するデータの使い道がない為、処理をスキップ */
ldr r3, =HW_TWL_ROM_HEADER_BUF
ldr r0, [r3, #ROM_Header.s.titleID_Hi]
tst r0, #TITLE_ID_HI_MEDIA_MASK
ldmnefd sp!, {pc}
@shelter_arm7_ltdautoload_src:
/* ARM7 用拡張常駐モジュールの存在を確認 */
ldr r1, [r3, #ROM_Header.s.sub_ltd_size]
cmp r1, #0
beq @shelter_arm9_ltdautoload_src
/* ARM7 用拡張常駐モジュールの先頭 16K bytes を退避 */
ldr r1, [r3, #ROM_Header.s.sub_ltd_ram_address]
ldr r0, =_start_LtdMainParams
ldr r0, [r0]
mov r2, #0x4000 // r2 = size of shelter buffer
sub r0, r0, r2 // r0 = SDK_LTDAUTOLOAD_LTDMAIN_START - 0x4000
bl INITi_Copy32
@shelter_arm9_ltdautoload_src:
/* ARM9 用拡張常駐モジュールの存在を確認 */
ldr r3, =HW_TWL_ROM_HEADER_BUF
ldr r1, [r3, #ROM_Header.s.main_ltd_size]
cmp r1, #0
beq @end
/* ARM9 用拡張常駐モジュールの先頭 16K bytes を退避 */
ldr r1, [r3, #ROM_Header.s.main_ltd_ram_address]
ldr r0, =_start_LtdMainParams
ldr r0, [r0]
mov r2, #0x4000 // r2 = size of shelter buffer
sub r0, r0, r2
sub r0, r0, r2 // r0 = SDK_LTDAUTOLOAD_LTDMAIN_START - 0x8000
bl INITi_Copy32
@end:
ldmfd sp!, {pc}
}
#ifndef SDK_NOINIT
/*---------------------------------------------------------------------------*
Name: INITi_ShelterStaticInitializer
Description: 各オートロードセグメント内の static initializer へのポインタ
テーブルを IRQ スタックの最上部に退避する。
Arguments: ptr - セグメント内のポインタテーブルへのポインタ。
テーブルは NULL で終端されている必要がある。
Returns: なし。
*---------------------------------------------------------------------------*/
static asm void
INITi_ShelterStaticInitializer(u32* ptr)
{
/* 引数確認 */
cmp r0, #0
bxeq lr
/* 退避場所先頭アドレスを計算 */
ldr r1, =HW_PRV_WRAM_IRQ_STACK_END
ldr r2, =SDK_IRQ_STACKSIZE
sub r1, r1, r2
add r1, r1, #4
/* 退避場所先頭から空き場所を調査 */
@001: ldr r2, [r1]
cmp r2, #0
addne r1, r1, #4
bne @001
/* 空き場所にテーブルをコピー */
@002: ldr r2, [r0], #4
str r2, [r1], #4
cmp r2, #0
bne @002
bx lr
}
/*---------------------------------------------------------------------------*
Name: INITi_CallStaticInitializers
Description: 各オートロードセグメント内の static initializer を呼び出す。
オートロード処理によって IRQ スタックの最上部に退避されている
関数ポインタテーブルを一つずつ呼び出す。
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
static asm void
INITi_CallStaticInitializers(void)
{
stmdb sp!, {lr}
/* テーブル退避場所先頭アドレスを計算 */
ldr r1, =HW_PRV_WRAM_IRQ_STACK_END
ldr r2, =SDK_IRQ_STACKSIZE
sub r1, r1, r2
add r1, r1, #4
/* テーブルに管理されているポインタを一つずつ呼び出し */
@001: ldr r0, [r1]
cmp r0, #0
beq @002
stmdb sp!, {r1}
mov lr, pc
bx r0
ldmia sp!, {r1}
/* 一旦呼び出したポインタはゼロクリア (IRQスタックを間借りしている為) */
mov r0, #0
str r0, [r1], #4
b @001
@002: ldmia sp!, {lr}
bx lr
}
#endif
/*---------------------------------------------------------------------------*
Name: _start_AutoloadDoneCallback
Description: オートロード完了コールバック。
Arguments: argv - オートロードパラメータを保持している配列。
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: なし。
*---------------------------------------------------------------------------*/
SDK_WEAK_SYMBOL asm void
_start_AutoloadDoneCallback(void* argv[])
{
bx lr
}
/*---------------------------------------------------------------------------*
Name: NitroSpStartUp
Description: Hook for user start up.
Arguments: None.
Returns: None.
*---------------------------------------------------------------------------*/
SDK_WEAK_SYMBOL void
NitroSpStartUp(void)
{
}
/*---------------------------------------------------------------------------*
Name: INITi_IsRunOnTwl
Description: check running platform
This function is used in only Nitro-TWL hybrid mode.
(In Nitro mode and TWL limited mode, treated as constant)
Arguments: None
Returns: TRUE : running on TWL
FALSE : running on NITRO
*---------------------------------------------------------------------------*/
static asm BOOL INITi_IsRunOnTwl( void )
{
ldr r0, =HW_PRV_WRAM_SYSRV
ldrb r0, [r0,#HWi_WSYS08_WRAMOFFSET]
and r0, r0, #HWi_WSYS08_ROM_ARM9SEC_MASK | HWi_WSYS08_ROM_ARM9RSEL_MASK
cmp r0, #HWi_WSYS08_ROM_ARM9SEC_MASK
moveq r0, #TRUE
movne r0, #FALSE
bx lr
}
/*---------------------------------------------------------------------------*
Name: INIT_InitializeScfg
Description: ローダーが行う SCFG ブロックへの設定処理を代行する為の関数。
処理の実体は crt0 の外部に定義するため、弱シンボルとする。
Arguments: None.
Returns: None.
*---------------------------------------------------------------------------*/
SDK_WEAK_SYMBOL asm void
INIT_InitializeScfg(void)
{
bx lr
}
/*---------------------------------------------------------------------------*
Name: INITi_CopySysConfig
Description: copy SCFG registers to HW_SYS_CONF_BUF and HW_PRV_WRAM_SYSRV
Arguments: None.
Returns: None.
*---------------------------------------------------------------------------*/
static asm void INITi_CopySysConfig( void )
{
//---- copy scfg setting
ldr r2, =HW_PRV_WRAM_SYSRV
ldr r3, =HW_SYS_CONF_BUF
ldr r0, [r2, #HWi_WSYS04_WRAMOFFSET]
str r0, [r3, #HWi_WSYS04_OFFSET]
ldrh r0, [r2, #HWi_WSYS08_WRAMOFFSET]
strh r0, [r3, #HWi_WSYS08_OFFSET]
bx lr
}
/*---------------------------------------------------------------------------*
Name: INITi_DetectMainMemorySize
Description: detect main memory size.
result is written into (u32*)HW_MMEMCHECKER_SUB.
value is [OS_CONSOLE_SIZE_4MB|OS_CONSOLE_SIZE_8MB|
OS_CONSOLE_SIZE_16MB|OS_CONSOLE_SIZE_32MB]
Arguments: None.
Returns: None.
*---------------------------------------------------------------------------*/
#define OSi_IMAGE_DIFFERENCE 0x400000
#define OSi_IMAGE_DIFFERENCE2 0xb000000
#define OSi_DETECT_NITRO_MASK (REG_SND_SMX_CNT_E_MASK | REG_SND_SMX_CNT_FSEL_MASK)
#define OSi_DETECT_NITRO_VAL (REG_SND_SMX_CNT_E_MASK)
#define OSi_CHECKNUM1 0x55
#define OSi_CHECKNUM2 0xaa
#define OSi_100usWAIT 3352 // 100us = 3351.4cycles(33.514MHz)
static asm void INITi_DetectMainMemorySize( void )
{
stmfd sp!, {lr}
//---- detect memory size
mov r0, #OS_CONSOLE_SIZE_4MB
mov r1, #0
ldr r2, =HW_MMEMCHECKER_SUB
sub r3, r2, #OSi_IMAGE_DIFFERENCE
@1:
strh r1, [r2]
ldrh r12, [r3]
cmp r1, r12
bne @2
add r1, r1, #1
cmp r1, #2 // check 2 loop
bne @1
//---- 4MB
b @3
//---- 8MB or 16MB or 32MB
@2:
// check if running on twl/nitro
bl INITi_IsRunOnTwl
movne r0, #OS_CONSOLE_SIZE_8MB
bne @3
//---- 16MB or 32MB
add r3, r2, #OSi_IMAGE_DIFFERENCE2
mov r0, #OS_CONSOLE_SIZE_16MB
ldrb r2, [r3]
mov r1, #OSi_CHECKNUM1
strb r1, [r3]
ldr r12, =OSi_100usWAIT
@4 subs r12, r12, #4
bcs @4
ldrb r1, [r3]
cmp r1, #OSi_CHECKNUM1
bne @3
mov r1, #OSi_CHECKNUM2
strb r1, [r3]
ldr r12, =OSi_100usWAIT
@5 subs r12, r12, #4
bcs @5
ldrb r1, [r3]
cmp r1, #OSi_CHECKNUM2
moveq r0, #OS_CONSOLE_SIZE_32MB
@3:
//---- check SMX_CNT
strb r2, [r3]
ldr r3, =REG_SMX_CNT_ADDR
ldrh r1, [r3]
and r1, r1, #OSi_DETECT_NITRO_MASK
cmp r1, #OSi_DETECT_NITRO_VAL
orreq r0, r0, #OS_CHIPTYPE_SMX_MASK
ldr r2, =HW_MMEMCHECKER_SUB
strh r0, [r2]
ldmfd sp!, {lr}
bx lr
}
/*---------------------------------------------------------------------------*
Name: WVR_ShelterExtWram
Description: WVR ライブラリ用に 拡張 WRAM に配置されるオートロードブロックを
メインメモリに退避する関数のダミー。
実際に拡張 WRAM にライブラリを配置する必要のあるコンポーネント
では、当関数の強シンボルが別途リンクされる。
Arguments: なし。
Returns: なし。
*---------------------------------------------------------------------------*/
SDK_WEAK_SYMBOL void
WVR_ShelterExtWram(void)
{
}
/*---------------------------------------------------------------------------*
Name: INITi_Copy32
Description: 可能な限り 32 バイト単位で、半端な分は 4 バイト単位でコピーを
行う。
スタックを 36 バイト消費するが、レジスタ r3 - r12 は破壊しない。
Arguments: r0 - コピー先へのポインタ ( 4 バイトアライン )。
r1 - コピー元へのポインタ ( 4 バイトアライン )。
r2 - コピーする長さをバイト単位で指定 ( 4 の倍数 )。
Returns: r0 - コピー後のコピー先へのポインタ ( r0 + r2 )。
r1 - コピー後のコピー元へのポインタ ( r1 + r2 )。
*---------------------------------------------------------------------------*/
static asm void*
INITi_Copy32(void* dst, void* src, u32 size)
{
stmfd sp!, {r3-r11}
bics r3, r2, #0x0000001f
beq @next
add r3, r0, r3
@loop:
ldmia r1!, {r4-r11}
stmia r0!, {r4-r11}
cmp r3, r0
bgt @loop
@next:
tst r2, #0x00000010
ldmneia r1!, {r4-r7}
stmneia r0!, {r4-r7}
tst r2, #0x00000008
ldmneia r1!, {r4-r5}
stmneia r0!, {r4-r5}
tst r2, #0x00000004
ldmneia r1!, {r4}
stmneia r0!, {r4}
ldmfd sp!, {r3-r11}
bx lr
}
/*---------------------------------------------------------------------------*
Name: INITi_Fill32
Description: 可能な限り 32 バイト単位で、半端な分は 4 バイト単位でバッファ
内容を指定データで埋める。
スタックを 36 バイト消費するが、レジスタ r3 - r12 は破壊しない。
Arguments: r0 - バッファへのポインタ ( 4 バイトアライン )。
r1 - バッファを埋める内容を 32 bit 値で指定。
r2 - バッファを埋める長さをバイト単位で指定 ( 4 の倍数 )。
Returns: r0 - 処理後のバッファへのポインタ ( r0 + r2 )。
*---------------------------------------------------------------------------*/
static asm void*
INITi_Fill32(void* dst, u32 value, u32 size)
{
stmfd sp!, {r3-r11}
mov r4, r1
mov r5, r1
mov r6, r1
mov r7, r1
mov r8, r1
mov r9, r1
mov r10, r1
mov r11, r1
bics r3, r2, #0x0000001f
beq @next
add r3, r0, r3
@loop:
stmia r0!, {r4-r11}
cmp r3, r0
bgt @loop
@next:
tst r2, #0x00000010
stmneia r0!, {r4-r7}
tst r2, #0x00000008
stmneia r0!, {r4-r5}
tst r2, #0x00000004
stmneia r0!, {r4}
ldmfd sp!, {r3-r11}
bx lr
}
#include <twl/codereset.h>
Reference in New Issue View Git Blame Copy Permalink