video.c

基于DSP的视频程序,适用C6000系列.开发平台CCS 2 ( C6000)

/*
 *  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.23 07-02-03 (ddk-b12)" */
#include <std.h>
#include <tsk.h>  
#include <sem.h>   
#include <gio.h>

#include <csl_dat.h>
#include <csl_cache.h>


#include <fvid.h>
#include <edc.h>
#include <vport.h>
#include <vportcap.h>
#include <vportdis.h>
#include "saa7121.h"
#include "tvp5150a.h"    
#include <evmdm642.h>

#include "vcapparams.h"
#include "vdisparams.h"   

/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;
extern unsigned char nMemTemp1[720*582];
extern unsigned char nMemTemp2[720*582];
extern void toggleLed();
/*
 * ======== 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 i,j;
    unsigned int m_nID;
    Int status;
    Int a=0,b=0;//记录点
    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;

    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;

    numLines *= 2; /* both fields */
    /******************************************************/
    /* allocate both capture and display frame buffers    */
    /* in external heap memory                            */
    /******************************************************/
        EVMDM642_vCapParamsChan.segId = EXTERNALHEAP;
        EVMDM642_vDisParamsChan.segId = EXTERNALHEAP;
        EVMDM642_vDisParamsSAA7121.hI2C = EVMDM642_I2C_hI2C;
        EVMDM642_vCapParamsTVP5150A.hI2C = EVMDM642_I2C_hI2C;

    /******************************************************/
    /* initialization of capture driver                   */
    /******************************************************/
    capChan=FVID_create("/VP0CAPTURE/A/0",IOM_INPUT,&status,(Ptr)&EVMDM642_vCapParamsChan,NULL);
    /******************************************************/
    /* initialization of display driver                   */
    /******************************************************/
    disChan=FVID_create("/VP2DISPLAY/0",IOM_OUTPUT,&status,(Ptr)&EVMDM642_vDisParamsChan,NULL);
    
    /******************************************************/
    /* configure video encoder & decoder                  */
    /******************************************************/
    FVID_control(disChan,VPORT_CMD_EDC_BASE+EDC_CONFIG,(Ptr)&EVMDM642_vDisParamsSAA7121);
    FVID_control(capChan,VPORT_CMD_EDC_BASE+EDC_CONFIG,(Ptr)&EVMDM642_vCapParamsTVP5150A);

    /******************************************************/
    /* start capture & display operation                  */    
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_START, NULL);
    FVID_control(capChan, VPORT_CMD_START, NULL);
    
    /********************************************************/
    /* request a frame buffer from display & capture driver */
    /********************************************************/
    FVID_alloc(disChan, &disFrameBuf);
    FVID_alloc(capChan, &capFrameBuf);
    toggleLed(0x40);
    frames ++;
    toggleLed(0x00);

    while ( 1 )
  {
    if(frames%2)
        for ( i = 0; i < numLines; i ++ ) 
        {
         m_nID=DAT_copy(capFrameBuf->frame.iFrm.y1+i*capLinePitch,nMemTemp1+i*numPixels,numPixels);
         DAT_wait(m_nID);
         //DAT_copy(nMemTemp1+i*numPixels,disFrameBuf->frame.iFrm.y1+i*disLinePitch,numPixels);
        }           
    else
         for ( i = 0; i < numLines; i ++ ) 
        {
          m_nID=DAT_copy(capFrameBuf->frame.iFrm.y1+i*capLinePitch,nMemTemp2+i*numPixels,numPixels);
          DAT_wait(m_nID);
        }
        
   if(!(frames%2)) 
         {
          if(frames<3)
            { 
             imagesub(nMemTemp1,nMemTemp2,&a,&b); 
             }
          else
             {imagesub(nMemTemp1,nMemTemp2,&a,&b);
             }
         }
                
   if(!(frames%2))                    
          for ( i = 0; i < numLines; i ++ ) 
              {
               DAT_copy(nMemTemp1+i*numPixels,disFrameBuf->frame.iFrm.y1+i*disLinePitch,numPixels);
              } 
        //DAT_copy2d(DAT_1D2D,capFrameBuf->frame.iFrm.y1,disFrameBuf->frame.iFrm.y1,720,576,720);
        //DAT_copy2d(DAT_1D2D,capFrameBuf->frame.iFrm.cb1,disFrameBuf->frame.iFrm.cb1,360,576,360);
        //DAT_copy2d(DAT_1D2D,capFrameBuf->frame.iFrm.cr1,disFrameBuf->frame.iFrm.cr1,360,576,360);
        DAT_wait(DAT_XFRID_WAITALL);
        FVID_exchange(capChan, &capFrameBuf);
        FVID_exchange(disChan, &disFrameBuf);        
         if(frames%2)
        {
         toggleLed(0x40);
         frames++;
         toggleLed(0x00);
        }
        else
        {
        toggleLed(0x80); 
        frames ++; 
        toggleLed(0x00);
        }              
   }
}