tskloopback.c

seed提供的版级代码

/*
 *  Copyright 2004 by SEED Incorporated.
 *  All rights reserved. Property of SEED Incorporated.
 *  Restricted rights to use, duplicate or disclose this code are
 *  granted through contract.
 *  
 */
/* "@(#) DDK 1.11.00.00 23-12-04 (ddk-b13)" */
#include <vport.h>
#include <vportcap.h>
#include <tvp51xx.h> 
#include <csl_edma.h>
#include <fvid.h>
#include <csl_dat.h>
#include <csl_cache.h>


//#include "appData.h"
#include "seeddm642.h"
#include "seedvpm642cfg.h"
#include "seedvpm642_vcapparams.h"
#include "seedvpm642_vdisparams.h"
#include "seedvpm642_mailbox.h"

extern int EXTERNALHEAP;
extern MBX_Obj VP1CAPTURE;
FVID_Handle  disChan;
Bool Ch1run =TRUE;
Bool Ch2arun =TRUE;
Bool Ch2brun =TRUE;
/*
 * ======== tskVideoLoopback ========
 * video loopback function.
 */
void tskVideoLoopback()
{
	Int status;
	int n = 0;
	Int i;
	int m = 0;	
	FVID_Frame *capFrameBuf,*temp;
	FVID_Frame *disFrameBuf;
    /*设置显示的行数*/
    Int numLinesDis = EVMDM642_vDisParamsChan.imgVSizeFld1;
    /*设置采集的行数*/
    Int numLinesCap = SEEDVPM642_vCapParamsChan.fldYStop1 -
       			      SEEDVPM642_vCapParamsChan.fldYStrt1+1;
    /*判断是显示区域大，还是采集区域大，取其小者*/   
    Int numLines = (numLinesDis > numLinesCap) ? numLinesCap : numLinesDis;
    /*设置采集像素数*/
    Int numPixels = SEEDVPM642_vCapParamsChan.fldXStop1 - 
       			    SEEDVPM642_vCapParamsChan.fldXStrt1+1;
    /*设置采集行的增量*/
    Int capLinePitch = SEEDVPM642_vCapParamsChan.fldXStop1 - 
                       SEEDVPM642_vCapParamsChan.fldXStrt1+1;
    /*设置显示行的增量*/
    Int disLinePitch = EVMDM642_vDisParamsChan.imgHSizeFld1;
    
    
	EVMDM642_vDisParamsChan.segId = EXTERNALHEAP; //EXTERNALHEAP;
    EVMDM642_vDisParamsSAA7105.hI2C = SEEDVPM642_I2C_hI2C;
    
    numLines *= 2; /* both fields */
    /******************************************************/
    /* initialization of display driver                   */
    /******************************************************/     
    disChan = FVID_create("/VP0DISPLAY/A/0", 
    					  IOM_OUTPUT, 
        				  &status, 
        				  (Ptr)&EVMDM642_vDisParamsChan, 
        				  NULL);
    /******************************************************/
    /* configure video decoder      			          */
    /******************************************************/
    FVID_control(disChan, 
    			 VPORT_CMD_EDC_BASE + EDC_CONFIG, 
        		(Ptr)&EVMDM642_vDisParamsSAA7105);   
    /******************************************************/
    /* configure video encoder & decoder                  */
    /******************************************************/
    /*配置SAA7121*/
    FVID_control(disChan, 
    			 VPORT_CMD_EDC_BASE + EDC_CONFIG, 
                 (Ptr)&EVMDM642_vDisParamsSAA7105);  		     
    /*启动显示*/
    FVID_control(disChan, VPORT_CMD_START, NULL);      
    /*申请一个空间*/
    FVID_alloc(disChan, &disFrameBuf); 
    /* loop forever */
    while(1)
    {
    	if(Ch1run == TRUE)
    	{
    		/* Wait for semaphore to be posted by vp1 capture*/
	    	SEM_pend(&vp1sem, SYS_FOREVER);
	    	LOG_printf(&trace,"get sem:%x",m++);
	    	/*获取当前的队列中的缓冲区*/     	 
	    	if((temp= (FVID_Frame *)QUE_get(&vp1que))!=(FVID_Frame *)&vp1que)
	    	{
	    		capFrameBuf = temp;
	    		/*将数据放入相应的显示缓冲区*/
	        	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);
		         }
		         
	        }
	        Ch1run = FALSE;
    	}
//		if(Ch2arun == TRUE)
//		{
	        /* Wait for semaphore to be posted by vp1 capture*/
//	    	SEM_pend(&vp2asem, SYS_FOREVER);
//	    	LOG_printf(&trace,"get vp2sem:%x",m++);
	    	/*获取当前的队列中的缓冲区*/     	 
//	    	if((temp= (FVID_Frame *)QUE_get(&vp2que))!=(FVID_Frame *)&vp2que)
//	    	{
//	    		capFrameBuf = temp;
	    		/*将数据放入相应的显示缓冲区*/
/*	        	for(i = 0; i < numLines; i ++) 
		        {
		            DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch, 
		                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch+720*280,
		                     numPixels);
		            DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), 
		                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)+360*280,
		                     numPixels>>1);
		
		            DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), 
		                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)+360*280,
		                     numPixels>>1);
		         }   	      	
	      		 DAT_wait(DAT_XFRID_WAITALL); 
	      		 Ch2arun = FALSE;
	        }
	        
	    }*/
//	    if(Ch2brun == TRUE)
//		{
	        /* Wait for semaphore to be posted by vp1 capture*/
//	    	SEM_pend(&vp2bsem, SYS_FOREVER);
//	    	LOG_printf(&trace,"get vp2bsem:%x",m++);
	    	/*获取当前的队列中的缓冲区*/     	 
//	    	if((temp= (FVID_Frame *)QUE_get(&vp2bque))!=(FVID_Frame *)&vp2bque)
//	    	{
//	    		capFrameBuf = temp;
	    		/*将数据放入相应的显示缓冲区*/
/*	        	for(i = 0; i < numLines; i ++) 
		        {
		            DAT_copy(capFrameBuf->frame.iFrm.y1 + i * capLinePitch, 
		                     disFrameBuf->frame.iFrm.y1 + i * disLinePitch+720*280+360,
		                     numPixels);
		            DAT_copy(capFrameBuf->frame.iFrm.cb1 + i * (capLinePitch >> 1), 
		                     disFrameBuf->frame.iFrm.cb1 + i * (disLinePitch >> 1)+360*280+180,
		                     numPixels>>1);
		
		            DAT_copy(capFrameBuf->frame.iFrm.cr1 + i * (capLinePitch >> 1), 
		                     disFrameBuf->frame.iFrm.cr1 + i * (disLinePitch >> 1)+360*280+180,
		                     numPixels>>1);
		         }
		         DAT_wait(DAT_XFRID_WAITALL);     	      	
	        }
	        Ch2brun = FALSE;
	    }*/
	    if((Ch1run == FALSE))
	    {
		    /*交换缓冲区*/
		    FVID_exchange(disChan, &disFrameBuf);
	        /*通知进行下一次采样*/
	        Ch1run = TRUE;
	        Ch2arun = TRUE;
//	        Ch2brun = TRUE;
	        SEM_post(&vp1semcap);
//	        SEM_post(&vp2asemcap);
//	        SEM_post(&vp2bsemcap);
	    }                             
    }
}