video_ntsc_pal.c

TI DSP DM642图像处理程序,---直方图均衡

/* ======================================================================== */
/*  Copyright 2003 by Wintech Digital System Technology Corp.               */
/*  All rights reserved. Property of Texas Instruments Incorporated.        */
/*  Restricted rights to use, duplicate or disclose this code are           */
/*  granted through contract.	                                            */														
/* ======================================================================== */

#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 "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];
void VidDisMode(Int displaymode);
/*
 * ======== 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;

    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_vDisParamsSAA7104.hI2C = EVMDM642_I2C_hI2C;
        EVMDM642_vCapParamsTVP5150A.hI2C = EVMDM642_I2C_hI2C;

    /******************************************************/
    /* initialization of capture driver                   */
    /******************************************************/
#ifdef _CAPTURE
    capChan = FVID_create("/VP1CAPTURE/A/1", 
            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_vDisParamsSAA7104);
#ifdef _CAPTURE
    FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
        (Ptr)&EVMDM642_vCapParamsTVP5150A);
  
#endif

    /******************************************************/
    /* start capture & display operation                  */    
    /******************************************************/
    FVID_control(disChan, VPORT_CMD_START, NULL);
#ifdef _CAPTURE
    FVID_control(capChan, VPORT_CMD_START, NULL);      
#endif    
  VidDisMode(1);  
    /********************************************************/
    /* 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 ++;              
   }
}

/*
 * Image process
 */   
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();	

}
/*
 * generate colorline
 */
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;  
             } 
             */              
           }
         }
    }
      
}
void VidDisMode(Int displaymode)
{

    *((volatile unsigned int *)0x01b4c010) =0x00000004|*((volatile unsigned int *)0x01b4c010); //configure video mode 
    *((volatile unsigned int *)0x01b4c014) =0x00000004|*((volatile unsigned int *)0x01b4c014);
  		
	switch(displaymode)
	{
	
     	case 0 : *((volatile unsigned int *)0x01b4c01c) = 0x00000004; break;     
     	case 1 : *((volatile unsigned int *)0x01b4c01c) = 0x00000004; break; 
     	case 2 : *((volatile unsigned int *)0x01b4c01c) = 0x00000000; break; 
     	default : *((volatile unsigned int *)0x01b4c01c) = 0x00000004;  
     	
     }
}
/* ======================================================================== */
/*             Copyright (c) 2003 Wintech Digital System Technology Corp.   */
/*                         All Rights Reserved.                             */
/* ======================================================================== */