www.pudn.com > dm642video-driver.rar > video_hd.c

/* 
 *  Copyright 2003 by Texas Instruments Incorporated. 
 *  All rights reserved. Property of Texas Instruments Incorporated. 
 *  Restricted rights to use, duplicate or disclose this code are 
 *  granted through contract. 
 *   
 */ 
/* "@(#) DDK 1.10.00.21 06-26-03 (ddk-b10)" */ 
#include  
#include    
#include     
#include  
 
#include  
#include  
 
 
#include  
#include  
#include  
#include  
#include  
#include  
#include      
 
#include  
 
#include "colorbar.h" 
#include "evmdm642_vcapparams.h" 
#include "evmdm642_vdisparams.h"    
 
/* heap IDs defined in the BIOS configuration file */ 
extern Int EXTERNALHEAP; 
 
 
/* 
 * ======== main ======== 
 */ 
main() 
{ 
    /******************************************************/ 
    /* open CSL DAT module for fast copy                  */ 
    /******************************************************/ 
    CSL_init();                                              
    CACHE_clean(CACHE_L2ALL, 0, 0); 
    CACHE_setL2Mode(CACHE_256KCACHE);        
    CACHE_enableCaching(CACHE_EMIFA_CE00); 
    CACHE_enableCaching(CACHE_EMIFA_CE01); 
    DAT_open(DAT_CHAANY, DAT_PRI_LOW, DAT_OPEN_2D); 
 
} 
 
/* 
 * ======== tskVideoLoopback ======== 
 * video loopback function. 
 */ 
void tskVideoLoopback() 
{ 
    Int status; 
    FVID_Handle disChan;  
    Int frames = 0; 
    FVID_Frame *disFrameBuf; 
    Int numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1; 
    Int numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 - 
       EVMDM642_vCapParamsChan.fldYStrt1+1; 
 
     
    Int numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis; 
 
#ifdef _LOOPBACK 
    Int i; 
    FVID_Handle capChan;  
    Int numPixels = EVMDM642_vCapParamsChan.fldXStop1 -  
       EVMDM642_vCapParamsChan.fldXStrt1+1; 
    FVID_Frame *capFrameBuf; 
    Int capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 -  
       EVMDM642_vCapParamsChan.fldXStrt1+1; 
    Int disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1; 
 
 
#ifdef _PIP 
    VPORTCAP_Params EVMDM642_vCapParamsChan2 = EVMDM642_vCapParamsChan; 
    FVID_Handle capChan2;  
    FVID_Frame *capFrameBuf2; 
    Int yPitch; 
    Int cPitch; 
    Int xOffset; 
    Int yOffset = numLinesDis - numLines; 
    Int numLines2; 
    Int numPixels2; 
#endif 
#endif                 
 
  
    numLines *= 2; /* both fields */ 
    /******************************************************/ 
    /* allocate both capture and display frame buffers    */ 
    /* in external heap memory                            */ 
    /******************************************************/ 
        EVMDM642_vCapParamsChan.segId = EXTERNALHEAP; 
        EVMDM642_vDisParamsChan.segId = EXTERNALHEAP; 
        EVMDM642_vDisParamsSAA7105.hI2C = EVMDM642_I2C_hI2C; 
        EVMDM642_vCapParamsSAA7115.hI2C = EVMDM642_I2C_hI2C; 
 
    /******************************************************/ 
    /* initialization of capture driver                   */ 
    /******************************************************/ 
#ifdef _LOOPBACK 
    capChan = FVID_create("/VP0CAPTURE/A/0",  
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL); 
 
#ifdef _PIP 
    if(EVMDM642_vDisParamsChan.fldOp == VPORT_FLDOP_FRAME) { 
        yPitch = capLinePitch ; 
        cPitch = capLinePitch >> 1; 
        yOffset <<= 1; 
        numLines2 = numLines; 
        numPixels2 = numPixels; 
     }else { 
        EVMDM642_vCapParamsChan2.scale = VPORT_SCALING_ENABLE; 
            EVMDM642_vCapParamsChan2.fldOp = VPORT_FLDOP_FLD1;         
            EVMDM642_vCapParamsChan2.thrld >>=1; 
        yPitch = capLinePitch >> 1; 
        cPitch = ((capLinePitch >> 2) + 7) & (~ 7); 
        numLines2 = numLines >> 1; 
        numPixels2 = numPixels >> 1; 
    } 
    xOffset = disLinePitch - yPitch; 
    capChan2 = FVID_create("/VP1CAPTURE/A/1",  
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan2, NULL); 
#endif           
 
#endif           
    /******************************************************/ 
    /* initialization of display driver                   */ 
    /******************************************************/ 
    disChan = FVID_create("/VP2DISPLAY", IOM_OUTPUT,  
        &status, (Ptr)&EVMDM642_vDisParamsChan, NULL); 
 
     
    /******************************************************/ 
    /* configure video encoder & decoder                  */ 
    /******************************************************/ 
    FVID_control(disChan, VPORT_CMD_EDC_BASE + EDC_CONFIG,  
        (Ptr)&EVMDM642_vDisParamsSAA7105); 
#ifdef _LOOPBACK 
    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG,  
        (Ptr)&EVMDM642_vCapParamsSAA7115); 
