diff --git a/build/tests/camera/Makefile b/build/tests/camera/Makefile index bed089f..ef3d656 100644 --- a/build/tests/camera/Makefile +++ b/build/tests/camera/Makefile @@ -23,6 +23,7 @@ include $(TWLSDK_ROOT)/build/buildtools/commondefs SUBDIRS = camera-1 \ camera-2 \ camera-3 \ + camera-4 \ #---------------------------------------------------------------------------- diff --git a/build/tests/camera/camera-4/ARM7/Makefile b/build/tests/camera/camera-4/ARM7/Makefile new file mode 100644 index 0000000..eeeb404 --- /dev/null +++ b/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 ===== diff --git a/build/tests/camera/camera-4/ARM7/src/main.c b/build/tests/camera/camera-4/ARM7/src/main.c new file mode 100644 index 0000000..db351a2 --- /dev/null +++ b/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 +#include + +/*---------------------------------------------------------------------------* + 定数定義 + *---------------------------------------------------------------------------*/ +// ===== スレッド優先度 ===== + +#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 + *---------------------------------------------------------------------------*/ diff --git a/build/tests/camera/camera-4/ARM9/Makefile b/build/tests/camera/camera-4/ARM9/Makefile new file mode 100644 index 0000000..f2db9fc --- /dev/null +++ b/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 ===== diff --git a/build/tests/camera/camera-4/ARM9/src/main.c b/build/tests/camera/camera-4/ARM9/src/main.c new file mode 100644 index 0000000..ccd6de7 --- /dev/null +++ b/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 +#include + +#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(); + } + } +} diff --git a/build/tests/camera/camera-4/Makefile b/build/tests/camera/camera-4/Makefile new file mode 100644 index 0000000..078ec37 --- /dev/null +++ b/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 =====