mirror of
https://github.com/rvtr/twl_wrapsdk.git
synced 2025-10-31 06:11:10 -04:00
d9fbb9af01
git-svn-id: file:///Users/lillianskinner/Downloads/platinum/twl/twl_wrapsdk/trunk@194 4ee2a332-4b2b-5046-8439-1ba90f034370
275 lines
9.8 KiB
C
275 lines
9.8 KiB
C
/*---------------------------------------------------------------------------*
|
|
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 NUMS 1 // バッファ数
|
|
|
|
#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);
|
|
|
|
/*---------------------------------------------------------------------------*
|
|
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, WIDTH*HEIGHT*2);
|
|
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(); // create camera thread
|
|
CAMERA_PowerOn(); // wakeup camera module
|
|
|
|
result = CAMERA_I2CInit(CAMERA_SELECT_IN);
|
|
if (result != CAMERA_RESULT_SUCCESS_TRUE)
|
|
{
|
|
OS_TPrintf("CAMERA_I2CInit was failed. (%d)\n", result);
|
|
CAMERA_PowerOff();
|
|
OS_Terminate();
|
|
}
|
|
OS_TPrintf("CAMERA_I2CInit was done successfully.\n");
|
|
|
|
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);
|
|
|
|
// カメラスタート (DMAはここで開始してもしなくても良い)
|
|
CAMERA_ClearBuffer();
|
|
CAMERA_DmaRecvAsync(DMA_NO, (void *)HW_LCDC_VRAM_A, BYTES_PER_LINE * LINES_AT_ONCE, BYTES_PER_LINE * HEIGHT);
|
|
CAMERA_Start();
|
|
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)
|
|
{
|
|
OS_TPrintf("call CAMERA_I2CActivate(CAMERA_SELECT_IN)... ");
|
|
result = CAMERA_I2CActivate(CAMERA_SELECT_IN);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
}
|
|
if (trg & PAD_BUTTON_B)
|
|
{
|
|
OS_TPrintf("call CAMERA_I2CActivate(CAMERA_SELECT_OUT)... ");
|
|
result = CAMERA_I2CActivate(CAMERA_SELECT_OUT);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
}
|
|
if (trg & PAD_BUTTON_R)
|
|
{
|
|
OS_TPrintf("call CAMERA_I2CActivate(CAMERA_SELECT_NONE)... ");
|
|
result = CAMERA_I2CActivate(CAMERA_SELECT_NONE);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
}
|
|
if (trg & PAD_BUTTON_START) // start/stop to capture
|
|
{
|
|
if (OS_GetIrqMask() & OS_IE_CAM)
|
|
{
|
|
// clear the handler
|
|
(void)OS_DisableIrqMask(OS_IE_CAM);
|
|
OS_TPrintf("call CAMERA_Stop()... ");
|
|
CAMERA_Stop();
|
|
while (CAMERA_IsBusy())
|
|
{
|
|
}
|
|
OS_TPrintf("Camera was stopped.\n");
|
|
}
|
|
else
|
|
{
|
|
// set the handler
|
|
OS_SetIrqFunction(OS_IE_CAM, CameraIntr);
|
|
(void)OS_EnableIrqMask(OS_IE_CAM);
|
|
|
|
CAMERA_ClearBuffer();
|
|
CAMERA_Start();
|
|
OS_TPrintf("Camera is shooting a movie...\n");
|
|
}
|
|
}
|
|
if (trg & PAD_BUTTON_SELECT) // power on/off
|
|
{
|
|
if (reg_CFG_CLK & REG_CFG_CLK_CAM_CKI_MASK)
|
|
{
|
|
OS_TPrintf("call CAMERA_I2CActivate(CAMERA_SELECT_NONE)... ");
|
|
result = CAMERA_I2CActivate(CAMERA_SELECT_NONE);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
OS_TPrintf("call CAMERA_PowerOff()... ");
|
|
CAMERA_PowerOff();
|
|
OS_TPrintf("Done.\n");
|
|
}
|
|
else
|
|
{
|
|
OS_TPrintf("call CAMERA_PowerOn()... ");
|
|
CAMERA_PowerOn();
|
|
OS_TPrintf("Done.\n");
|
|
OS_TPrintf("call CAMERA_I2CInit(CAMERA_SELECT_IN)... ");
|
|
result = CAMERA_I2CInit(CAMERA_SELECT_IN);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
// resize
|
|
OS_TPrintf("call CAMERA_I2CResize(CAMERA_SELECT_IN)... ");
|
|
result = CAMERA_I2CResize(CAMERA_SELECT_IN, 320, 240);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
// activate inside camera first
|
|
OS_TPrintf("call CAMERA_I2CActivate(CAMERA_SELECT_IN)... ");
|
|
result = CAMERA_I2CActivate(CAMERA_SELECT_IN);
|
|
OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS_TRUE ? "SUCCESS" : "FAILED");
|
|
// set misc registers
|
|
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_SetBufferErrorIntrrupt(TRUE);
|
|
CAMERA_SetMasterIntrrupt(TRUE);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
//--------------------------------------------------------------------------------
|
|
// Ｖブランク割り込み処理
|
|
//
|
|
void VBlankIntr(void)
|
|
{
|
|
OS_SetIrqCheckFlag(OS_IE_V_BLANK); // checking VBlank interrupt
|
|
}
|
|
|
|
//--------------------------------------------------------------------------------
|
|
// カメラ割り込み処理 (エラー時とVsync時の両方で発生)
|
|
//
|
|
#if 0
|
|
Start時にDMAを開始しない場合、Startのタイミングによっては、最初にエラー検知から始まる。
|
|
Start時にDMAを開始している場合、Startのタイミングによっては、DMAが停止していないから始まる。
|
|
DMA周りの管理をカメラのVsyncからDMA割り込みに変えても良いかも。
|
|
#endif
|
|
#define PRINT_RATE 32
|
|
void CameraIntr(void)
|
|
{
|
|
OS_TPrintf(".");
|
|
OS_SetIrqCheckFlag(OS_IE_CAM); // checking camera interrupt
|
|
|
|
if (CAMERA_GetErrorStatus()) // error?
|
|
{
|
|
OS_TPrintf("Error was occurred.\n");
|
|
// 停止処理
|
|
CAMERA_Stop(); // カメラ停止
|
|
MIi_StopExDma(DMA_NO); // DMA停止
|
|
while (CAMERA_IsBusy()) // 待ち
|
|
{
|
|
}
|
|
// カメラ再開
|
|
CAMERA_ClearBuffer();
|
|
CAMERA_Start();
|
|
return; // waiting next frame (skip current frame)
|
|
}
|
|
|
|
// 以降はVsync時の処理
|
|
|
|
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)
|
|
}
|
|
if (CAMERA_IsBusy() == FALSE) // done to execute stop command?
|
|
{
|
|
OS_TPrintf("Finished receiving final frame.\n");
|
|
// disable this handler?
|
|
}
|
|
else
|
|
{
|
|
// start to capture for next frame
|
|
CAMERA_DmaRecvAsync(DMA_NO, (void *)HW_LCDC_VRAM_A, 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;
|
|
OS_TPrintf("%2d.%03d fps\n", (int)(1000000LL / uspf), (int)(1000000000LL / uspf) % 1000);
|
|
count = 0;
|
|
begin = OS_GetTick();
|
|
}
|
|
}
|
|
}
|