video_ntsc_pal(1).c

TMS320C6000系列的DM642成像PAL摄像头采集

/*
 *  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>//使用CSL库，要用到的一些头文件，可参考CSL


#include <fvid.h>  //视频驱动头文件
#include <edc.h>
#include <vport.h>
#include <vportcap.h>
#include <vportdis.h>
#include <saa7105.h>
#include <saa7115.h>    

#include <evmdm642.h>

#include "colorbar.h"
#include "evmdm642_vcapparams.h"
#include "evmdm642_vdisparams.h"   

/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;//在DSP/BIOS中已定义


/*
 * ======== main ========
 */
main()
{
    /******************************************************/
    /* open CSL DAT module for fast copy                  */
    /******************************************************/
    CSL_init(); //调用任何CSL库中的函数，必须先在此调用该函数                                             
    CACHE_clean(CACHE_L2ALL, 0, 0);//清洗Cache
    CACHE_setL2Mode(CACHE_256KCACHE); //设置Cache模式      
    CACHE_enableCaching(CACHE_EMIFA_CE00);//使能EMIFA CE0空间
    CACHE_enableCaching(CACHE_EMIFA_CE01);//使能EMIFA CE1空间
    DAT_open(DAT_CHAANY, DAT_PRI_LOW, DAT_OPEN_2D);

}

/*
 * ======== tskVideoLoopback ========
 * video loopback function.
 */
void tskVideoLoopback()
{
    Int i;
    int m_nWork;
    Int status;
    FVID_Handle disChan; 
    Int frames = 0;
    FVID_Frame *disFrameBuf;
       /*设置显示的行数 VGA制式为480，PAL制为576*/

    Int numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1;
     /*设置采集的行数 PAL制为576*/

    Int numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 -
       EVMDM642_vCapParamsChan.fldYStrt1+1;
       /*判断是显示区域大，还是采集区域大，取其小者*/   
    
    Int numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis;

#ifdef _LOOPBACK
    FVID_Handle capChan; 
    /*设置采集像素数 PAL制为720*/

    Int numPixels = EVMDM642_vCapParamsChan.fldXStop1 - 
       EVMDM642_vCapParamsChan.fldXStrt1+1;
    FVID_Frame *capFrameBuf;
     /*设置采集行的增量 PAL制为720*/

    Int capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 - 
       EVMDM642_vCapParamsChan.fldXStrt1+1;
        /*设置显示行的增量 VGA制为640*/
    Int disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1;


#ifdef _PIP
    VPORTCAP_Params EVMDM642_vCapParamsChan2 = EVMDM642_vCapParamsChan;
    FVID_Handle capChan2; 
    FVID_Frame *capFrameBuf2;
    Int yPitch = capLinePitch >> 1;
    Int cPitch = ((capLinePitch >> 2) + 7) & (~ 7);
#endif
#endif                

 
    numLines *= 2; /* both fields */ //如果输出为PAL制，前面numLinesCap不要*2，这里再*2
    /******************************************************/
    /* 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
    EVMDM642_vCapParamsChan2.scale = VPORT_SCALING_ENABLE;
        EVMDM642_vCapParamsChan2.fldOp = VPORT_FLDOP_FLD1;        
        EVMDM642_vCapParamsChan2.thrld >>=1;
    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                  */
    /******************************************************/
    for ( m_nWork=0;m_nWork<6;m_nWork++ )
    {
	    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 ++) {
        
        IMG_sobel(capFrameBuf->frame.iFrm.y1,// + i * capLinePitch, 
                   disFrameBuf->frame.iFrm.y1,// + i * disLinePitch,
                  720 ,576);
                  
                  
                  
                  
                  
         
        
           //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 < (numLines>>1); i ++) {
            DAT_copy(capFrameBuf2->frame.iFrm.y1 + i * yPitch, 
                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch
                     + (disLinePitch >> 1),
                     (numPixels>>1));
            DAT_copy(capFrameBuf2->frame.iFrm.cb1 + i * cPitch, 
                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)
                     + (disLinePitch >>2 ),
                     (numPixels >> 2));

            DAT_copy(capFrameBuf2->frame.iFrm.cr1 + i * cPitch, 
                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)
                     +(disLinePitch >> 2),
                     (numPixels >> 2));
                     
            sobel_
        }
#endif
        DAT_wait(DAT_XFRID_WAITALL);
        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 ++;              
   }
}





for(i = 0; i < numLines; i ++) 
      
      {
        
        {if(capFrameBuf->frame.iFrm.cb1<=123&&capFrameBuf->frame.iFrm.cb1>=108)
        {
        if(capFrameBuf->frame.iFrm.cr1<=156&&capFrameBuf->frame.iFrm.cr1>=135)
         capFrameBuf->frame.iFrm.cr1=128;
         capFrameBuf->frame.iFrm.cb1=128;
         capFrameBuf->frame.iFrm.y1=180;
         else 
         capFrameBuf->frame.iFrm.cr1=129;
         capFrameBuf->frame.iFrm.cb1=129;
         capFrameBuf->frame.iFrm.jy1=16;
        
        }
        else capFrameBuf->frame.iFrm.cr1=129;
         capFrameBuf->frame.iFrm.cb1=129;
         capFrameBuf->frame.iFrm.y1=16;
       }
       }