video_ntsc_pal.c

TIDSP下的图像采集处理程序

/*直方图统计
 *  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 <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 <saa7105.h>
#include <saa7115.h>    

#include <evmdm642.h>

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

    unsigned char Y1[720*576];
    unsigned char CB1[720*288];
    unsigned char CR1[720*288];
    
/* heap IDs defined in the BIOS configuration file */
extern Int EXTERNALHEAP;




    FVID_Handle disChan; 
    FVID_Handle capChan;
    FVID_Frame *capFrameBuf=NULL;
    FVID_Frame *disFrameBuf=NULL;
   
    Int numLinesDis=0 ;
    Int numLinesCap=0;
    Int numLines=0 ;
 
    Int numPixels =0;
    Int capLinePitch=0 ;
    Int disLinePitch=0 ;
    void myImageProcess();
    void generateColorLine();
     int histgram[360];
/*
 * ======== 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);
}

/*
 * ======== tskVideoCAPTURE ========
 * video CAPTURE function.
 */
void tskVideoCapture()
{
    Int status,i;

    Int frames = 0;

    numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1;
    numLinesCap = EVMDM642_vCapParamsChan.fldYStop1 - EVMDM642_vCapParamsChan.fldYStrt1+1;
    numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis;
   // char mLaplacian[3*3]={ -1,-1,-1, -1,9,-1,-1,-1,-1};

#ifdef _CAPTURE
      
     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 */
    /******************************************************/
    /* 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 _CAPTURE
    capChan = FVID_create("/VP0CAPTURE/A/0", 
            IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);
#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 _CAPTURE
    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
        (Ptr)&EVMDM642_vCapParamsSAA7115);
  
#endif


    /******************************************************/
    /* start capture & display operation                  */    
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_START, NULL);
#ifdef _CAPTURE
    FVID_control(capChan, VPORT_CMD_START, NULL);      
#endif    
    
    /********************************************************/
    /* request a frame buffer from display & capture driver */
    /********************************************************/
    FVID_alloc(disChan, &disFrameBuf);
#ifdef _CAPTURE
    FVID_alloc(capChan, &capFrameBuf);        
#endif
    frames ++;
    
    while(1)
    {/* loop forever */
#ifdef _CAPTURE
        
        
       
#ifdef _PROCESS  
       
         myImageProcess();
       
#else
        
        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        
        
   
        DAT_wait(DAT_XFRID_WAITALL);
        FVID_exchange(capChan, &capFrameBuf);
 
#else
        fillFrmBuf(&disFrameBuf->frame.iFrm, EVMDM642_vDisParamsChan.imgHSizeFld1,
            EVMDM642_vDisParamsChan.imgVSizeFld1  + 
            EVMDM642_vDisParamsChan.imgVSizeFld2, frames % 360);
#endif
        CACHE_clean(CACHE_L2ALL,NULL,NULL);
        FVID_exchange(disChan, &disFrameBuf);        
        frames ++;              
   }
}

   
void myImageProcess()
{
	Uint32 i=0,ii;
	float j=0;
	Uint8 * temp_address1;	

	for(i = 0; i < numLines; i ++) {
        
          DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch, 
                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch,
                     numPixels>>1);
          DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), 
                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1),
                     numPixels>>2);
          DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), 
                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1),
                     numPixels>>2); 
    }
   
		
	temp_address1=(Uint8 *)capFrameBuf->frame.iFrm.y1;//capFrameBuf->frame.rpFrm.buf;//&InBufferY[0];
	
	for(i=0;i<360;i++)
		histgram[i]=0;
	
	for(i=0;i<numLines;i++)
	  for (ii=0;ii<360;ii++)   
	   {
	      histgram[ii]=histgram[ii]+temp_address1[i*disLinePitch+ii];		
       }
	
	j=0;	
	for(i=0;i<360;i++)
	{
		if(histgram[i]>j)
			j=histgram[i];
	}	
	for(i=0;i<360;i++)
	{
	    histgram[i]=(int)((float)histgram[i]/j* numLines/2);
	}
	
	generateColorLine();
	

}


void generateColorLine()
{
    Int i;   
    Int k;
    
    
     for (i=0;i<360;i++)
     {
         
       for (k=0;k<numLines;k++)
        {
          
          
          
           if (((numLines-k) <= histgram[i])) //&&  (i<256))
           {
              disFrameBuf->frame.iFrm.y1[k*720+360+i] = RED_Y;
              /*
              if (i%2==0)
              {  
                 disFrameBuf->frame.iFrm.cb1[k*360+180+i/2] = RED_CB;
                 disFrameBuf->frame.iFrm.cr1[k*360+180+i/2] = RED_CR;
              }
              */
           }
           else
           {
             disFrameBuf->frame.iFrm.y1[k*720+360+i] = WHITE_Y;
             /*
             if (i%2==0)
             {  
               disFrameBuf->frame.iFrm.cb1[k*360+180+i/2] = WHITE_CR;
               disFrameBuf->frame.iFrm.cr1[k*360+180+i/2] = WHITE_CB;  
             } 
             */
              
           }
         }
    }
      
}