From e6d27a1aaf6e7d21806bcadad057d02f21e6a154 Mon Sep 17 00:00:00 2001 From: "(no author)" <(no author)@b08762b0-b915-fc4b-9d8c-17b2551a87ff> Date: Wed, 5 Dec 2007 12:58:41 +0000 Subject: [PATCH] =?UTF-8?q?(=E6=9B=B4=E6=96=B0=E8=80=85)akabane=5Fjumpei?= =?UTF-8?q?=20=E3=82=AB=E3=83=BC=E3=83=89=E3=83=87=E3=83=BC=E3=82=BF?= =?UTF-8?q?=E3=81=AEARM9=E5=B8=B8=E9=A7=90=E3=83=A2=E3=82=B8=E3=83=A5?= =?UTF-8?q?=E3=83=BC=E3=83=AB=E5=85=88=E9=A0=AD2KB=E3=81=AE=E6=9A=97?= =?UTF-8?q?=E5=8F=B7=E5=8C=96=E9=A0=98=E5=9F=9F=E3=82=92=E5=BE=A9=E5=8F=B7?= =?UTF-8?q?=E5=8C=96?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@313 b08762b0-b915-fc4b-9d8c-17b2551a87ff --- .../libraries_sysmenu/hotsw/ARM7/src/hotsw.c | 104 ++++++++++++++---- 1 file changed, 84 insertions(+), 20 deletions(-) diff --git a/build/libraries_sysmenu/hotsw/ARM7/src/hotsw.c b/build/libraries_sysmenu/hotsw/ARM7/src/hotsw.c index ebadba14..2251d3fd 100644 --- a/build/libraries_sysmenu/hotsw/ARM7/src/hotsw.c +++ b/build/libraries_sysmenu/hotsw/ARM7/src/hotsw.c @@ -29,6 +29,9 @@ #define DEBUG_CARD_TYPE 1 // DS Card Type1 = 0 DS Card Type2 = 1 +#define UNDEF_CODE 0xe7ffdeff // 未定義コード +#define ENCRYPT_DEF_SIZE 0x800 // 2KB ※ ARM9常駐モジュール先頭2KB + // Function prototype ------------------------------------------------------- static BOOL IsCardExist(void); @@ -49,17 +52,18 @@ static void SetMCSCR(void); static void GenVA_VB_VD(void); static void LoadTable(void); static void ReadIDNormal(void); +static void DecryptObjectFile(void); + static void MIm_CardDmaCopy32(u32 dmaNo, const void *src, void *dest); static void ShowRegisterData(void); static void ShowRomHeaderData(void); // Static Values ------------------------------------------------------------ -static u64 s_MCStack[STACK_SIZE / sizeof(u64)]; -static u64 s_MLStack[STACK_SIZE / sizeof(u64)]; +static char *encrypt_object_key ATTRIBUTE_ALIGN(4) = "encryObj"; +static u64 s_MCStack[STACK_SIZE / sizeof(u64)]; static OSThread s_MCThread; -static OSThread s_MLThread; static u32 s_SecureSegBufSize, s_BootSegBufSize; @@ -128,18 +132,6 @@ void HOTSW_Init(void) // Secure Segment バッファの設定 HOTSW_SetSecureSegmentBuffer((void *)SYSM_CARD_NTR_SECURE_BUF, SECURE_AREA_SIZE ); - // モジュールロード用スレッドの生成 -/* OS_CreateThread(&s_MLThread, - StaticModuleLoadThread, - NULL, - s_MLStack + STACK_SIZE / sizeof(u64), - STACK_SIZE, - ML_THREAD_PRIO - ); - - // モジュールロード用スレッド起動 - OS_WakeupThreadDirect(&s_MLThread);*/ - // カードブート用構造体の初期化 MI_CpuClear32(&s_cbData, sizeof(CardBootData)); @@ -158,6 +150,7 @@ BOOL HOTSW_Boot(void) { s32 tempLockID; BOOL retval = TRUE; + OSTick start = OS_GetTick(); OS_TPrintf("---------------- Card Boot Start ---------------\n"); @@ -254,12 +247,17 @@ BOOL HOTSW_Boot(void) // Arm9の常駐モジュールを指定先に転送 LoadStaticModule_Secure(); + // ゲームモードに移行 s_funcTable[s_cbData.cardType].ChangeMode_S(&s_cbData); // ---------------------- Game Mode ---------------------- // ID読み込み s_funcTable[s_cbData.cardType].ReadID_G(&s_cbData); + + // ARM9常駐モジュールの先頭2KBの暗号化領域を複合化 + DecryptObjectFile(); + // 常駐モジュール残りを指定先に転送 HOTSW_LoadStaticModule(); @@ -288,7 +286,7 @@ BOOL HOTSW_Boot(void) #ifdef DEBUG_USED_CARD_SLOT_B_ SYSMi_GetWork()->is1stCardChecked = TRUE; #endif - + return retval; } @@ -442,15 +440,13 @@ static void LoadTable(void) // MCCNT1 レジスタ設定 (START = 1 W/R = 0 PC = 101(16ページ) latency1 = 0(必要ないけど) に) reg_HOTSW_MCCNT1 = (u32)((reg_HOTSW_MCCNT1 & CNT1_MSK(0,0,1,0, 0,0, 1,0, 0, 0,0,0, 0)) | - CNT1_FLD(1,0,0,0, 0,5, 0,0, 0, 0,0,0, 0)); + CNT1_FLD(1,0,0,0, 0,5, 0,0, 0, 0,0,0, 0)); // MCCNTレジスタのRDYフラグをポーリングして、フラグが立ったらデータをMCD1レジスタに再度セット。スタートフラグが0になるまでループ。 while(reg_HOTSW_MCCNT1 & START_FLG_MASK){ while(!(reg_HOTSW_MCCNT1 & READY_FLG_MASK)){} temp = reg_HOTSW_MCD1; } - - OS_TPrintf("Load Table...\n"); } /* ----------------------------------------------------------------- @@ -469,15 +465,83 @@ static void ReadIDNormal(void) // MCCNT1 レジスタ設定 (START = 1 W/R = 0 PC = 111(ステータスリード) latency1 = 2320(必要ないけど) に) reg_HOTSW_MCCNT1 = (u32)((reg_HOTSW_MCCNT1 & CNT1_MSK(0,0,1,0, 0,0, 1,0, 0, 0,0,0, 0)) | - CNT1_FLD(1,0,0,0, 0,7, 0,0, 0, 0,0,0, 2320)); + CNT1_FLD(1,0,0,0, 0,7, 0,0, 0, 0,0,0, 2320)); // MCCNTレジスタのRDYフラグをポーリングして、フラグが立ったらデータをMCD1レジスタに再度セット。スタートフラグが0になるまでループ。 while(reg_HOTSW_MCCNT1 & START_FLG_MASK){ while(!(reg_HOTSW_MCCNT1 & READY_FLG_MASK)){} s_cbData.id_nml = reg_HOTSW_MCD1; } + } +/* ----------------------------------------------------------------- + * DecryptObjectFile関数 + * + * セキュア領域先頭2KBの暗号化領域を復号化 + * + * 注：セキュアモード中、またはセキュアモード前にこの関数を呼ぶと、 + * 　　正常にコマンドの暗号化が行えなくなります。 + * ----------------------------------------------------------------- */ +static u32 encDestBuf[ENCRYPT_DEF_SIZE/sizeof(u32)]; + +static void DecryptObjectFile(void) +{ + u8 i; + s32 restSize; + s32 size = (s32)s_cbData.pBootSegBuf->rh.s.main_size; + u32 *pEncBuf = encDestBuf; + u32 *pEncDes = s_cbData.pSecureSegBuf; + BLOWFISH_CTX *tableBufp = &s_cbData.keyTable; + BOOL exist = TRUE; + + if (size > ENCRYPT_DEF_SIZE) { + size = ENCRYPT_DEF_SIZE; + } + restSize = size; + + // 読み込んだセキュア領域をバッファから一時バッファにコピー + MI_CpuCopy32(s_cbData.pSecureSegBuf, pEncBuf, (u32)size); + + // セキュア領域先頭8バイトをBlowfishで複合化 + DecryptByBlowfish(&s_cbData.keyTable, &(pEncBuf)[1], &(pEncBuf)[0]); + + // Key Tableを変換 + s_cbData.keyBuf[1] = (s_cbData.keyBuf[1] << 1); + s_cbData.keyBuf[2] = (s_cbData.keyBuf[2] >> 1); + InitBlowfishKeyAndTableDS(&s_cbData.keyTable, s_cbData.keyBuf, 8); + + // もう一度セキュア領域先頭8バイトをBlowfishで複合化 + DecryptByBlowfish(&s_cbData.keyTable, &(pEncBuf)[1], &(pEncBuf)[0]); + for ( i=0; i<8; i++ ){ + // 先頭8バイトが複合化の結果 "encryObj" となっていたら複合化成功 + if ( encrypt_object_key[i] != ((char*)pEncBuf)[i] ){ + exist = FALSE; + break; + } + } + + // 暗号化オブジェクト有効時 + if ( exist ){ + u32 *bufp = pEncBuf; + + OS_PutString("★ DecryptObjectFile : Success!\n"); + + bufp[0] = UNDEF_CODE; + bufp[1] = UNDEF_CODE; + while ((restSize -= 8) > 0) { + bufp += 2; // 復号処理 + DecryptByBlowfish(tableBufp, &(bufp)[1], &(bufp)[0]); + } + } + else{ + OS_PutString("▼ DecryptObjectFile : Error...\n"); + // CpuClearFast32(UNDEF_CODE, pEncBuf, size); // 未定義コードでクリア + } + MI_CpuCopy32(pEncBuf, pEncDes, (u32)size); +} + + /* ----------------------------------------------------------------- * IsCardExist関数 *