CARD APIをローカルに持つことにした

git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/TwlIPL/trunk@1746 b08762b0-b915-fc4b-9d8c-17b2551a87ff

build/gcdfirm/sdmc-launcher-writer/ARM7/main.c

@@ -125,19 +125,172 @@ static void EraseAll(void)
     MI_CpuClearFast( nor, (gh->l.nandfirm_size + 512) * 2 );
 }
 
+/*
+  独自CARDライブラリ
+*/
+
+#define CARD_COMMAND_PAGE           0x01000000
+#define CARD_COMMAND_MASK           0x07000000
+#define CARD_RESET_HI               0x20000000
+#define CARD_COMMAND_OP_G_READPAGE  0xB7
+
+static u32                  cache_page;
+static u8                   CARDi_cache_buf[CARD_ROM_PAGE_SIZE] ATTRIBUTE_ALIGN(32);
+
+/*---------------------------------------------------------------------------*
+  Name:         CARDi_SetRomOp
+
+  Description:  カードコマンド設定
+
+  Arguments:    command    コマンド
+                offset     転送ページ数
+
+  Returns:      None.
+ *---------------------------------------------------------------------------*/
+static void CARDi_SetRomOp(u32 command, u32 offset)
+{
+    u32     cmd1 = (u32)((offset >> 8) | (command << 24));
+    u32     cmd2 = (u32)((offset << 24));
+    // 念のため前回のROMコマンドの完了待ち。
+    while ((reg_MI_MCCNT1 & REG_MI_MCCNT1_START_MASK) != 0)
+    {
+    }
+    // マスターイネーブル。
+    reg_MI_MCCNT0 = (u16)(REG_MI_MCCNT0_E_MASK | REG_MI_MCCNT0_I_MASK |
+                          (reg_MI_MCCNT0 & ~REG_MI_MCCNT0_SEL_MASK));
+    // コマンド設定。
+    reg_MI_MCCMD0 = MI_HToBE32(cmd1);
+    reg_MI_MCCMD1 = MI_HToBE32(cmd2);
+}
+
+/*---------------------------------------------------------------------------*
+  Name:         CARDi_GetRomFlag
+
+  Description:  カードコマンドコントロールパラメータを取得
+
+  Arguments:    flag       カードデバイスへ発行するコマンドのタイプ
+                           (CARD_COMMAND_PAGE / CARD_COMMAND_ID /
+                            CARD_COMMAND_STAT / CARD_COMMAND_REFRESH)
+
+  Returns:      カードコマンドコントロールパラメータ
+ *---------------------------------------------------------------------------*/
+SDK_INLINE u32 CARDi_GetRomFlag(u32 flag)
+{
+    u32     rom_ctrl = *(vu32 *)(HW_CARD_ROM_HEADER + 0x60);
+    return (u32)(flag | REG_MI_MCCNT1_START_MASK | CARD_RESET_HI | (rom_ctrl & ~CARD_COMMAND_MASK));
+}
+
+/*---------------------------------------------------------------------------*
+  Name:         CARDi_StartRomPageTransfer
+
+  Description:  ROMページ転送を開始。
+
+  Arguments:    offset     転送元のROMオフセット
+
+  Returns:      None.
+ *---------------------------------------------------------------------------*/
+static void CARDi_StartRomPageTransfer(u32 offset)
+{
+    u8 op = CARD_COMMAND_OP_G_READPAGE;
+    CARDi_SetRomOp(op, offset);
+    reg_MI_MCCNT1 = CARDi_GetRomFlag(CARD_COMMAND_PAGE);
+}
+
+/*---------------------------------------------------------------------------*
+  Name:         CARDi_ReadRomWithCPU
+
+  Description:  CPUを使用してROM転送。
+                キャッシュやページ単位の制限を考慮する必要は無いが
+                転送完了まで関数がブロッキングする点に注意。
+
+  Arguments:    userdata          (他のコールバックとして使用するためのダミー)
+                buffer            転送先バッファ
+                offset            転送元ROMオフセット
+                length            転送サイズ
+
+  Returns:      None.
+ *---------------------------------------------------------------------------*/
+static int CARDi_ReadRomWithCPU(void *userdata, void *buffer, u32 offset, u32 length)
+{
+    int     retval = (int)length;
+    // 頻繁に使用するグローバル変数をローカル変数へキャッシュ。
+    u32         cachedPage = cache_page;
+    u8  * const cacheBuffer = CARDi_cache_buf;
+    while (length > 0)
+    {
+        // ROM転送は常にページ単位。
+        u8     *ptr = (u8 *)buffer;
+        u32     n = CARD_ROM_PAGE_SIZE;
+        u32     pos = MATH_ROUNDDOWN(offset, CARD_ROM_PAGE_SIZE);
+        // 以前のページと同じならばキャッシュを使用。
+        if (pos == cachedPage)
+        {
+            ptr = cacheBuffer;
+        }
+        else
+        {
+            // バッファへ直接転送できないならキャッシュへ転送。
+            if(((pos != offset) || (((u32)buffer & 3) != 0) || (length < n)))
+            {
+                cachedPage = pos;
+                ptr = cacheBuffer;
+            }
+            // 4バイト整合の保証されたバッファへCPUで直接リード。
+            CARDi_StartRomPageTransfer(pos);
+            {
+                u32     word = 0;
+                for (;;)
+                {
+                    // 1ワード転送完了を待つ。
+                    u32     ctrl = reg_MI_MCCNT1;
+                    if ((ctrl & REG_MI_MCCNT1_RDY_MASK) != 0)
+                    {
+                        // データを読み出し、必要ならバッファへ格納。
+                        u32     data = reg_MI_MCD1;
+                        if (word < (CARD_ROM_PAGE_SIZE / sizeof(u32)))
+                        {
+                            ((u32 *)ptr)[word++] = data;
+                        }
+                    }
+                    // 1ページ転送完了なら終了。
+                    if ((ctrl & REG_MI_MCCNT1_START_MASK) == 0)
+                    {
+                        break;
+                    }
+                }
+            }
+        }
+        // キャッシュ経由ならキャッシュから転送。
+        if (ptr == cacheBuffer)
+        {
+            u32     mod = offset - pos;
+            n = MATH_MIN(length, CARD_ROM_PAGE_SIZE - mod);
+            MI_CpuCopy8(cacheBuffer + mod, buffer, n);
+        }
+        buffer = (u8 *)buffer + n;
+        offset += n;
+        length -= n;
+    }
+    // ローカル変数からグローバル変数へ反映。
+    cache_page = cachedPage;
+    (void)userdata;
+    return retval;
+}
+
+
+extern SDPortContext *SDNandContext;
 extern SDMC_ERR_CODE FATFSi_sdmcGoIdle(u16 ports, void (*func1)(),void (*func2)());
 
 void TwlSpMain( void )
 {
     GCDHeader* const gh = &OSi_GetFromBromAddr()->header.gcd;
     u32 offset = gh->l.nandfirm_offset;
-    u32 size = gh->l.nandfirm_size;
+    u32 size = 261120;//gh->l.nandfirm_size;
     u32 nsize = size - offsetof(NANDHeader,l);  // size to write to nand
     u32 sectors = (nsize + 511)/512;
     u8* nor2 = nor + size;      // buffer to verify
     u8* nand2 = nand + size;    // buffer to verify
 
-    s32             lock_id;
     SdmcResultInfo  sdResult;
 
     InitDebugLED();
@@ -160,14 +313,11 @@ void TwlSpMain( void )
         OS_TPrintf("Failed to call FATFSi_sdmcInit().\n");
         goto err;
     }
