add double buffers and display buffer sample

git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/twl_wrapsdk/trunk@212 4ee2a332-4b2b-5046-8439-1ba90f034370

build/tests/camera/Makefile

@@ -23,6 +23,7 @@ include	$(TWLSDK_ROOT)/build/buildtools/commondefs
 SUBDIRS =	camera-1 \
                 camera-2 \
                 camera-3 \
+                camera-4 \
 
 #----------------------------------------------------------------------------
 

build/tests/camera/camera-4/ARM7/Makefile

@@ -0,0 +1,44 @@
+#! make -f
+#----------------------------------------------------------------------------
+# Project:  TwlSDK - CAMERA - demos - camera-4
+# File:     Makefile
+#
+# 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.
+#
+# $Log: $
+# $NoKeywords: $
+#----------------------------------------------------------------------------
+
+SUBDIRS		=
+
+
+#----------------------------------------------------------------------------
+
+#TWL_CODEGEN   =       THUMB
+TWL_PROC      =       ARM7
+
+TARGET_BIN	=	main.axf
+
+SRCS		=	main.c
+
+#SRCDIR		=	# using default
+#LCFILE		=	# using default
+
+include	$(TWLSDK_ROOT)/build/buildtools/commondefs
+
+
+#----------------------------------------------------------------------------
+
+do-build:		$(TARGETS)
+
+
+include	$(TWLSDK_ROOT)/build/buildtools/modulerules
+
+
+#===== End of Makefile =====

build/tests/camera/camera-4/ARM7/src/main.c

@@ -0,0 +1,167 @@
+/*---------------------------------------------------------------------------*
+  Project:  TwlSDK - tests - camera
+  File:     main.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.
+
+  $Log: main.c,v $
+  $NoKeywords: $
+ *---------------------------------------------------------------------------*/
+
+#include    <twl_sp.h>
+#include    <twl/camera.h>
+
+/*---------------------------------------------------------------------------*
+    定数定義
+ *---------------------------------------------------------------------------*/
+// ===== スレッド優先度 =====
+
+#define THREAD_PRIO_SPI         2
+#define THREAD_PRIO_CAMERA      6
+
+/*---------------------------------------------------------------------------*
+    内部関数定義
+ *---------------------------------------------------------------------------*/
+static OSHeapHandle InitializeAllocateSystem(void);
+static void VBlankIntr(void);
+
+/*---------------------------------------------------------------------------*
+  Name:         TwlSpMain
+
+  Description:  Initialize and do main
+
+  Arguments:    None.
+
+  Returns:      None.
+ *---------------------------------------------------------------------------*/
+void TwlSpMain(void)
+{
+    OSHeapHandle heapHandle;
+
+    // OS初期化
+    OS_Init();
+    OS_InitThread();
+
+    // PXI初期化、ARM9と同期
+    PXI_Init();
+
+    // ヒープ領域設定
+    heapHandle = InitializeAllocateSystem();
+
+    // 割込み許可
+    (void)OS_SetIrqFunction(OS_IE_V_BLANK, VBlankIntr);
+    (void)OS_EnableIrqMask(OS_IE_V_BLANK);
+    (void)GX_VBlankIntr(TRUE);
+    (void)OS_EnableIrq();
+    (void)OS_EnableInterrupts();
+
+    // ボタン入力サーチ初期化
+    (void)PAD_InitXYButton();
+
+    // SPI初期化
+    SPI_Init(THREAD_PRIO_SPI);
+
+    // カメラ初期化
+    CAMERA_Init(THREAD_PRIO_CAMERA);
+
+    while (TRUE)
+    {
+        OS_Halt();
+
+        //---- check reset
+        if (OS_IsResetOccurred())
+        {
+            OS_ResetSystem();
+        }
+    }
+}
+
+/*---------------------------------------------------------------------------*
+  Name:         InitializeAllocateSystem
+
+  Description:  メモリ割当てシステムを初期化する。
+
+  Arguments:    None.
+
+  Returns:      None.
+ *---------------------------------------------------------------------------*/
+static OSHeapHandle InitializeAllocateSystem(void)
+{
+    void   *tempLo;
+    OSHeapHandle hh;
+
+    OS_TPrintf("OS_GetWramSubPrivArenaLo() = %p\n", OS_GetWramSubPrivArenaLo());
+    OS_TPrintf("OS_GetWramSubPrivArenaHi() = %p\n", OS_GetWramSubPrivArenaHi());
+    OS_TPrintf("OS_GetWramSubArenaLo() = %p\n", OS_GetWramSubArenaLo());
+    OS_TPrintf("OS_GetWramSubArenaHi() = %p\n", OS_GetWramSubArenaHi());
+    OS_TPrintf("OS_GetSubPrivArenaLo() = %p\n", OS_GetSubPrivArenaLo());
+    OS_TPrintf("OS_GetSubPrivArenaHi() = %p\n", OS_GetSubPrivArenaHi());
+
+    OS_TPrintf("call OS_SetWramSubPrivArenaHi(0x0380f980); to fix arena.\n");
+    OS_SetWramSubPrivArenaHi((void*)0x0380f980);
+
+    // メモリ割当て初期化
+    tempLo = OS_InitAlloc(OS_ARENA_WRAM_SUBPRIV,
+                          OS_GetWramSubPrivArenaLo(), OS_GetWramSubPrivArenaHi(), 1);
+
+    // アリーナを0クリア
+    MI_CpuClear8(tempLo, (u32)OS_GetWramSubPrivArenaHi() - (u32)tempLo);
+
+    // アリーナ下位アドレスを設定
+    OS_SetArenaLo(OS_ARENA_WRAM_SUBPRIV, tempLo);
+
+    // ヒープ作成
+    hh = OS_CreateHeap(OS_ARENA_WRAM_SUBPRIV,
+                       OS_GetWramSubPrivArenaLo(), OS_GetWramSubPrivArenaHi());
+
+    if (hh < 0)
+    {
+        OS_Panic("ARM7: Fail to create heap.\n");
+    }
+
+    // カレントヒープに設定
+    (void)OS_SetCurrentHeap(OS_ARENA_WRAM_SUBPRIV, hh);
+
+    return hh;
+}
+
+/*---------------------------------------------------------------------------*
+  Name:         VBlankIntr
+
+  Description:  VBlank interrupt handler
+
+  Arguments:    None
+
+  Returns:      None
+ *---------------------------------------------------------------------------*/
+#ifndef SDK_TEG
+
+extern BOOL PMi_Initialized;
+void    PM_SelfBlinkProc(void);
+
+static void VBlankIntr(void)
+{
+    //---- LED blink system
+    if (PMi_Initialized)
+    {
+        PM_SelfBlinkProc();
+    }
+}
+
+#else
+
+static void VBlankIntr(void)
+{
+}
+
+#endif
+
+/*---------------------------------------------------------------------------*
+    End of file
+ *---------------------------------------------------------------------------*/

