vportcap.rar_DM642 vportcap_vportcap_vportcap.c_视频采集

/* DSP/BIOS standard include files */ #include <std.h> #include <mem.h> #include <que.h> #include <tsk.h> #include <hwi.h> /* Chip-support library include files */ #include <csl.h> #include <csl_edma.h> #include <csl_vphal.h> #include <csl_irq.h> /* IOM/GIO driver model include files */ #include <iom.h> #include <fvid.h> /* video driver specific include files */ #include <vport.h> #include <vportcap.h> #include <edc.h> #include "_vport.h" /* debug include files */ /* to minimize code size and cycle count overhead of the driver */ /* error checking is only performed at debug time */ #include <assert.h> /* type defines and data structures */ /************************************************************** * data structure for video port object * **************************************************************/ typedef struct PortObj{ /* port status register, contains information on whether */ /* port is opened, configured, etc. */ Int status; /* vp base address for all register access */ Int base; /* two channel objects for channel A & B. */ /* This is only for capture operation */ _VPORT_ChanObj chanObj[2]; } PortObj; /* mini-driver API functions */ static Int mdBindDev(Ptr *devp, Int devid, Ptr devParams); static Int mdControlChan(Ptr chanp, Uns cmd, Ptr args); static Int mdCreateChan(Ptr *chanp, Ptr devp, String name, Int mode, Ptr chanParams, IOM_TiomCallback cbFxn, Ptr cbArg); static Int mdDeleteChan(Ptr chanp); static Int mdSubmitChan(Ptr chanp, IOM_Packet *packet); /* local functions */ static void captureEdmaISR(Int tcc); static void captureISR(Int portNum); static Int _configCh(Ptr chanp, VPORTCAP_Params *params); static Int _configChan(Ptr chanp, Ptr args); static Int _configPort(Ptr chanp, Ptr args); static Int _configTransfer(Ptr chanp,VPORTCAP_Params *params); static Int _covrRecover(Ptr chanp); static Int _setVIntCb(Ptr chanp, Ptr args); static Int _startVPCapture(Ptr chanp); static Int _stopVPCapture(Ptr chanp); /* global and static variables */ IOM_Fxns VPORTCAP_Fxns = { mdBindDev, (IOM_TmdUnBindDev)IOM_mdNotImpl, mdControlChan, mdCreateChan, mdDeleteChan, mdSubmitChan }; /************************************************************** * Static allocation and initialization of port objects * **************************************************************/ static PortObj portObjs[_VP_PORT_CNT] = { /* video port 0 */ {0, _VP_BASE_PORT0, /* channel A */ {{0, 0, 0, _VP_BASE_CHAPORT0, EDMA_CHA_VP0EVTYA, EDMA_CHA_VP0EVTUA, EDMA_CHA_VP0EVTVA, _VP_YSRCA0_ADDR, _VP_CBSRCA0_ADDR, _VP_CRSRCA0_ADDR }, /* channel B */ {0, 0, 1, _VP_BASE_CHBPORT0, EDMA_CHA_VP0EVTYB, EDMA_CHA_VP0EVTUB, EDMA_CHA_VP0EVTVB, _VP_YSRCB0_ADDR, _VP_CBSRCB0_ADDR, _VP_CRSRCB0_ADDR}}}, /* video port 1 */ {0, _VP_BASE_PORT1, /* channel A */ {{0, 1, 0, _VP_BASE_CHAPORT1, EDMA_CHA_VP1EVTYA, EDMA_CHA_VP1EVTUA, EDMA_CHA_VP1EVTVA, _VP_YSRCA1_ADDR, _VP_CBSRCA1_ADDR, _VP_CRSRCA1_ADDR }, /* channel B */ {0, 1, 1, _VP_BASE_CHBPORT1, EDMA_CHA_VP1EVTYB, EDMA_CHA_VP1EVTUB, EDMA_CHA_VP1EVTVB, _VP_YSRCB1_ADDR, _VP_CBSRCB1_ADDR, _VP_CRSRCB1_ADDR}}}, /* video port 2 */ {0, _VP_BASE_PORT2, /* channel A */ {{0, 2, 0, _VP_BASE_CHAPORT2, EDMA_CHA_VP2EVTYA, EDMA_CHA_VP2EVTUA, EDMA_CHA_VP2EVTVA, _VP_YSRCA2_ADDR, _VP_CBSRCA2_ADDR, _VP_CRSRCA2_ADDR }, /* channel B */ {0, 2, 1, _VP_BASE_CHBPORT2, EDMA_CHA_VP2EVTYB, EDMA_CHA_VP2EVTUB, EDMA_CHA_VP2EVTVB, _VP_YSRCB2_ADDR, _VP_CBSRCB2_ADDR, _VP_CRSRCB2_ADDR }}} }; /* * =================== mdBindDev ============================ * Register all external devices to video port capture driver */ static Int mdBindDev(Ptr *devp, Int devid, Ptr devParams) { Int portNum = devid; volatile Int i; volatile Int* base = (volatile Int *)portObjs[portNum].base; assert(portNum < _VP_PORT_CNT); base[_VP_VPCTL_OFFSET] = VP_VPCTL_VPRST_RESET << _VP_VPCTL_VPRST_SHIFT; for(i = 0; i < 100000; i ++); *devp = &portObjs[portNum]; return mdControlChan(&portObjs[portNum], VPORT_CMD_CONFIG_PORT, devParams); } /* * ======== mdControlChan ======== */ static Int mdControlChan(Ptr chanp, Uns cmd, Ptr args) { Int retVal = IOM_EBADMODE; _VPORT_ChanObj* chan = (_VPORT_ChanObj* )chanp; PortObj* port = &portObjs[chan->portNum]; switch (cmd) { case VPORT_CMD_START: retVal = _startVPCapture(chanp); break; case VPORT_CMD_STOP: retVal = _stopVPCapture(chanp); break; case VPORT_CMD_SET_VINTCB: retVal = _setVIntCb(chanp, args); break; case VPORT_CMD_CONFIG_PORT: retVal = _configPort(chanp, args); break; case VPORT_CMD_COVR_RECOVER: retVal = _covrRecover(chanp); break; case VPORT_CMD_CONFIG_CHAN: if(! (port->status & _VPORT_CFGED)) { retVal = _configChan(chanp, args); } break; default: if(chan->edcFxns!=INV){ retVal = chan->edcFxns->ctrl(chan->edcHandle, cmd-VPORT_CMD_EDC_BASE,(Arg)args); }else { retVal = IOM_ENOTIMPL; } break; } return retVal; } /* * =================== mdCreateChan ============================ * create a capture channel */ static Int mdCreateChan(Ptr *chanp, Ptr devp, String name, Int mode, Ptr chanParams, IOM_TiomCallback cbFxn, Ptr cbArg) { Int chanNum; volatile Int* base; PortObj* port; Int retVal = IOM_COMPLETED; if(mode != IOM_INPUT){ return IOM_EBADARGS; } if(*name ++ != '/') { return IOM_EBADARGS; } chanNum = *name ++ - 'A'; assert(chanNum < _VPORT_CHAN_CNT); // hard code port = (PortObj *)devp; if(port->chanObj[chanNum].edcFxns != INV) { /* open external device */ port->chanObj[chanNum].edcHandle = port->chanObj[chanNum].edcFxns->open(name, (Arg)INV); } if(! (port->status & _VPORT_OPENED)) { port->status |= _VPORT_OPENED; base = (volatile Int *)port->base; /* reset both channels */ base[_VP_VCACTL_OFFSET] |= VP_VCACTL_RSTCH_RESET << _VP_VCACTL_RSTCH_SHIFT; base[_VP_VCBCTL_OFFSET] |= VP_VCBCTL_RSTCH_RESET << _VP_VCBCTL_RSTCH_SHIFT; } /* if(!port->opened) */ /* initialize the channel object */ if(! (port->chanObj[chanNum].status & _VPORT_OPENED)) { Int j; _VPORT_ChanObj *chan = &port->chanObj[chanNum]; chan->status |= _VPORT_OPENED; chan->vIntMask = 0; QUE_new(&chan->qIn); chan->cbFxn = cbFxn; chan->vIntFxn = (VPORT_IntCallBack)INV; chan->queEmpty = FALSE; chan->cbArg = (Arg)cbArg; chan->mrViop = INV; chan->packetIOM = INV; chan->numFrms = 0; chan->vIntCbArg = (Int)INV; chan->bufSz = 0; for(j = 0; j < _VPORT_NUM_EDMA_CHANS_RAW && retVal == IOM_COMPLETED; j ++){ if( (chan->hEdma[j] = EDMA_open(chan->edmaChanNum[j], EDMA_OPEN_RESET))==EDMA_HINV ||