+    SDNandContext = NULL;
     FATFSi_sdmcGoIdle( 2, NULL, NULL );
     SetDebugLED(++step);  // 0x05
 
     // CARD<52>‰Šú‰»
-    CARD_Init();
-    CARD_Enable(TRUE);
-    lock_id = OS_GetLockID();
-    CARD_LockRom((u16)lock_id);
     SetDebugLED(++step);  // 0x06
 
     PXI_SendStream(&size, sizeof(size));
@@ -180,7 +330,7 @@ void TwlSpMain( void )
     SetDebugLED(++step);  // 0x07
 
     // read all
-    CARD_ReadRom( DMA_CARD, (void*)offset, nor, size );
+    CARDi_ReadRomWithCPU( NULL, nor, offset, size );
     SetDebugLED(++step);  // 0x08
 
     PXI_NotifyID( FIRM_PXI_ID_NULL );
@@ -196,7 +346,7 @@ void TwlSpMain( void )
     SetDebugLED(++step);  // 0x0a
 
     // write NAND
-    if ( FATFSi_sdmcWriteFifo( nand, sectors, 1, SDMC_PORT_NAND, &sdResult ) )
+    if (SDMC_NORMAL != FATFSi_sdmcWriteFifo( nand, sectors, 1, SDMC_PORT_NAND, &sdResult ))
     {
         OS_TPrintf("Failed to call FATFSi_sdmcWriteFifo() to write header.\n");
         goto err;

build/gcdfirm/sdmc-launcher-writer/ARM9/main.c

@@ -80,8 +80,6 @@ void TwlMain( void )
     myInit();
     PostInit();
 
-    CARD_Init();
-
     //---- clear screen buffer
     ClearScreen();