main.c

DM642的VP口驱动

/*
 *  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 <stdio.h>

#include <std.h>
#include <tsk.h>  
#include <sem.h>   
#include <gio.h>

#include <csl_dat.h>
#include <csl_cache.h>
#include <csl_vp.h>

#include <edc.h>
#include <vport.h>
#include <vportcap.h>
#include <vportdis.h>
#include <saa7105.h>
#include <saa7115.h>    



#include "../VideoCapturecfg.h"
#include "evmdm642_vcapparams.h"

#include <evmdm642.h>
#include <CapVP.h>

extern CapChan_Params CapChanParams;

/*
 * ======== 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);
}

void TSK_CapVideo(void)
{
    Int status;
	GIO_Handle hGIOCapVP0A;
	CapChan_YCrbBufElem vYCrbBuf[4];

#ifdef _OUTFILE
	Int		i;
	FILE	*yuvFile;	
	yuvFile = fopen("workpics.yuv", "wb");
#endif

    EVMDM642_vCapParamsSAA7115.hI2C = EVMDM642_I2C_hI2C;
        	
	hGIOCapVP0A = GIO_create("/CapVP0/A/0", IOM_INPUT, &status, &CapChanParams, NULL);
	GIO_control(hGIOCapVP0A, CAPVP_CMD_EDC_BASE + EDC_CONFIG, (Ptr)&EVMDM642_vCapParamsSAA7115);
	
    EVMDM642_rset(0x10, 0x20); 				/* unlock DLL 				*/
    EVMDM642_rset(0x10, 0x00); 				/* set FPGA in 16-bit mode 	*/
    while(!(EVMDM642_rget(0x13) & 0x40)); 	/* wait until DLL is locked */

	GIO_control(hGIOCapVP0A, CAPVP_CMD_STARTCAP, NULL);
	
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[0], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[1], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[2], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[3], NULL, NULL);

#ifdef _OUTFILE
	for(i=0; i<4; i++){
		fwrite(vYCrbBuf[i].ycbr[0],1,176*144,  yuvFile);
		fwrite(vYCrbBuf[i].ycbr[1],1,176*144/4,yuvFile);
		fwrite(vYCrbBuf[i].ycbr[2],1,176*144/4,yuvFile);
	}
#endif

	GIO_submit(hGIOCapVP0A, CAPVP_CMD_PUT, NULL, NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_PUT, NULL, NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_PUT, NULL, NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_PUT, NULL, NULL, NULL);
	
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[0], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[1], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[2], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_GET, &vYCrbBuf[3], NULL, NULL);

#ifdef _OUTFILE
	for(i=0; i<4; i++){
		fwrite(vYCrbBuf[i].ycbr[0],1,176*144,  yuvFile);
		fwrite(vYCrbBuf[i].ycbr[1],1,176*144/4,yuvFile);
		fwrite(vYCrbBuf[i].ycbr[2],1,176*144/4,yuvFile);
	}
#endif

	GIO_submit(hGIOCapVP0A, CAPVP_CMD_EXCHANGE, &vYCrbBuf[0], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_EXCHANGE, &vYCrbBuf[1], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_EXCHANGE, &vYCrbBuf[2], NULL, NULL);
	GIO_submit(hGIOCapVP0A, CAPVP_CMD_EXCHANGE, &vYCrbBuf[3], NULL, NULL);

#ifdef _OUTFILE
	for(i=0; i<4; i++){
		fwrite(vYCrbBuf[i].ycbr[0],1,176*144,  yuvFile);
		fwrite(vYCrbBuf[i].ycbr[1],1,176*144/4,yuvFile);
		fwrite(vYCrbBuf[i].ycbr[2],1,176*144/4,yuvFile);
	}
	fclose(yuvFile);
#endif

	for(;;);
}