video.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 <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 <saa7105.h>
#include <saa7115.h>    

#include <evmdm642.h>

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

#include "ICETEK-DM642-PCI.h"

/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;
//extern unsigned char nMemTemp[720];
extern int z;

extern unsigned int m_uVideoStatus,m_bFreeze;
extern unsigned char m_dbFrameY[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameU[SIMGWIDTH1*SIMGHEIGHT1];
extern unsigned char m_dbFrameV[SIMGWIDTH1*SIMGHEIGHT1];

extern unsigned char m_dbFrameYz1[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz2[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz3[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz4[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz5[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz6[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz7[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz8[SIMGWIDTH*SIMGHEIGHT];
extern unsigned char m_dbFrameYz9[SIMGWIDTH*SIMGHEIGHT];

/*
 * ======== main ========
 */
main()
{
    /******************************************************/
    /* open CSL DAT module for fast copy                  */
    /******************************************************/
    CSL_init();                                             
    CACHE_clean(CACHE_L2ALL, 0, 0);
//    CACHE_setL2Mode(CACHE_256KCACHE);       
    CACHE_setL2Mode(CACHE_0KCACHE);       
    CACHE_enableCaching(CACHE_EMIFA_CE00);
    CACHE_enableCaching(CACHE_EMIFA_CE01);
    DAT_open(DAT_CHAANY, DAT_PRI_LOW, DAT_OPEN_2D);

	ICETEKDM642PCIBoardInit();
}

/*
 * ======== tskVideoLoopback ========
 * video loopback function.
 */
void tskVideoLoopback()
{
 
    
    int i;
    unsigned int m_nID;
    int frames = 0;
    FVID_Handle disChan;
    Int capLinePitch = EVMDM642_vCapParamsChan.fldXStop1 - 
    EVMDM642_vCapParamsChan.fldXStrt1+1;
  int disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1;
FVID_Frame *disFrameBuf;

    
    int m_nWork;
   int status;
   int j;
   int s;

   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;

    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                   */
    /******************************************************/
    capChan = FVID_create("/VP0CAPTURE/A/0", 
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);

    /******************************************************/
    /* 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);
	    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
	        (Ptr)&EVMDM642_vCapParamsSAA7115);
	}

    /******************************************************/
    /* 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);
    frames ++;
    

       while ( 1 )
    {
        switch ( m_uVideoStatus )
        {
        	case FREEZE:
        	ICETEKDM642PCIImageProcessReverse();
		        DAT_copy2d(DAT_2D2D,
		        			m_dbFrameY,
		        				disFrameBuf->frame.iFrm.y1,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_copy2d(DAT_2D2D,
		        			m_dbFrameV,
		        				disFrameBuf->frame.iFrm.cb1,
		        					numPixels>>1,
		        						numLines,
		        							numPixels>>1);
		        DAT_copy2d(DAT_2D2D,
		        			m_dbFrameU,
		        				disFrameBuf->frame.iFrm.cr1,
		        					numPixels>>1,
		        						numLines,
		        							numPixels>>1);
				if ( !m_bFreeze )
				{
					ICETEKDM642PCIYUVRGB();
					m_bFreeze=1;
				}
        		break;
        	case LOOPBACK:
			default:
		     
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameY,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz1,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
                m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz2,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz3,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz4,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz5,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz6,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz7,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz8,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		        m_nID=DAT_copy2d(DAT_2D2D,
		        			capFrameBuf->frame.iFrm.y1,
		        				m_dbFrameYz9,
		        					numPixels,
		        						numLines,
		        							numPixels);
		        DAT_wait(m_nID);
		       // DAT_copy2d(DAT_2D2D,
		       // 			capFrameBuf->frame.iFrm.cb1,
		       // 				m_dbFrameV,
		       // 					numPixels>>1,
		       // 						numLines,
		       // 							numPixels>>1);

		        //DAT_copy2d(DAT_2D2D,
		        //			capFrameBuf->frame.iFrm.cr1,
		        //				m_dbFrameU,
		        //					numPixels>>1,
		        //						numLines,
		        //							numPixels>>1);
		        //ICETEKDM642PCIImageProcessReverse();
    for (j=0;j<576;j++)
	for ( s=0;s<720;s++ )
	{
	    if(m_dbFrameY[s+j*720]>127)
	    //+m_dbFrameYz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzzz[s+j*720])/4>127)
	    m_dbFrameY[s+j*720]=255;
	    else
	   m_dbFrameY[s+j*720]=(m_dbFrameY[s+j*720]+m_dbFrameYz1[s+j*720]+m_dbFrameYz2[s+j*720]+m_dbFrameYz3[s+j*720]
	                        +m_dbFrameYz4[s+j*720]+m_dbFrameYz5[s+j*720]+m_dbFrameYz6[s+j*720]+m_dbFrameYz7[s+j*720]
	                        +m_dbFrameYz8[s+j*720]+m_dbFrameYz9[s+j*720])/5;
	   // m_dbFrameY[s+j*720]=(m_dbFrameY[s+j*720]+m_dbFrameYz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzzz[s+j*720]
	   //                     +m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]
	   //                     +m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]
	   //                     +m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]
	   //                     +m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]+m_dbFrameY[s+j*720]
	   //                     +m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]+m_dbFrameYz[s+j*720]
	   //                    +m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]+m_dbFrameYzz[s+j*720]
	   //                     +m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720]
	   //                     +m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720]+m_dbFrameYzzz[s+j*720])/12;

    		
	}
    for (j=0;j<576;j++)
	for ( s=0;s<360;s++ )
	{
    	m_dbFrameU[s+j*360]=0x080;
		m_dbFrameV[s+j*360]=0x080;
	}
		       DAT_copy2d(DAT_2D2D,
		        			m_dbFrameY,
		        				disFrameBuf->frame.iFrm.y1,
		        					numPixels,
		        						numLines,
		        							numPixels);
		       DAT_copy2d(DAT_2D2D,
		        			m_dbFrameV,
		        				disFrameBuf->frame.iFrm.cb1,
		       					numPixels>>1,
		        						numLines,
		        							numPixels>>1);
		       DAT_copy2d(DAT_2D2D,
		       			m_dbFrameU,
		        				disFrameBuf->frame.iFrm.cr1,
		       					numPixels>>1,
		       						numLines,
		       							numPixels>>1);
				m_bFreeze=0;
        		break;   
      }
        DAT_wait(DAT_XFRID_WAITALL);
        FVID_exchange(capChan, &capFrameBuf);
        FVID_exchange(disChan, &disFrameBuf);        
        frames ++;              
   }
   }