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

(更新:Akabane Jumpei)

Browse Source 
・挿抜処理を行うスレッドを修正

git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@765 b08762b0-b915-fc4b-9d8c-17b2551a87ff
This commit is contained in:
(no author) 2008-02-28 08:46:24 +00:00
parent 5053ca0b24
commit 10e5c6a167
2 changed files with 108 additions and 49 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
build/libraries_sysmenu/hotsw/ARM7/include/hotswTypes.h
View File

@ -196,7 +196,7 @@ typedef enum HotSwState{
HOTSW_HASH_CHECK_ERROR, HOTSW_HASH_CHECK_ERROR,
HOTSW_ID_CHECK_ERROR, HOTSW_ID_CHECK_ERROR,
HOTSW_PULLED_OUT_ERROR, HOTSW_PULLED_OUT_ERROR,
HOTSW_INSERT_COUNT_ERROR, HOTSW_DATA_DECRYPT_ERROR,
HOTSW_UNEXPECTED_ERROR HOTSW_UNEXPECTED_ERROR
} HotSwState; } HotSwState;

155
build/libraries_sysmenu/hotsw/ARM7/src/hotsw.c
View File

@ -26,7 +26,7 @@
#define DEBUG_MODE #define DEBUG_MODE
// define ------------------------------------------------------------------- // define -------------------------------------------------------------------
#define CHATTERING_COUNTER 0x100 #define CHATTERING_COUNTER 0x600
#define COUNTER_A 0x100 #define COUNTER_A 0x100
#define UNDEF_CODE 0xe7ffdeff // 未定義コード #define UNDEF_CODE 0xe7ffdeff // 未定義コード
@ -38,11 +38,11 @@
#define ROM_EMULATION_END_OFS 0x180 #define ROM_EMULATION_END_OFS 0x180
#define HOTSW_THREAD_STACK_SIZE (1024 + PAGE_SIZE) // スタックサイズ #define HOTSW_THREAD_STACK_SIZE (1024 + PAGE_SIZE) // スタックサイズ
#define HOTSW_THREAD_PRIO 11 // カード電源ON → ゲームモードのスレッド優先度 #define HOTSW_THREAD_PRIO 11 // カード電源ON → ゲームモードのスレッド優先度
#define HOTSW_MSG_BUFFER_NUM 40 // 受信バッファの数 #define HOTSW_INSERT_MSG_NUM 16 // 挿し割り込み送信メッセージの数
#define HOTSW_INSERT_MSG_NUM 16 // 挿し割り込み送信メッセージの数 #define HOTSW_PULLED_MSG_NUM 16 // 抜け割り込み送信メッセージの数
#define HOTSW_PULLED_MSG_NUM 16 // 抜け割り込み送信メッセージの数 #define HOTSW_CTRL_MSG_NUM 8 // PXI割り込み送信メッセージの数
#define HOTSW_CTRL_MSG_NUM 8 // PXI割り込み送信メッセージの数 #define HOTSW_MSG_BUFFER_NUM (HOTSW_INSERT_MSG_NUM + HOTSW_PULLED_MSG_NUM + HOTSW_CTRL_MSG_NUM) // 受信バッファの数
#define SLOT_B_LOCK_BUF HW_CTRDG_LOCK_BUF #define SLOT_B_LOCK_BUF HW_CTRDG_LOCK_BUF
@ -99,7 +99,7 @@ static void McPowerOff(void);
static void SetMCSCR(void); static void SetMCSCR(void);
static void GenVA_VB_VD(void); static void GenVA_VB_VD(void);
static void DecryptObjectFile(void); static HotSwState DecryptObjectFile(void);
static HotSwState LoadTable(void); static HotSwState LoadTable(void);
static HotSwState ReadRomEmulationData(void); static HotSwState ReadRomEmulationData(void);
static HotSwState ReadIDNormal(void); static HotSwState ReadIDNormal(void);
@ -120,6 +120,7 @@ static BOOL CheckExtArm9HashValue(void);
static void ShowRegisterData(void); static void ShowRegisterData(void);
static void ShowRomHeaderData(void); static void ShowRomHeaderData(void);
static void DebugPrintErrorMessage(HotSwState state);
// Static Values ------------------------------------------------------------ // Static Values ------------------------------------------------------------
static char *encrypt_object_key ATTRIBUTE_ALIGN(4) = "encryObj"; static char *encrypt_object_key ATTRIBUTE_ALIGN(4) = "encryObj";
@ -258,7 +259,6 @@ void HOTSW_Init(void)
// Secure Segment バッファの設定 // Secure Segment バッファの設定
HOTSW_SetSecureSegmentBuffer((void *)SYSM_CARD_NTR_SECURE_BUF, SECURE_AREA_SIZE ); HOTSW_SetSecureSegmentBuffer((void *)SYSM_CARD_NTR_SECURE_BUF, SECURE_AREA_SIZE );
// カードが挿さってあったらスレッドを起動する // カードが挿さってあったらスレッドを起動する
if(HOTSW_IsCardExist()){ if(HOTSW_IsCardExist()){
// メッセージ送信 // メッセージ送信
@ -439,7 +439,7 @@ static HotSwState LoadCardData(void)
// カードIDの比較をして、一致しなければFALSEを返す // カードIDの比較をして、一致しなければFALSEを返す
if(s_cbData.id_scr != s_cbData.id_gam){ if(s_cbData.id_scr != s_cbData.id_gam){
retval = (retval == HOTSW_SUCCESS) ? HOTSW_ID_CHECK_ERROR : retval; retval = (retval == HOTSW_SUCCESS) ? HOTSW_ID_CHECK_ERROR : retval;
goto error; goto end;
} }
// 常駐モジュール残りを指定先に転送 // 常駐モジュール残りを指定先に転送
@ -447,7 +447,8 @@ static HotSwState LoadCardData(void)
retval = (retval == HOTSW_SUCCESS) ? state : retval; retval = (retval == HOTSW_SUCCESS) ? state : retval;
// ARM9常駐モジュールの先頭2KBの暗号化領域を複合化 // ARM9常駐モジュールの先頭2KBの暗号化領域を複合化
DecryptObjectFile(); state = DecryptObjectFile();
retval = (retval == HOTSW_SUCCESS) ? state : retval;
// 認証コード読み込み＆ワーク領域にコピー // 認証コード読み込み＆ワーク領域にコピー
state = CheckCardAuthCode(); state = CheckCardAuthCode();
@ -464,11 +465,7 @@ static HotSwState LoadCardData(void)
retval = (retval == HOTSW_SUCCESS) ? HOTSW_PULLED_OUT_ERROR : retval; retval = (retval == HOTSW_SUCCESS) ? HOTSW_PULLED_OUT_ERROR : retval;
} }
goto end;
error:
OS_TPrintf("ng... retval : %d\n", retval);
end: end:
// カードのロック開放(※ロックIDは開放せずに持ち続ける) // カードのロック開放(※ロックIDは開放せずに持ち続ける)
#ifndef DEBUG_USED_CARD_SLOT_B_ #ifndef DEBUG_USED_CARD_SLOT_B_
CARD_UnlockRom(s_CardLockID); CARD_UnlockRom(s_CardLockID);
@ -756,7 +753,7 @@ static void GenVA_VB_VD(void)
* カード側の Key Table をロードする関数。 * カード側の Key Table をロードする関数。
* *
* ※この関数は開発カード用に発行しないといけない。 * ※この関数は開発カード用に発行しないといけない。
* 製品版カードの場合、このコマンドは無視される設計 * 製品版カードの場合、このコマンドは無視される
* ----------------------------------------------------------------- */ * ----------------------------------------------------------------- */
static HotSwState LoadTable(void) static HotSwState LoadTable(void)
{ {
@ -858,7 +855,7 @@ static HotSwState ReadIDNormal(void)
* ----------------------------------------------------------------- */ * ----------------------------------------------------------------- */
static u32 encDestBuf[ENCRYPT_DEF_SIZE/sizeof(u32)]; static u32 encDestBuf[ENCRYPT_DEF_SIZE/sizeof(u32)];
static void DecryptObjectFile(void) static HotSwState DecryptObjectFile(void)
{ {
u8 i; u8 i;
s32 restSize; s32 restSize;
@ -867,6 +864,7 @@ static void DecryptObjectFile(void)
u32 *pEncDes = s_cbData.pSecureSegBuf; u32 *pEncDes = s_cbData.pSecureSegBuf;
BLOWFISH_CTX *tableBufp = &s_cbData.keyTable; BLOWFISH_CTX *tableBufp = &s_cbData.keyTable;
BOOL exist = TRUE; BOOL exist = TRUE;
HotSwState retval = HOTSW_SUCCESS;
if (size > ENCRYPT_DEF_SIZE) { if (size > ENCRYPT_DEF_SIZE) {
size = ENCRYPT_DEF_SIZE; size = ENCRYPT_DEF_SIZE;
@ -906,11 +904,13 @@ static void DecryptObjectFile(void)
} }
} }
else{ else{
OS_PutString("▼ DecryptObjectFile : Error...\n"); retval = HOTSW_DATA_DECRYPT_ERROR;
MI_NDmaFill( HOTSW_DMA_NO, pEncBuf, UNDEF_CODE, (u32)size ); // 未定義コードでクリア MI_NDmaFill( HOTSW_DMA_NO, pEncBuf, UNDEF_CODE, (u32)size ); // 未定義コードでクリア
} }
MI_CpuCopy32(pEncBuf, pEncDes, (u32)size); MI_CpuCopy32(pEncBuf, pEncDes, (u32)size);
return retval;
} }
/* ----------------------------------------------------------------- /* -----------------------------------------------------------------
@ -1149,7 +1149,6 @@ static void McThread(void *arg)
{ {
#pragma unused( arg ) #pragma unused( arg )
u32 hotswCount = UNDEF_CODE;
BOOL isPulledOut = TRUE; BOOL isPulledOut = TRUE;
HotSwState retval; HotSwState retval;
HotSwMessage *msg; HotSwMessage *msg;
@ -1157,8 +1156,6 @@ static void McThread(void *arg)
while(1){ while(1){
OS_ReceiveMessage(&s_ctData.hotswQueue, (OSMessage *)&msg, OS_MESSAGE_BLOCK); OS_ReceiveMessage(&s_ctData.hotswQueue, (OSMessage *)&msg, OS_MESSAGE_BLOCK);
// OS_TPrintf("msg -> value : %x msg -> ctrl : %x msg -> type : %x\n", msg->value, msg->ctrl, msg->type);
// カードデータロード完了フラグを下ろす // カードデータロード完了フラグを下ろす
SYSMi_GetWork()->flags.hotsw.isCardLoadCompleted = FALSE; SYSMi_GetWork()->flags.hotsw.isCardLoadCompleted = FALSE;
@ -1179,8 +1176,8 @@ static void McThread(void *arg)
if(HOTSW_IsCardExist()){ if(HOTSW_IsCardExist()){
// 前の状態が挿し // 前の状態が挿し
if(!isPulledOut){ if(!isPulledOut){
// 抜き差しがなかったか判定 // 抜きがなかったか判定
if(CARDi_IsPulledOutEx(hotswCount)){ if(CmpMcSlotMode(SLOT_STATUS_MODE_10) == TRUE){
// フラグケア // フラグケア
LockHotSwRsc(&SYSMi_GetWork()->lockCardRsc); LockHotSwRsc(&SYSMi_GetWork()->lockCardRsc);
SYSMi_GetWork()->flags.hotsw.isExistCard = TRUE; SYSMi_GetWork()->flags.hotsw.isExistCard = TRUE;
@ -1203,9 +1200,6 @@ static void McThread(void *arg)
} }
} }
// 挿し回数を取得
hotswCount = CARDi_GetSlotResetCount();
// HotSwをbusy状態にする // HotSwをbusy状態にする
SetHotSwState(TRUE); SetHotSwState(TRUE);
@ -1215,33 +1209,51 @@ static void McThread(void *arg)
// HotSwをfree状態にする // HotSwをfree状態にする
SetHotSwState(FALSE); SetHotSwState(FALSE);
// 状態フラグを更新 // Debug表示
isPulledOut = (retval == HOTSW_SUCCESS) ? FALSE : TRUE; DebugPrintErrorMessage(retval);
}
// カード読みが失敗していたらカードがないことにする
// カードが抜けてたら if(retval != HOTSW_SUCCESS){
else{ LockHotSwRsc(&SYSMi_GetWork()->lockHotSW);
if(isPulledOut){ SYSMi_GetWork()->flags.hotsw.isExistCard = FALSE;
// フラグケア SYSMi_GetWork()->flags.hotsw.isValidCardBanner = FALSE;
{ SYSMi_GetWork()->flags.hotsw.isCardStateChanged = TRUE;
LockHotSwRsc(&SYSMi_GetWork()->lockHotSW); UnlockHotSwRsc(&SYSMi_GetWork()->lockHotSW);
SYSMi_GetWork()->flags.hotsw.isExistCard = FALSE;
SYSMi_GetWork()->flags.hotsw.isValidCardBanner = FALSE;
SYSMi_GetWork()->flags.hotsw.isCardStateChanged = TRUE;
UnlockHotSwRsc(&SYSMi_GetWork()->lockHotSW);
}
// カードブート用構造体の初期化 // カードブート用構造体の初期化
MI_CpuClear32(&s_cbData, sizeof(CardBootData)); MI_CpuClear32(&s_cbData, sizeof(CardBootData));
// バッファのクリア // バッファのクリア
MI_CpuClearFast(s_pBootSegBuffer, s_BootSegBufSize); MI_CpuClearFast(s_pBootSegBuffer, s_BootSegBufSize);
MI_CpuClearFast(s_pSecureSegBuffer, s_SecureSegBufSize); MI_CpuClearFast(s_pSecureSegBuffer, s_SecureSegBufSize);
MI_CpuClearFast((u32 *)SYSM_CARD_BANNER_BUF, sizeof(TWLBannerFile));
break; break;
} }
// 状態フラグを更新
isPulledOut = FALSE;
}
// カードが抜けてたら
else{
LockHotSwRsc(&SYSMi_GetWork()->lockHotSW);
SYSMi_GetWork()->flags.hotsw.isExistCard = FALSE;
SYSMi_GetWork()->flags.hotsw.isValidCardBanner = FALSE;
SYSMi_GetWork()->flags.hotsw.isCardStateChanged = TRUE;
UnlockHotSwRsc(&SYSMi_GetWork()->lockHotSW);
// カードブート用構造体の初期化
MI_CpuClear32(&s_cbData, sizeof(CardBootData));
// バッファのクリア
MI_CpuClearFast(s_pBootSegBuffer, s_BootSegBufSize);
MI_CpuClearFast(s_pSecureSegBuffer, s_SecureSegBufSize);
MI_CpuClearFast((u32 *)SYSM_CARD_BANNER_BUF, sizeof(TWLBannerFile));
isPulledOut = TRUE; isPulledOut = TRUE;
break;
} }
} }
SYSMi_GetWork()->flags.hotsw.is1stCardChecked = TRUE; SYSMi_GetWork()->flags.hotsw.is1stCardChecked = TRUE;
@ -1265,7 +1277,7 @@ static void InterruptCallbackCard(void)
// メッセージインデックスをインクリメント // メッセージインデックスをインクリメント
s_ctData.idx_pulledOut = (s_ctData.idx_pulledOut+1) % HOTSW_PULLED_MSG_NUM; s_ctData.idx_pulledOut = (s_ctData.idx_pulledOut+1) % HOTSW_PULLED_MSG_NUM;
OS_TPrintf("○ - idx_pullout : %d Slot B state : 0x%08x\n", s_ctData.idx_pulledOut, reg_MI_MC1); OS_PutString("○\n");
} }
/*---------------------------------------------------------------------------* /*---------------------------------------------------------------------------*
@ -1275,9 +1287,6 @@ static void InterruptCallbackCard(void)
*---------------------------------------------------------------------------*/ *---------------------------------------------------------------------------*/
static void InterruptCallbackCardDet(void) static void InterruptCallbackCardDet(void)
{ {
// SDKのカード状態をリセットする
CARDi_ResetSlotStatus();
s_ctData.hotswInsertMsg[s_ctData.idx_insert].ctrl = FALSE; s_ctData.hotswInsertMsg[s_ctData.idx_insert].ctrl = FALSE;
s_ctData.hotswInsertMsg[s_ctData.idx_insert].value = 0; s_ctData.hotswInsertMsg[s_ctData.idx_insert].value = 0;
s_ctData.hotswInsertMsg[s_ctData.idx_insert].type = HOTSW_INSERT; s_ctData.hotswInsertMsg[s_ctData.idx_insert].type = HOTSW_INSERT;
@ -1288,7 +1297,7 @@ static void InterruptCallbackCardDet(void)
// メッセージインデックスをインクリメント // メッセージインデックスをインクリメント
s_ctData.idx_insert = (s_ctData.idx_insert+1) % HOTSW_INSERT_MSG_NUM; s_ctData.idx_insert = (s_ctData.idx_insert+1) % HOTSW_INSERT_MSG_NUM;
OS_TPrintf("● - idx_insert : %d Slot B state : 0x%08x\n", s_ctData.idx_insert, reg_MI_MC1); OS_PutString("●\n");
} }
/*---------------------------------------------------------------------------* /*---------------------------------------------------------------------------*
@ -1611,3 +1620,53 @@ static void ShowRegisterData(void)
OS_TPrintf("MC コントロールレジスタ1 (START etc) : %08x\n", reg_HOTSW_MCCNT1); OS_TPrintf("MC コントロールレジスタ1 (START etc) : %08x\n", reg_HOTSW_MCCNT1);
OS_TPrintf("----------------------------------------------------------\n"); OS_TPrintf("----------------------------------------------------------\n");
} }
/*---------------------------------------------------------------------------*
Name: DebugPrintErrorMessage
Description:
*---------------------------------------------------------------------------*/
static void DebugPrintErrorMessage(HotSwState state)
{
switch(state){
case HOTSW_SUCCESS:
OS_PutString(" - Success\n");
break;
case HOTSW_TIME_OUT:
OS_PutString(" - Error 1 : TimeOut\n");
break;
case HOTSW_CARD_LOCK_ERROR:
OS_PutString(" - Error 2 : Slot Lock\n");
break;
case HOTSW_CRC_CHECK_ERROR:
OS_PutString(" - Error 3 : CRC Check\n");
break;
case HOTSW_HASH_CHECK_ERROR:
OS_PutString(" - Error 4 : Hash Check\n");
break;
case HOTSW_ID_CHECK_ERROR:
OS_PutString(" - Error 5 : ID Check\n");
break;
case HOTSW_PULLED_OUT_ERROR:
OS_PutString(" - Error 6 : Pulled Out\n");
break;
case HOTSW_DATA_DECRYPT_ERROR:
OS_PutString(" - Error 7 : Data Decrypt\n");
break;
case HOTSW_UNEXPECTED_ERROR:
OS_PutString(" - Error 8 : Unexpected\n");
break;
default :
OS_PutString(" - illigal Error\n");
break;
}
}