#ifdef _PIP 
    EVMDM642_vCapParamsSAA7115.aFmt = SAA7115_AFMT_COMPOSITE; 
    FVID_control(capChan2, VPORT_CMD_EDC_BASE+EDC_CONFIG,  
        (Ptr)&EVMDM642_vCapParamsSAA7115); 
#endif 
#endif 
 
 
    /******************************************************/ 
    /* start capture & display operation                  */     
    /******************************************************/ 
    FVID_control(disChan, VPORT_CMD_START, NULL); 
#ifdef _LOOPBACK 
    FVID_control(capChan, VPORT_CMD_START, NULL); 
#ifdef _PIP 
    FVID_control(capChan2, VPORT_CMD_START, NULL); 
#endif     
#endif     
     
    /********************************************************/ 
    /* request a frame buffer from display & capture driver */ 
    /********************************************************/ 
    FVID_alloc(disChan, &disFrameBuf); 
#ifdef _LOOPBACK 
    FVID_alloc(capChan, &capFrameBuf); 
#ifdef _PIP 
    FVID_alloc(capChan2, &capFrameBuf2); 
#endif       
#endif 
    frames ++; 
 
    while(1){/* loop forever */ 
#ifdef _LOOPBACK 
        /* copy data from capture buffer to display buffer */ 
        /***************************************************/ 
 
        for(i = 0; i < numLines; i ++) { 
            DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch,  
                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch, 
                     numPixels); 
            DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1),  
                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1), 
                     numPixels>>1); 
 
            DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1),  
                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1), 
                     numPixels>>1); 
        } 
#ifdef _PIP   
        for(i = 0; i < numLines2; i ++) { 
            DAT_copy(capFrameBuf2->frame.iFrm.y1 + i * yPitch,  
                     disFrameBuf->frame.iFrm.y1 + (i + yOffset) * disLinePitch 
                     + xOffset, 
                     numPixels2); 
                      
            DAT_copy(capFrameBuf2->frame.iFrm.cb1 + i * cPitch,  
                     disFrameBuf->frame.iFrm.cb1 + (i + yOffset) * (disLinePitch >> 1) 
                     + (xOffset >> 1), 
                     (numPixels2 >> 1)); 
 
            DAT_copy(capFrameBuf2->frame.iFrm.cr1 + i * cPitch,  
                     disFrameBuf->frame.iFrm.cr1 + (i + yOffset) * (disLinePitch >> 1) 
                     +(xOffset >> 1), 
                     (numPixels2 >> 1)); 
        } 
#endif 
        FVID_exchange(capChan, &capFrameBuf); 
#ifdef _PIP 
        FVID_exchange(capChan2, &capFrameBuf2); 
#endif 
#else 
        fillFrmBuf(&disFrameBuf->frame.iFrm, EVMDM642_vDisParamsChan.imgHSizeFld1, 
          EVMDM642_vDisParamsChan.imgVSizeFld1  
            + EVMDM642_vDisParamsChan.imgVSizeFld2, 
          frames % 360); 
#endif 
        FVID_exchange(disChan, &disFrameBuf); 
         
        frames ++;               
   } 
}