From 32957c8e3c06ab66c89b3142e4d706a3216b433a Mon Sep 17 00:00:00 2001 From: yutaka Date: Thu, 8 Nov 2007 11:49:30 +0000 Subject: [PATCH] =?UTF-8?q?TwlSDK=E3=81=8C=E3=81=82=E3=82=84=E3=81=97?= =?UTF-8?q?=E3=81=84=E3=81=AE=E3=81=A7=E3=82=B9=E3=82=BF=E3=83=83=E3=82=AF?= =?UTF-8?q?=E3=81=AE=E4=BD=8D=E7=BD=AE=E3=82=920x03FFXXXX=E3=81=AB?= =?UTF-8?q?=E5=9B=BA=E5=AE=9A=E3=81=99=E3=82=8B=E3=82=88=E3=81=86=E3=81=AB?= =?UTF-8?q?=E3=81=97=E3=81=9F?= 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@126 b08762b0-b915-fc4b-9d8c-17b2551a87ff --- build/libraries/fatfs/ARM7/src/fatfs_firm.c | 223 +++++++++++++++++--- build/libraries/init/ARM7/crt0_firm.c | 14 +- 2 files changed, 196 insertions(+), 41 deletions(-) diff --git a/build/libraries/fatfs/ARM7/src/fatfs_firm.c b/build/libraries/fatfs/ARM7/src/fatfs_firm.c index 11fcbd12..c09bf5a7 100644 --- a/build/libraries/fatfs/ARM7/src/fatfs_firm.c +++ b/build/libraries/fatfs/ARM7/src/fatfs_firm.c @@ -24,6 +24,8 @@ #include #include +//#define USE_SPECULATIVE_READ + extern u32 NAND_FAT_PARTITION_COUNT; #define DMA_PIPE 2 @@ -35,7 +37,9 @@ extern u32 NAND_FAT_PARTITION_COUNT; extern volatile SDMC_ERR_CODE SDCARD_ErrStatus; extern s16 SDCARD_SDHCFlag; /* SDHCカードフラグ */ extern SDPortContext* SDNandContext; /* NAND初期化パラメータ */ - +#ifdef USE_SPECULATIVE_READ +static u32 currentSector; +#endif /*---------------------------------------------------------------------------* Name: WaitFifoFull @@ -59,6 +63,80 @@ static inline void WaitFifoFull( void ) } } +/*---------------------------------------------------------------------------* + Name: StopToRead + + Description: stop to read from SD I/F + + SDカードからの読み込みの完了処理を行います。 + + Arguments: None + + Returns: None + *---------------------------------------------------------------------------*/ +static void StopToRead( void ) +{ +#ifdef NAND_FAT_PARTITION_COUNT + if ( *SDIF_CNT & SDIF_CNT_USEFIFO ) + { + SD_AndFPGA( SD_INFO2,(~(SD_INFO2_ERROR_SET))); /* SD_INFO2のエラーフラグを全て落とす */ + SD_OrFPGA( SD_INFO2_MASK, SD_INFO2_MASK_ERRSET); /* 全てのエラー割り込みを禁止 */ + SD_OrFPGA( SD_INFO1_MASK, SD_INFO1_MASK_ALL_END); /* INFO1の access all end 割込み禁止 */ + SD_TransEndFPGA(); /* 強制的にカード転送の終了処理 */ + SD_StopTransmission(); /* 強制的にカード転送終了設定 */ + // SDCARD_EndFlag + if ( SDCARD_ErrStatus ) + { + //OS_TPrintf("R1_STATUS (1st).\n"); + SD_SendStatus(); /* CMD13 addressed card sends its status register 発行、レスポンス待ち */ + + if( !SDCARD_ErrStatus ) /* エラーステータスの確認（エラー有り？）*/ + { + u16 usRSP0; + //OS_TPrintf("R1_STATUS (2nd).\n"); + SD_GetFPGA( usRSP0, SD_RSP0); + usRSP0 = (u16)(( usRSP0 & RSP_R1_CURRENT_STATE) >> 1); /* カレントステートを取り出す */ + if((usRSP0 == CURRENT_STATE_DATA) || (usRSP0 == CURRENT_STATE_RCV)){ /* SDCARD Status が data rcv の時 */ + SD_Command(SD_CMD_CMD | STOP_TRANSMISSION); /* CMD12（StopTransmission）発行処理 */ + } + } + } + if(!(SDCARD_ErrStatus & SDMC_ERR_R1_STATUS)) /* コマンドレスポンス(R1)のカードステータスがエラーでないか? */ + { + //OS_TPrintf("R1_STATUS (3rd).\n"); + SD_CheckStatus(TRUE); /* コマンドレスポンス(R1)の Card Status チェック */ + if(!(SDCARD_ErrStatus & SDMC_ERR_R1_STATUS)) /* コマンドレスポンス(R1)のカードステータスがエラーでないか? */ + { + //OS_TPrintf("R1_STATUS (4th).\n"); + SD_SendStatus(); /* カードステータスの取得コマンド発行 */ + SD_CheckStatus(TRUE); /* コマンドレスポンス(R1)の Card Status チェック */ + } + } + if( !SD_CheckFPGAReg( SD_STOP,SD_STOP_SEC_ENABLE ) ){ + //OS_TPrintf("SD_StopTransmission.\n"); + SD_StopTransmission(); /* カード転送終了をFPGAに通知（CMD12発行） */ + } + SD_DisableClock(); /* クロック供給停止 */ + + *SDIF_CNT = (*SDIF_CNT & ~SDIF_CNT_USEFIFO) | SDIF_CNT_FCLR; /* FIFO使用フラグOFF */ + CC_EXT_MODE = CC_EXT_MODE_PIO; /* PIOモード(DMAモードOFF) */ + //OS_TPrintf("DONE\n"); + } +#else + if ( *SDIF_CNT & SDIF_CNT_USEFIFO ) + { + if( !SD_CheckFPGAReg( SD_STOP,SD_STOP_SEC_ENABLE ) ){ + SD_StopTransmission(); /* カード転送終了をFPGAに通知（CMD12発行） */ + } + SD_TransEndFPGA(); /* 転送終了処理(割り込みマスクを禁止に戻す) */ + SD_DisableClock(); /* クロック供給停止 */ + + *SDIF_CNT = (*SDIF_CNT & ~SDIF_CNT_USEFIFO) | SDIF_CNT_FCLR; /* FIFO使用フラグOFF */ + CC_EXT_MODE = CC_EXT_MODE_PIO; /* PIOモード(DMAモードOFF) */ + } +#endif +} + /*---------------------------------------------------------------------------* Name: StartToRead @@ -73,6 +151,15 @@ static inline void WaitFifoFull( void ) *---------------------------------------------------------------------------*/ static void StartToRead(u32 block, u32 count) { +#ifdef USE_SPECULATIVE_READ + if ( currentSector == block ) + { + return; + } + StopToRead(); + currentSector = block; + count = 0xFFFF; +#endif *SDIF_FSC = count; *SDIF_FDS = SECTOR_SIZE; *SDIF_CNT = (*SDIF_CNT & ~(SDIF_CNT_FEIE | SDIF_CNT_FFIE)) | SDIF_CNT_FCLR | SDIF_CNT_USEFIFO; @@ -91,29 +178,6 @@ static void StartToRead(u32 block, u32 count) } } -/*---------------------------------------------------------------------------* - Name: StopToRead - - Description: stop to read from SD I/F - - SDカードからの読み込みの完了処理を行います。 - - Arguments: None - - Returns: None - *---------------------------------------------------------------------------*/ -static void StopToRead( void ) -{ - if( !SD_CheckFPGAReg( SD_STOP,SD_STOP_SEC_ENABLE ) ){ - SD_StopTransmission(); /* カード転送終了をFPGAに通知（CMD12発行） */ - } - SD_TransEndFPGA(); /* 転送終了処理(割り込みマスクを禁止に戻す) */ - SD_DisableClock(); /* クロック供給停止 */ - - *SDIF_CNT = (*SDIF_CNT & ~SDIF_CNT_USEFIFO) | SDIF_CNT_FCLR; /* FIFO使用フラグOFF */ - CC_EXT_MODE = CC_EXT_MODE_PIO; /* PIOモード(DMAモードOFF) */ -} - /* FATFS-SDMCの間にAESを組み込む 一部の設定は、FATFSを迂回して設定することになる。 @@ -183,6 +247,7 @@ void FATFS_DisableAES( void ) *---------------------------------------------------------------------------*/ static u16 ReadNormal(u32 block, void *dest, u16 count) { +#if 1 // use TIMING_SD_1 or not MINDmaConfig config = { MI_NDMA_NO_INTERVAL, @@ -191,11 +256,68 @@ static u16 ReadNormal(u32 block, void *dest, u16 count) SECTOR_SIZE/4 }; // OS_TPrintf("ReadNormal(0x%X, 0x%08X, 0x%X) is calling.\n", block, dest, count); - MI_NDmaRecvExAsync_Dev( DMA_PIPE, SDIF_FI, dest, (u32)(count * SECTOR_SIZE), NULL, NULL, &config, MI_NDMA_TIMING_SD_1 ); +#ifdef USE_SPECULATIVE_READ + if (block == currentSector) + { + //StartToRead( block, 1 ); + WaitFifoFull(); + MI_NDmaRecvAsync( DMA_PIPE, SDIF_FI, dest, SECTOR_SIZE, NULL, NULL ); + block++; + dest = (u8*)dest + SECTOR_SIZE; + count--; + currentSector++; + if (count == 0) + { + MI_WaitNDma( DMA_PIPE ); + return SDCARD_ErrStatus; + } + // ここまでで次のFIFO FULL前であると仮定しているが、問題ない？ + } +#endif + MI_NDmaRecvExAsync_Dev( DMA_RECV, SDIF_FI, dest, (u32)(count * SECTOR_SIZE), NULL, NULL, &config, MI_NDMA_TIMING_SD_1 ); StartToRead( block, count ); - MI_WaitNDma( DMA_PIPE ); - StopToRead(); + if ( SDCARD_ErrStatus != SDMC_NORMAL ) + { + goto err; + } +#else + u32 offset = 0; // in bytes +// OS_TPrintf("ReadNormal(0x%X, 0x%08X, 0x%X) is calling.\n", block, dest, count); + MI_NDmaRecvAsync_SetUp( DMA_RECV, (void*)SDIF_FI, dest, SECTOR_SIZE, NULL, NULL ); + StartToRead( block, count ); + if ( SDCARD_ErrStatus != SDMC_NORMAL ) + { + goto err; + } + while ( count * SECTOR_SIZE > offset ) + { + WaitFifoFull(); + if ( SDCARD_ErrStatus != SDMC_NORMAL ) + { + goto err; + } +// MI_NDMA_REG( DMA_RECV, MI_NDMA_REG_DAD_WOFFSET ) = (u32)dest + offset; + MIi_SetNDmaDest( DMA_RECV, (u8*)dest + offset ); + MI_NDmaRestart( DMA_RECV ); + offset += SECTOR_SIZE; + } +#endif + + MI_WaitNDma( DMA_RECV ); +#ifdef USE_SPECULATIVE_READ + currentSector += count; +#else + StopToRead(); +#endif + return SDCARD_ErrStatus; + +err: + MI_StopNDma( DMA_RECV ); +#ifdef USE_SPECULATIVE_READ + currentSector = 0xFFFFFFFF; +#endif + StopToRead(); return SDCARD_ErrStatus; } @@ -223,6 +345,11 @@ static u16 ReadAES(u32 block, void *dest, u16 count) // OS_TPrintf("ReadAES(0x%X, 0x%08X, 0x%X) is calling.\n", block, dest, count); MI_NDmaPipeAsync_SetUp( DMA_PIPE, (void*)SDIF_FI, (void*)REG_AES_IFIFO_ADDR, PIPE_SIZE, NULL, NULL ); + StartToRead( block, count ); + if ( SDCARD_ErrStatus != SDMC_NORMAL ) + { + goto err; + } /* AESのセットアップ＆出力DMA設定 @@ -236,11 +363,6 @@ static u16 ReadAES(u32 block, void *dest, u16 count) // update for next read AESi_AddCounter( &aesCounter, (u32)(count * SECTOR_SIZE / AES_BLOCK_SIZE) ); - StartToRead( block, count ); - if ( SDCARD_ErrStatus != SDMC_NORMAL ) - { - goto err; - } while ( count * SECTOR_SIZE > offset ) { @@ -259,13 +381,20 @@ static u16 ReadAES(u32 block, void *dest, u16 count) offset += PIPE_SIZE; } MI_WaitNDma( DMA_PIPE ); +#ifdef USE_SPECULATIVE_READ + currentSector += count; +#else StopToRead(); +#endif MI_WaitNDma( DMA_RECV ); return SDCARD_ErrStatus; err: MI_StopNDma( DMA_RECV ); MI_StopNDma( DMA_PIPE ); +#ifdef USE_SPECULATIVE_READ + currentSector = 0xFFFFFFFF; +#endif StopToRead(); AESi_Reset(); return SDCARD_ErrStatus; @@ -449,7 +578,7 @@ static BOOL sdmcRtfsAttachFirm( int driveno) BOOL FATFS_InitFIRM( void* nandContext ) { /* RTFSライブラリを初期化 */ - if( !FATFSi_rtfs_init() ) + if( !rtfs_init() ) { return FALSE; } @@ -457,11 +586,16 @@ BOOL FATFS_InitFIRM( void* nandContext ) /* NAND初期化パラメータの設定 */ SDNandContext = (SDPortContext*)nandContext; +#ifdef USE_SPECULATIVE_READ + currentSector = 0xFFFFFFFF; +#endif + /* SDドライバ初期化 */ - if ( FATFSi_sdmcInit( SDMC_NOUSE_DMA ) != SDMC_NORMAL ) + if ( sdmcInit( SDMC_NOUSE_DMA ) != SDMC_NORMAL ) { return FALSE; } + return TRUE; } @@ -504,3 +638,24 @@ BOOL FATFS_MountDriveFIRM( int driveno, FATFSMediaType media, int partition_no ) } return TRUE; } + +/*---------------------------------------------------------------------------* + Name: FATFS_UnmountDriveFIRM + + Description: unmount specified partition + + 特殊なドライバの終了処理をします。 + + Arguments: driveno drive number "A:" is 0 + + Returns: None + *---------------------------------------------------------------------------*/ +BOOL FATFS_UnmountDriveFIRM( int driveno ) +{ +#ifdef USE_SPECULATIVE_READ + StopToRead(); + currentSector = 0xFFFFFFFF; +#endif + return TRUE; + return rtfs_detach( driveno ); +} diff --git a/build/libraries/init/ARM7/crt0_firm.c b/build/libraries/init/ARM7/crt0_firm.c index 5f51f136..537fc70b 100644 --- a/build/libraries/init/ARM7/crt0_firm.c +++ b/build/libraries/init/ARM7/crt0_firm.c @@ -97,16 +97,16 @@ SDK_WEAK_SYMBOL asm void _start( void ) // SVC mode mov r0, #HW_PSR_SVC_MODE msr cpsr_c, r0 - ldr sp, =HW_PRV_WRAM_SVC_STACK_END + ldr sp, =HW_FIRM_SVC_STACK_END // IRQ mode mov r0, #HW_PSR_IRQ_MODE msr cpsr_c, r0 - ldr r0, =HW_PRV_WRAM_IRQ_STACK_END + ldr r0, =HW_FIRM_IRQ_STACK_END mov sp, r0 // System mode - ldr r1, =SDK_IRQ_STACKSIZE + ldr r1, =HW_FIRM_IRQ_STACK_SIZE sub r1, r0, r1 mov r0, #HW_PSR_SYS_MODE msr cpsr_csfx, r0 @@ -345,8 +345,8 @@ INITi_ShelterStaticInitializer(u32* ptr) bxeq lr /* 退避場所先頭アドレスを計算 */ - ldr r1, =HW_PRV_WRAM_IRQ_STACK_END - ldr r2, =SDK_IRQ_STACKSIZE + ldr r1, =HW_FIRM_IRQ_STACK_END + ldr r2, =HW_FIRM_IRQ_STACK_SIZE sub r1, r1, r2 add r1, r1, #4 @@ -379,8 +379,8 @@ INITi_CallStaticInitializers(void) stmdb sp!, {lr} /* テーブル退避場所先頭アドレスを計算 */ - ldr r1, =HW_PRV_WRAM_IRQ_STACK_END - ldr r2, =SDK_IRQ_STACKSIZE + ldr r1, =HW_FIRM_IRQ_STACK_END + ldr r2, =HW_FIRM_IRQ_STACK_SIZE sub r1, r1, r2 add r1, r1, #4