build/tests/camera/camera-4/ARM9/Makefile

@@ -0,0 +1,41 @@
+#! make -f
+#----------------------------------------------------------------------------
+# Project:  TwlSDK - CAMERA - demos - camera-4
+# File:     Makefile
+#
+# 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.
+#
+# $Log: Makefile,v $
+# $NoKeywords: $
+#----------------------------------------------------------------------------
+
+SUBDIRS		=
+
+
+#----------------------------------------------------------------------------
+
+#TWL_CODEGEN   =       THUMB
+
+TARGET_BIN	=	main.axf
+
+SRCS		=	main.c
+
+#SRCDIR		=	# using default
+#LCFILE		=	# using default
+
+include	$(TWLSDK_ROOT)/build/buildtools/commondefs
+
+
+#----------------------------------------------------------------------------
+
+do-build:		$(TARGETS)
+
+include	$(TWLSDK_ROOT)/build/buildtools/modulerules
+
+#===== End of Makefile =====

build/tests/camera/camera-4/ARM9/src/main.c

@@ -0,0 +1,221 @@
+/*---------------------------------------------------------------------------*
+  Project:  TwlSDK - tests - camera
+  File:     main.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.
+
+  $Log: main.c,v $
+  $NoKeywords: $
+ *---------------------------------------------------------------------------*/
+
+#include <twl.h>
+#include <twl/camera.h>
+
+#define DMA_NO      5           // 使用するDMA番号(4-7)
+#define WIDTH       256         // イメージの幅
+#define HEIGHT      192         // イメージの高さ
+
+#define LINES_AT_ONCE   CAMERA_GET_MAX_LINES(WIDTH)     // 一回の転送ライン数
+#define BYTES_PER_LINE  CAMERA_GET_LINE_BYTES(WIDTH)    // 一ラインの転送バイト数
+
+static void VBlankIntr(void);
+static void CameraIntr(void);
+
+static BOOL startRequest = FALSE;
+
+#if 0
+    メインメモリにダブルバッファ＆VRAM1枚の構成例
+#endif
+
+static int wp;  // カメラからデータを取り込み中のバッファ
+static int rp;  // 最後のVRAMにコピーしたバッファ
+static BOOL wp_pending; // 取り込みを中断した (再び同じバッファに取り込む)
+static u16 buffer[2][WIDTH*HEIGHT] ATTRIBUTE_ALIGN(32);
+static void DebugReport(void)
+{
+    OS_TPrintf("\nCapture to No.%d\tDisplay from No.%d\n", wp, rp);
+}
+static void PendingCapture(void)
+{
+    wp_pending = TRUE;
+}
+/*---------------------------------------------------------------------------*
+  Name:         TwlMain
+
+  Description:  main
+
+  Arguments:    None
+
+  Returns:      None
+ *---------------------------------------------------------------------------*/
+void TwlMain()
+{
+    CAMERAResult result;
+
+    // 初期化
+    OS_Init();
+    OS_InitThread();
+    GX_Init();
+    OS_InitTick();
+
+    // Vブランク割り込み設定
+    OS_SetIrqFunction(OS_IE_V_BLANK, VBlankIntr);
+    (void)OS_EnableIrqMask(OS_IE_V_BLANK);
+    (void)OS_EnableIrq();
+    (void)GX_VBlankIntr(TRUE);
+    (void)OS_EnableInterrupts();
+
+    // VRAM表示モード
+    GX_SetBankForLCDC(GX_VRAM_LCDC_A);
+    MI_CpuClearFast((void*)HW_LCDC_VRAM_A, BYTES_PER_LINE * HEIGHT);    // clear display buffer
+    wp = 0;
+    rp = 1;
+    wp_pending = TRUE;
+    GX_SetGraphicsMode(GX_DISPMODE_VRAM_A, GX_BGMODE_0, GX_BG0_AS_2D);
+    //GX_SetDispSelect(GX_DISP_SELECT_SUB_MAIN);
+    OS_WaitVBlankIntr();
+    GX_DispOn();
+
+    // カメラ初期化
+    CAMERA_Init();      // wakeup camera module
+
+    result = CAMERA_I2CActivate(CAMERA_SELECT_IN);
+    if (result != CAMERA_RESULT_SUCCESS_TRUE)
+    {
+        OS_TPrintf("CAMERA_I2CActivate was failed. (%d)\n", result);
+    }
+#if 0
+    result = CAMERA_I2CResize(CAMERA_SELECT_IN, 320, 240);
+    if (result != CAMERA_RESULT_SUCCESS_TRUE)
+    {
+        OS_TPrintf("CAMERA_I2CResize was failed. (%d)\n", result);
+    }
+#endif
+    CAMERA_SetTrimmingParamsCenter(WIDTH, HEIGHT, 320, 240);    // clipped by camera i/f
+    CAMERA_SetTrimming(TRUE);
+    CAMERA_SetOutputFormat(CAMERA_OUTPUT_RGB);
+    CAMERA_SetTransferLines(CAMERA_GET_MAX_LINES(WIDTH));
+
+    // カメラ割り込み設定
+    //CAMERA_SetVsyncIntrrupt(CAMERA_INTR_VSYNC_POSITIVE_EDGE);   // almost end of vblank
+    CAMERA_SetVsyncIntrrupt(CAMERA_INTR_VSYNC_NEGATIVE_EDGE);   // almost begin of vblank
+    CAMERA_SetBufferErrorIntrrupt(TRUE);
+    CAMERA_SetMasterIntrrupt(TRUE);
+    OS_SetIrqFunction(OS_IE_CAM, CameraIntr);
+    (void)OS_EnableIrqMask(OS_IE_CAM);
+
+    // カメラスタート (リクエストのみ)
+    startRequest = TRUE;
+    OS_TPrintf("Camera is shooting a movie...\n");
+
+    while (1)
+    {
+        u16 pad;
+        u16 trg;
+        static u16 old = 0xffff;    // ignore the trigger by first data
+
+        OS_WaitVBlankIntr();
+
+        pad = PAD_Read();
+        trg = (u16)(pad & ~old);
+        old = pad;
+
+        if (trg & PAD_BUTTON_A)
+        {
+            DebugReport();
+        }
+    }
+}
+
+//--------------------------------------------------------------------------------
+//    Ｖブランク割り込み処理
+//
+void VBlankIntr(void)
+{
+    OS_SetIrqCheckFlag(OS_IE_V_BLANK); // checking VBlank interrupt
+    if (wp == rp)
+    {
+        rp ^= 1;
+        // ここでは単純なコピーだが、フォーマット変換なども可能 (重いけど)
+        MI_CpuCopyFast(buffer[rp], (void*)HW_LCDC_VRAM_A, BYTES_PER_LINE * HEIGHT);
+        DC_InvalidateRange(buffer[rp], BYTES_PER_LINE * HEIGHT);
+    }
+}
+
+//--------------------------------------------------------------------------------
+//    カメラ割り込み処理 (エラー時とVsync時の両方で発生)
+//
+#define PRINT_RATE  32
+void CameraIntr(void)
+{
+    OS_SetIrqCheckFlag(OS_IE_CAM); // checking camera interrupt
+
+    if (CAMERA_GetErrorStatus())    // error?
+    {
+        OS_TPrintf("Error was occurred.\n");
+        // 停止処理
+        CAMERA_StopCapture();   // カメラ停止
+        CAMERA_ClearBuffer();   // クリア (すぐにできる？)
+        MIi_StopExDma(DMA_NO);  // DMA停止
+        wp_pending = TRUE;      // 次回も同じフレームを使用する
+        startRequest = TRUE;    // カメラ再開要求
+        return;     // waiting next frame (skip current frame)
+    }
+
+    // 以降はVsync時の処理
+
+    if (startRequest)
+    {
+        CAMERA_ClearBuffer();
+        CAMERA_StartCapture();
+        startRequest = FALSE;
+    }
+
+    if (CAMERA_IsBusy() == FALSE)   // done to execute stop command?
+    {
+        //OS_TPrintf("while stopping the capture or just finished\n");
+    }
+    else
+    {
+        OS_TPrintf(".");
+        if (MIi_IsExDmaBusy(DMA_NO))    // NOT done to capture last frame?
+        {
+            OS_TPrintf("DMA was not done until VBlank.\n");
+            return; // waiting next frame (skip current frame)
+        }
+        // start to capture for next frame
+        if (wp_pending)
+        {
+            wp_pending = FALSE;
+        }
+        else
+        {
+            wp ^= 1;
+        }
+        CAMERA_DmaRecvAsync(DMA_NO, buffer[wp], BYTES_PER_LINE * LINES_AT_ONCE, BYTES_PER_LINE * HEIGHT);
+    }
+
+    // debug print
+    {
+        static OSTick begin = 0;
+        static int count = 0;
+        if (begin == 0) // first time
+        {
+            begin = OS_GetTick();
+        }
+        else if (++count == PRINT_RATE)
+        {
+            OSTick uspf = OS_TicksToMicroSeconds(OS_GetTick() - begin) / count;
+            int mfps = (int)(1000000000LL / uspf);
+            OS_TPrintf("%2d.%03d fps\n", mfps / 1000, mfps % 1000);
+            count = 0;
+            begin = OS_GetTick();
+        }
+    }
+}

build/tests/camera/camera-4/Makefile

@@ -0,0 +1,32 @@
+#! make -f
+#----------------------------------------------------------------------------
+# Project:  TwlSDK - build
+# File:     Makefile
+#
+# 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.
+#
+# $Log: $
+# $NoKeywords: $
+#----------------------------------------------------------------------------
+
+include	$(TWLSDK_ROOT)/build/buildtools/commondefs
+
+
+#----------------------------------------------------------------------------
+
+SUBDIRS =	\
+            ARM7 \
+            ARM9 \
+
+#----------------------------------------------------------------------------
+
+include	$(TWLSDK_ROOT)/build/buildtools/modulerules
+
+
+#===== End of Makefile =====