image_vdp_6.c

DM642视频例程

/*
 *  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 <rtdx.h62>
#include <std.h>

#include <tsk.h>  
#include <sem.h>   
#include <gio.h>

#include <csl_dat.h>
#include <csl_cache.h>
#include <csl.h>
#include <csl_edma.h>
#include <sys.h>
#include <log.h>

#include <fvid.h>
#include <edc.h>
#include <vport.h>
#include <vportcap.h>
#include <vportdis.h>
#include <saa7104.h>
#include <tvp5150a.h>    

#include <dm642.h>

#include "colorbar.h"
#include "evmdm642_vcapparams.h"
#include "evmdm642_vdisparams.h"  
    unsigned char Y1[360*288];
    unsigned char CB1[360*144];
    unsigned char CR1[360*144];
     
/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;

//*RTDX_CreateOutputChannel(ochan);

	Int status;
 	FVID_Handle capChan; 
    FVID_Handle disChan; 
    Int frames = 0;
    FVID_Frame *disFrameBuf;
    FVID_Frame *capFrameBuf;
    Int numLinesDis = 0;
    Int numLinesCap = 0;
    Int numLines = 0;
//    Int numColumes = 0;    
    Int numPixels = 0;
    Int capLinePitch = 0;
    Int disLinePitch = 0;
    void myImageProcess();
/*
 * ======== 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()
{
    
    
    numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1;
    numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 -
       EVMDM642_vCapParamsChan.fldYStrt1+1;

    
    numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis;
   

#ifdef _LOOPBACK
   
    numPixels = EVMDM642_vCapParamsChan.fldXStop1 - 
       EVMDM642_vCapParamsChan.fldXStrt1+1;
    
    capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 - 
       EVMDM642_vCapParamsChan.fldXStrt1+1;
    disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1;
     
#endif      

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

    /******************************************************/
    /* initialization of capture driver                   */
    /******************************************************/
#ifdef _LOOPBACK

#ifdef _VP2
    capChan = FVID_create("/VP2CAPTURE/A/1", 
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);
#else  
    capChan = FVID_create("/VP0CAPTURE/A/0", 
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);

#endif 
#endif 
       

          
    /******************************************************/
    /* initialization of display driver                   */
    /******************************************************/
    disChan = FVID_create("/VP1DISPLAY", IOM_OUTPUT, 
        &status, (Ptr)&EVMDM642_vDisParamsChan, NULL);

    
    /******************************************************/
    /* configure video encoder & decoder                  */
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
        (Ptr)&EVMDM642_vDisParamsSAA7104);
#ifdef _LOOPBACK
    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
        (Ptr)&EVMDM642_vCapParamsTVP5150A);
#endif
    //EVMDM642_rset(0x10, 0x20);
    //EVMDM642_rset(0x10, 0x08);
    //while(!(EVMDM642_rget(0x13) & 0x40));


    /******************************************************/
    /* start capture & display operation                  */    
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_START, NULL);
#ifdef _LOOPBACK
    FVID_control(capChan, VPORT_CMD_START, NULL);
#endif    
    
    /********************************************************/
    /* request a frame buffer from display & capture driver */
    /********************************************************/
    FVID_alloc(disChan, &disFrameBuf);
#ifdef _LOOPBACK 
    FVID_alloc(capChan, &capFrameBuf);
#endif
    frames ++;


    while(1){/* loop forever */
#ifdef _LOOPBACK

	#ifdef _PROCESS  
       
         myImageProcess();
     
	#else
        Int i;
   /*   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);
        }
     #endif   

        FVID_exchange(capChan, &capFrameBuf);

#else
        fillFrmBuf(&disFrameBuf->frame.iFrm, 
			       EVMDM642_vDisParamsChan.imgHSizeFld1,
                   EVMDM642_vDisParamsChan.imgVSizeFld1 + 
		           EVMDM642_vDisParamsChan.imgVSizeFld2,
                   frames % 360);
#endif
        FVID_exchange(disChan, &disFrameBuf);
        
        frames ++;              
   }
}

void myImageProcess()
{ 

    Int i;
         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); 
		      
         }
/*
         for(i = 0; i < numLines; i ++) //输出原始图像到右上角
         {
	          DAT_copy(capFrameBuf->frame.iFrm.y1 + i * (capLinePitch), 
	                   disFrameBuf->frame.iFrm.y1 + i * (disLinePitch)+360,
	                   numPixels);
           
	          DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), 
	                   disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)+180,
	                   numPixels>>1);
		      
	          DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), 
	                   disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)+180,
	                   numPixels>>1); 
		      
         }   

*/ 

         for(i =  numLines; i <  288+numLines; i ++) //输出原始图像到左下角
         {
	          DAT_copy(capFrameBuf->frame.iFrm.y1 + (i-288) * (capLinePitch), 
	                   disFrameBuf->frame.iFrm.y1 + i * (disLinePitch),
	                   numPixels);
           
	          DAT_copy(capFrameBuf->frame.iFrm.cb1 + (i-288) * (capLinePitch >> 1), 
	                   disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1),
	                   numPixels>>1);
		      
	          DAT_copy(capFrameBuf->frame.iFrm.cr1 + (i-288) * (capLinePitch >> 1), 
	                   disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1),
	                   numPixels>>1); 
		      
         }
        
                               
        for (i=0; i<numLines; i++)  //输出处理后的图像到右上角
        {
         IMG_median_3x3(capFrameBuf->frame.iFrm.y1 + i * (disLinePitch>>1),
	   		            numPixels,
	   		            disFrameBuf->frame.iFrm.y1 + i * (disLinePitch)+360); 
   		 IMG_median_3x3(capFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 2),
		                numPixels>>1,
		                disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)+180);
		 IMG_median_3x3(capFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 2),
		                numPixels>>1,
		                disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)+180);                    
        }

   }