/*
 *  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.
 *  
 */
#include <std.h>
#include <csl.h>
#include <csl_dat.h>
#include <csl_cache.h>
#include <chan.h>
#include <scom.h>
#include <utl.h>
#include <fvid.h>
#include <tsk.h>
#include "edc.h"
#include "vport.h"
#include "vportcap.h"
#include "evmdm642.h"                      
#include "saa7115.h"    
#include "evmdm642_vcapparams.h"
#include "appMain.h"
#include "tskVideoInput.h"



ThrInput thrInput;
/* heap IDs defined in the BIOS configuration file */
extern int extHeap;


FVID_Handle  capChan;
FVID_Frame *capFrameBuf;

#define LINE_SZ 720
#define NUM_LINES 240
#define NUM_OF_CAPTURE_FRAMES 5
#define DEMO_WIDTH  LINE_SZ
#define DEMO_HEIGHT  NUM_LINES*2

#pragma DATA_ALIGN(YUV_buffer_for_capture_all, 256)
char YUV_buffer_for_capture_all[NUM_OF_CAPTURE_FRAMES * ((DEMO_WIDTH * DEMO_HEIGHT*3)/2)];
char *YUV_buffer_for_capture[NUM_OF_CAPTURE_FRAMES][3];
char *yuvBufIp[3];

/*-----------------------------------------------------------*/
/* Create the capture channel and initialize it              */
/*-----------------------------------------------------------*/
void tskVideoInputInit()
{
    
    int status;    	
    
    EVMDM642_vCapParamsChan.segId = extHeap ;//EXTERNALHEAP;
    EVMDM642_vCapParamsSAA7115.hI2C = EVMDM642_I2C_hI2C;
    
    /******************************************************/
    /* allocate capture  frame buffers                    */
    /* in external heap memory                            */
    /******************************************************/
    
    capChan = FVID_create("/VP0CAPTURE/A/0", 
        IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);

	FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
      (Ptr)&EVMDM642_vCapParamsSAA7115);


}

/*-----------------------------------------------------------*/
/*Start the capturing                                        */
/*-----------------------------------------------------------*/
void tskVideoInputStart() 
{
	FVID_control(capChan, VPORT_CMD_START, NULL);
}

/*-----------------------------------------------------------*/
/* handle video capture, scaling and re-format               */
/*-----------------------------------------------------------*/
void tskVideoInput()
{
    int i=0,frame=0;
    SCOM_Handle fromInputtoProc,fromOuttoInput;
    char *ycbcrBuf[3];
    int  capfrnum ;
    fromInputtoProc = SCOM_open("INTOPROC");
    fromOuttoInput = SCOM_open("OUTTOIN");
    
	for(i = 0 ; i < NUM_OF_CAPTURE_FRAMES; i++)
    {
		YUV_buffer_for_capture[i][0] = 
					YUV_buffer_for_capture_all  +
					(i * ((DEMO_WIDTH * DEMO_HEIGHT * 3) /2)) ;
		YUV_buffer_for_capture[i][1] = 
					YUV_buffer_for_capture[i][0] +
					(DEMO_WIDTH * DEMO_HEIGHT) ;								
		YUV_buffer_for_capture[i][2] = 
					YUV_buffer_for_capture[i][1] + 
					((DEMO_WIDTH * DEMO_HEIGHT)/4 );
   } 
	
	

	FVID_alloc(capChan, &capFrameBuf);
	capfrnum = 0;
 	
 	while(1)
 	{ 	
 	    frame++;
 		ycbcrBuf[0] = capFrameBuf->frame.iFrm.y1;
 		ycbcrBuf[1] = capFrameBuf->frame.iFrm.cb1;
 		ycbcrBuf[2] = capFrameBuf->frame.iFrm.cr1;				
		
		yuvBufIp[0] = YUV_buffer_for_capture[capfrnum][0];
		yuvBufIp[1] = YUV_buffer_for_capture[capfrnum][1];	    
		yuvBufIp[2] = YUV_buffer_for_capture[capfrnum][2];    

 		/*-----------------------------------------------------------*/
		/* Call YUV422to420v to do chroma resampling                 */
 		/*-----------------------------------------------------------*/
		yuv422to420(ycbcrBuf,yuvBufIp,720,480);		 		

        capfrnum ++;        
        if(capfrnum > 3)
           capfrnum = 0;
           
       	/*-----------------------------------------------------------*/
  		/* Send message to process task with pointers to captured frame*/
   		/*-----------------------------------------------------------*/
        (thrInput.scomMsgTx).bufChannel = (void *)&yuvBufIp[0];
    	SCOM_putMsg(fromInputtoProc, &(thrInput.scomMsgTx));

       	/*-----------------------------------------------------------*/
       	/* Capture a new frame.                                      */
      	/*-----------------------------------------------------------*/
    	FVID_exchange(capChan, &capFrameBuf);
    	
		/*-----------------------------------------------------------*/
   		/* Wait for the message from the output task                 */
   		/*-----------------------------------------------------------*/
    	SCOM_getMsg(fromOuttoInput, SYS_FOREVER);
 	}	    

}