tskvideoinput.c

基于ICETEK-DM642的视频图象处理-H.263 编码解码源码

#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 "tvp5150a.h"

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

#include "evmdm642_vcapparams.h"
#include "cap_dis_size.h"

#define VPEX_EN (*((unsigned char*)(0x90080015)))
#define I2C_EN (*((unsigned char*)(0x90080016)))
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;
    int ii;


    /* Unlock PERCFG through PCFGLOCK */
    *((unsigned long *)0x1b3f018) = 0x10c0010c;
    
    /* Enable VP0-VP2, I2C and McASP0 in PERCFG */
    *((unsigned long *)0x1b3f000) = 0x78;

    /* Read back PERCFG */
    ii = *((unsigned long *)0x1b3f000);
    
    /* Wait at least 128 CPU cycles */
    EVMDM642_wait(128);

	*((unsigned long *)0x1c400c0)=0x8000; //reset vport0
	*((unsigned long *)0x1c440c0)=0x8000; //reset vport1
    TSK_sleep(256);
	*((unsigned long *)0x1c400c0)=0x00001; //enable double chn
	*((unsigned long *)0x1c440c0)=0x00001; //enable double chn
    TSK_sleep(256);
    VPEX_EN=0x1E;
    I2C_EN=0x00;

    EVMDM642_vCapParamsChan.segId = extHeap;
    //EVMDM642_vCapParamsSAA7115.hI2C = EVMDM642_I2C_hI2C;
    EVMDM642_vCapParamsTVP5150A.hI2C = EVMDM642_I2C_hI2C;

//	*((unsigned char *)0x900c0001)=0x10; //set the i2c addr of all tvp5150s to channel 0
    capChan = FVID_create("/VP0CAPTURE/A/0",
        IOM_INPUT, &status, (Ptr)&EVMDM642_vCapParamsChan, NULL);
	
	FVID_control(capChan, VPORT_CMD_EDC_BASE + EDC_CONFIG, 
         (Ptr)&EVMDM642_vCapParamsTVP5150A);
    //FVID_control(capChan, VPORT_CMD_EDC_BASE+EDC_CONFIG, (Ptr)&EVMDM642_vCapParamsSAA7115);
}

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, 480);

        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);
    }
}