/*---------------------------------------------------------------------------* Project: TwlSDK - demos.TWL - camera - camera-3 File: main.c Copyright 2007-2009 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. $Date:: 2009-06-15#$ $Rev: 10750 $ $Author: kitase_hirotake $ *---------------------------------------------------------------------------*/ #include #include #include "DEMOBitmap.h" #define NDMA_NO 1 // The NDMA number (0 to 3) to use #define WIDTH 256 // Image width #define HEIGHT 192 // Image height #define LINES_AT_ONCE CAMERA_GET_MAX_LINES(WIDTH) // Number of lines transferred in one cycle #define BYTES_PER_LINE CAMERA_GET_LINE_BYTES(WIDTH) // Number of bytes in one line's transfer static void VBlankIntr(void); static BOOL CameraInit(void); static void CameraIntrVsync(CAMERAResult result); static void CameraIntrError(CAMERAResult result); static void CameraIntrReboot(CAMERAResult result); static void CameraDmaRecvIntr(void* arg); static u32 stabilizedCount; static BOOL switchFlag; ///// // Triple buffer sequence that assumes the display FPS rate is larger than that for rendering ///// static int wp; // Buffer while capturing data from camera static int rp; // The buffer being displayed static BOOL wp_pending; // Data capture was cancelled (recapture to same buffer) static GXBGBmpScrBase dispSrc[] = { GX_BG_BMPSCRBASE_0x20000, GX_BG_BMPSCRBASE_0x40000, GX_BG_BMPSCRBASE_0x60000, }; static void* dispAddr[] = { (void*)(HW_BG_VRAM + 0x20000), (void*)(HW_BG_VRAM + 0x40000), (void*)(HW_BG_VRAM + 0x60000), }; static CAMERASelect current; static void DebugReport(void) { const char* const str[] = { "HW_BG_VRAM + 0x20000", "HW_BG_VRAM + 0x40000", "HW_BG_VRAM + 0x60000" }; OSIntrMode enabled = OS_DisableInterrupts(); int wp_bak = wp; int rp_bak = rp; (void)OS_RestoreInterrupts(enabled); OS_TPrintf("\nCapture to %s\tDisplay from %s\n", str[wp_bak], str[rp_bak]); } static GXBGBmpScrBase GetNextDispSrc(void) { OSIntrMode enabled = OS_DisableInterrupts(); GXBGBmpScrBase base; int next = (rp + 1) % 3; if (next != wp) // Next buffer is not in the middle of a write { rp = next; } base = dispSrc[rp]; (void)OS_RestoreInterrupts(enabled); //DebugReport(); return base; } static void* GetNextCaptureAddr(void) { OSIntrMode enabled = OS_DisableInterrupts(); void* addr; int next = (wp + 1) % 3; if (wp_pending) // Recapture to the same buffer { wp_pending = FALSE; } else if (next != rp) // Next buffer is not in the middle of a load { // Capture results are not displayed on screen until camera is stable // This demo waits the minimum of four camera frames required to avoid chromatic aberration, but if you want to wait until auto-exposure is stable, you need to wait 14 frames for an indoor shot or 30 for an outdoor one, as indicated in the Function Reference. // if(stabilizedCount > 4) { wp = next; } } else // No buffer exists that can be captured (which is not possible from the FPS perspective) { OS_TPrintf("ERROR: there is no unused frame to capture.\n"); } addr = dispAddr[wp]; (void)OS_RestoreInterrupts(enabled); //DebugReport(); return addr; } static void PendingCapture(void) { wp_pending = TRUE; } // Display text (one row only) static u16 text_buffer[ 32 ] ATTRIBUTE_ALIGN(32); static void PutString( char *format, ... ) { u16 *dest = text_buffer; char temp[32+1]; int i; va_list va; va_start(va, format); (void)OS_VSNPrintf(temp, sizeof(temp), format, va); va_end(va); MI_CpuClearFast(text_buffer, sizeof(text_buffer)); for (i = 0; i < 32 && temp[i]; i++) { dest[i] = (u16)((u8)temp[i] | (1 << 12)); } DC_StoreRange(text_buffer, sizeof(text_buffer)); } /*---------------------------------------------------------------------------* Name: TwlMain Description: Main. Arguments: None. Returns: None. *---------------------------------------------------------------------------*/ void TwlMain() { CAMERAResult result; // Initialization OS_Init(); OS_InitThread(); GX_Init(); OS_InitTick(); OS_InitAlarm(); // DMA is not used in GX (the old DMA conflicts with camera DMA) (void)GX_SetDefaultDMA(GX_DMA_NOT_USE); // Clears VRAM GX_SetBankForLCDC(GX_VRAM_LCDC_A); GX_SetBankForLCDC(GX_VRAM_LCDC_B); GX_SetBankForLCDC(GX_VRAM_LCDC_C); GX_SetBankForLCDC(GX_VRAM_LCDC_D); MI_CpuClearFast((void*)HW_LCDC_VRAM_A, 128 * 1024); MI_CpuClearFast((void*)HW_LCDC_VRAM_B, 128 * 1024); MI_CpuClearFast((void*)HW_LCDC_VRAM_C, 128 * 1024); MI_CpuClearFast((void*)HW_LCDC_VRAM_D, 128 * 1024); // Direct bitmap display mode and text display GX_SetBankForBG(GX_VRAM_BG_512_ABCD); // Assign VRAM-A, B, C, and D banks to the background GX_SetGraphicsMode(GX_DISPMODE_GRAPHICS, GX_BGMODE_4, GX_BG0_AS_2D); GX_SetVisiblePlane(GX_PLANEMASK_BG1 | GX_PLANEMASK_BG3); G2_SetBG1Control(GX_BG_SCRSIZE_TEXT_256x256, GX_BG_COLORMODE_16, GX_BG_SCRBASE_0x0000, GX_BG_CHARBASE_0x04000, GX_BG_EXTPLTT_01); G2_SetBG1Priority(1); G2_BG1Mosaic(FALSE); wp = 0; rp = 2; wp_pending = TRUE; stabilizedCount = 0; switchFlag = FALSE; G2_SetBG3ControlDCBmp(GX_BG_SCRSIZE_DCBMP_256x256, GX_BG_AREAOVER_XLU, GetNextDispSrc()); G2_SetBG3Priority(3); G2_BG3Mosaic(FALSE); // Load text { static const GXRgb pal[16] = { GX_RGB(0, 0, 0), GX_RGB(31, 31, 31), }; GX_LoadBG1Char(DEMOAsciiChr, 0x00000, sizeof(DEMOAsciiChr)); GX_LoadBGPltt(pal, 0x0000, sizeof(pal)); } // V-Blank interrupt settings OS_SetIrqFunction(OS_IE_V_BLANK, VBlankIntr); (void)OS_EnableIrqMask(OS_IE_V_BLANK); (void)OS_EnableIrq(); (void)GX_VBlankIntr(TRUE); (void)OS_EnableInterrupts(); OS_WaitVBlankIntr(); GX_DispOn(); // Initialize camera current = CAMERA_SELECT_IN; (void)CameraInit(); // Configure DMA interrupt (void)OS_EnableIrqMask(OS_IE_NDMA1); // Camera VSYNC interrupt callback CAMERA_SetVsyncCallback(CameraIntrVsync); // Camera error interrupt callback CAMERA_SetBufferErrorCallback(CameraIntrError); // Camera restart completion callback CAMERA_SetRebootCallback(CameraIntrReboot); CAMERA_SetOutputFormat(CAMERA_OUTPUT_RGB); CAMERA_SetTransferLines(CAMERA_GET_MAX_LINES(WIDTH)); // Start capturing CAMERA_DmaRecvAsync(NDMA_NO, GetNextCaptureAddr(), CAMERA_GetBytesAtOnce(WIDTH), CAMERA_GET_FRAME_BYTES(WIDTH, HEIGHT), CameraDmaRecvIntr, NULL); CAMERA_ClearBuffer(); CAMERA_StartCapture(); OS_TPrintf("Camera is shooting a movie...\n"); while (1) { u16 pad; u16 trg; static u16 old = 0xffff; static BOOL standby = FALSE; OS_WaitVBlankIntr(); pad = PAD_Read(); trg = (u16)(pad & ~old); old = pad; if (trg & PAD_BUTTON_A) { DebugReport(); } if (trg & PAD_BUTTON_X) { switchFlag = TRUE; } if (trg & PAD_BUTTON_B) { standby ^= 1; if (standby) { // If you set Activate to NONE before StopCapture, there is a risk that IsBusy will be TRUE until the next time you set "Activate ON" CAMERA_StopCapture(); while(CAMERA_IsBusy()) { } MI_StopNDma(NDMA_NO); result = CAMERA_I2CActivate(CAMERA_SELECT_NONE); if(result == CAMERA_RESULT_FATAL_ERROR) OS_Panic("CAMERA FATAL ERROR\n"); } else { result = CAMERA_I2CActivate(current); if(result == CAMERA_RESULT_FATAL_ERROR) OS_Panic("CAMERA FATAL ERROR\n"); stabilizedCount = 0; CAMERA_DmaRecvAsync(NDMA_NO, GetNextCaptureAddr(), CAMERA_GetBytesAtOnce(WIDTH), CAMERA_GET_FRAME_BYTES(WIDTH, HEIGHT), CameraDmaRecvIntr, NULL); CAMERA_ClearBuffer(); CAMERA_StartCapture(); } OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS ? "SUCCESS" : "FAILED"); } } } //-------------------------------------------------------------------------------- // V-Blank interrupt process // void VBlankIntr(void) { OS_SetIrqCheckFlag(OS_IE_V_BLANK); G2_SetBG3ControlDCBmp(GX_BG_SCRSIZE_DCBMP_256x256, GX_BG_AREAOVER_XLU, GetNextDispSrc()); GX_LoadBG1Scr(text_buffer, 0, sizeof(text_buffer)); } //-------------------------------------------------------------------------------- // Camera initialization (only the Init- and I2C-related initialization) // BOOL CameraInit(void) { CAMERAResult result; result = CAMERA_Init(); if(result == CAMERA_RESULT_FATAL_ERROR) OS_TPanic("CAMERA_Init was failed."); if(result == CAMERA_RESULT_ILLEGAL_STATUS) return FALSE; result = CAMERA_I2CActivate(current); if (result == CAMERA_RESULT_FATAL_ERROR) OS_TPanic("CAMERA_I2CActivate was failed. (%d)\n", result); if(result == CAMERA_RESULT_ILLEGAL_STATUS) return FALSE; stabilizedCount = 0; return TRUE; } //-------------------------------------------------------------------------------- // Camera interrupt process (occurs both when there is an error and for Vsync) // #define FPS_SAMPLES 4 void CameraIntrError(CAMERAResult result) { #pragma unused(result) OS_TPrintf("Error was occurred.\n"); // Camera stop processing CAMERA_StopCapture(); MI_StopNDma(NDMA_NO); CAMERA_ClearBuffer(); PendingCapture(); // Also use same frame next time CAMERA_DmaRecvAsync(NDMA_NO, GetNextCaptureAddr(), CAMERA_GetBytesAtOnce(WIDTH), CAMERA_GET_FRAME_BYTES(WIDTH, HEIGHT), CameraDmaRecvIntr, NULL); CAMERA_StartCapture(); } void CameraIntrReboot(CAMERAResult result) { if(result == CAMERA_RESULT_FATAL_ERROR) { return; // Restore was not possible, even after restarting camera } CameraIntrError(result); // DMA synchronization might have drifted, so realign } void CameraIntrVsync(CAMERAResult result) { #pragma unused(result) if(stabilizedCount <= 30) stabilizedCount++; if(switchFlag) { current = (current == CAMERA_SELECT_IN ? CAMERA_SELECT_OUT : CAMERA_SELECT_IN); OS_TPrintf("call CAMERA_I2CActivate(%s)... ", (current == CAMERA_SELECT_IN ? "CAMERA_SELECT_IN" : "CAMERA_SELECT_OUT")); result = CAMERA_I2CActivate(current); if(result == CAMERA_RESULT_FATAL_ERROR) OS_Panic("CAMERA FATAL ERROR\n"); OS_TPrintf("%s\n", result == CAMERA_RESULT_SUCCESS ? "SUCCESS" : "FAILED"); stabilizedCount = 0; switchFlag = FALSE; } } void CameraDmaRecvIntr(void* arg) { #pragma unused(arg) MI_StopNDma(NDMA_NO); if (CAMERA_IsBusy() == TRUE) { if (MI_IsNDmaBusy(NDMA_NO)) // Check whether image transfer is complete { OS_TPrintf("DMA was not done until VBlank.\n"); MI_StopNDma(NDMA_NO); } // Start the next frame capture CAMERA_DmaRecvAsync(NDMA_NO, GetNextCaptureAddr(), CAMERA_GetBytesAtOnce(WIDTH), CAMERA_GET_FRAME_BYTES(WIDTH, HEIGHT), CameraDmaRecvIntr, NULL); } // Display frame rate { static OSTick begin = 0; static int uspf[FPS_SAMPLES] = { 0 }; static int count = 0; int i; int sum = 0; OSTick end = OS_GetTick(); if (begin) // Leave out the first time { uspf[count] = (int)OS_TicksToMicroSeconds(end - begin); count = (count + 1) % FPS_SAMPLES; } begin = end; // Calculate average value for (i = 0; i < FPS_SAMPLES; i++) { if (uspf[i] == 0) break; sum += uspf[i]; } if (sum) { int mfps = (int)(1000000000LL * i / sum); PutString("%2d.%03d fps", mfps / 1000, mfps % 1000); } } }