#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 "seeddm642.h"
#include "seedvpm642_vcapparams.h"

#include "edc.h"

#include "vport.h"
#include "vportcap.h"

#include "appMain.h"
#include "appBiosObjects.h"
#include "appThreads.h"

#include "cap_dis_size.h"

static unsigned char YArray[LINE_SZ*NUM_LINES*2];
static unsigned char CbArray[(LINE_SZ*NUM_LINES*2)>>1];
static unsigned char CrArray[(LINE_SZ*NUM_LINES*2)>>1];

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


FVID_Handle  capChan;
FVID_Frame *capFrameBuf;
void tskVideoInputInit()
{

    int             status;

    SEEDVPM642_vCapParamsChan.segId = extHeap;
    SEEDVPM642_vCapParamsTVP5150.hI2C = SEEDVPM642_I2C_hI2C;

    /******************************************************/
    /* initialization of capture driver                   */
    /******************************************************/
	/*打開第一通路*/
	capChan  = FVID_create(	"/VP1ACAPTURE/A/1", 
            				    IOM_INPUT, 
            				    &status, 
            				    (Ptr)&SEEDVPM642_vCapParamsChan, 
            				    NULL); //這個是視頻口設備驅動

    /******************************************************/
    /* configure video encoder 			                  */
    /******************************************************/
    /*配置第一通路的TVP5150*/
    FVID_control( capChan, 
    			  VPORT_CMD_EDC_BASE+EDC_CONFIG, 
        		  (Ptr)&SEEDVPM642_vCapParamsTVP5150);
}

void tskVideoInputStart()
{
    FVID_control(capChan, VPORT_CMD_START, NULL);
}

/* handle video capture, scaling and re-format */
void tskVideoInput()
{
    int frame=0;
    SCOM_Handle fromInputtoProc,fromProctoInput;
    char *outBuf[3];
    char *inBuf[3];
    ScomMessage scomMsg;
    ScomMessage *pMsgBuf;

    fromInputtoProc = SCOM_open("INTOPROC");
    fromProctoInput = SCOM_open("PROCTOIN");

    FVID_alloc(capChan, &capFrameBuf);

    pMsgBuf = &scomMsg;

    while(1)
    {
        frame++;

        UTL_stsStart( stsCapTime );

        inBuf[0]  = capFrameBuf->frame.iFrm.y1;
        inBuf[1]  = capFrameBuf->frame.iFrm.cb1;
        inBuf[2]  = capFrameBuf->frame.iFrm.cr1;

        outBuf[0] =  (char *)YArray;
        outBuf[1] =  (char *)CbArray;
        outBuf[2] =  (char *)CrArray;

        yuv422to420(inBuf,outBuf, 720, 576);

        UTL_stsStop( stsCapTime );

        pMsgBuf->bufY = YArray;
        pMsgBuf->bufU = CbArray;
        pMsgBuf->bufV = CrArray;
        SCOM_putMsg(fromInputtoProc, pMsgBuf);

        // Calculate how long it takes to capture one frame
        UTL_stsPeriod( stsCycleTime );

        FVID_exchange(capChan, &capFrameBuf);

        pMsgBuf = SCOM_getMsg(fromProctoInput, SYS_FOREVER);
    }
}