?? vportcap.c
字號:
}
}
if(nextViopChanged) {
/* now modify the EDMA rld entries */
if(chan->interlaced){
EDMA_RSETH(chan->hRld[offset], DST,
chan->nextViop->frame.iFrm.y1);
EDMA_RSETH(chan->hRld[offset + 1], DST,
chan->nextViop->frame.iFrm.y2);
EDMA_RSETH(chan->hRld[4 + offset], DST,
chan->nextViop->frame.iFrm.cb1);
EDMA_RSETH(chan->hRld[5 + offset], DST,
chan->nextViop->frame.iFrm.cb2);
EDMA_RSETH(chan->hRld[8 + offset], DST,
chan->nextViop->frame.iFrm.cr1);
EDMA_RSETH(chan->hRld[9 + offset], DST,
chan->nextViop->frame.iFrm.cr2);
} else {
EDMA_RSETH(chan->hRld[offset], DST,
chan->nextViop->frame.iFrm.y1);
EDMA_RSETH(chan->hRld[4 + offset], DST,
chan->nextViop->frame.iFrm.cb1);
EDMA_RSETH(chan->hRld[8 + offset], DST,
chan->nextViop->frame.iFrm.cr1);
} /* if(chan->interlaced) */
}
IRQ_globalRestore(gie);
return retVal;
}
/*
* ======== _captureEdmaISR ========
* EDMA ISR
*/
static void captureEdmaISR(Int tcc)
{
Int i, j;
Int offset;
FVID_Frame *viop, *curViop;
/* find out the source of the edma interrupt */
for(j = 0; j < _VP_PORT_CNT; j ++) {
for(i = 0; i < _VPORT_CHAN_CNT; i ++ ){ /* loop through two channels */
_VPORT_ChanObj* chan = &portObjs[j].chanObj[i];
if((chan->status & _VPORT_READY)
&& (tcc == chan->tcc[0] || tcc == chan->tcc[1])){
if(chan->autoSyncEnable) {
_autoSync(chan);
}
/* re-sync tcc with activeEDMARlds */
/* they may be out of sync after interrupt over-run */
/* e.g. execution is halted at break-point */
chan->nextEDMARlds = (tcc == chan->tcc[0]) ? 0 : 1;
offset = chan->nextEDMARlds << 1;
/* update the current and next viop pointers */
curViop = chan->curViop;
chan->curViop = chan->nextViop;
/* update the most recent viop */
if(curViop != chan->mrViop && chan->mrViop != INV) {
QUE_enqueue(&chan->qIn, chan->mrViop);
}
chan->mrViop = curViop;
if((viop = (FVID_Frame *)QUE_dequeue(&chan->qIn))
!=(FVID_Frame *)&chan->qIn) {
/* queue IS not empty */
chan->nextViop = viop;
}else {
if(chan->packetIOM == INV) {
/* in queue is empty, but no request is pending */
/* recycle the current VIOP back */
/* but still set it as the most recent VIOP */
chan->nextViop = curViop;
}
chan->queEmpty = TRUE;
}
/* call the channel's callback function */
if(curViop != chan->curViop) {
if(chan->packetIOM != INV) {
/* call the channel's callback function */
*(void **)chan->packetIOM->addr = curViop;
chan->packetIOM->size = sizeof(FVID_Frame);
chan->packetIOM->status = IOM_COMPLETED;
chan->cbFxn((Ptr)chan->cbArg, chan->packetIOM);
chan->packetIOM = INV;
chan->mrViop = INV;
}else if(chan->queEmpty){
chan->nextViop = chan->mrViop;
}
}else {
chan->mrViop = INV;
}
/* Update the EDMA reload entry */
if(chan->interlaced){
EDMA_RSETH(chan->hRld[offset], DST,
chan->nextViop->frame.iFrm.y1);
EDMA_RSETH(chan->hRld[offset + 1], DST,
chan->nextViop->frame.iFrm.y2);
EDMA_RSETH(chan->hRld[4 + offset], DST,
chan->nextViop->frame.iFrm.cb1);
EDMA_RSETH(chan->hRld[5 + offset], DST,
chan->nextViop->frame.iFrm.cb2);
EDMA_RSETH(chan->hRld[8 + offset], DST,
chan->nextViop->frame.iFrm.cr1);
EDMA_RSETH(chan->hRld[9 + offset], DST,
chan->nextViop->frame.iFrm.cr2);
}else {
EDMA_RSETH(chan->hRld[offset], DST,
chan->nextViop->frame.iFrm.y1);
EDMA_RSETH(chan->hRld[offset + 4], DST,
chan->nextViop->frame.iFrm.cb1);
EDMA_RSETH(chan->hRld[offset + 8], DST,
chan->nextViop->frame.iFrm.cr1);
}/* if(chan->interlaced) {*/
}
}
}
}
/*
* ======== _configCh ========
* configure video port channel settings
*/
static Int _configCh(
Ptr chanp,
VPORTCAP_Params *params
)
{
_VPORT_ChanObj* chan= (_VPORT_ChanObj *)chanp;
volatile Int vpCtl, vcCtl, fld1Strt, fld2Strt, fld1Stop, fld2Stop;
volatile Int* base = (volatile Int *)chan->base;
Int retVal = IOM_COMPLETED;
Int numPixels, numLines, numCPixels;
if(chan->status & _VPORT_OPENED) {
chan->vIntMask = 0;
QUE_new(&chan->qIn);
chan->vIntFxn = (VPORT_IntCallBack)INV;
chan->queEmpty = FALSE;
chan->mrViop = INV;
chan->packetIOM = INV;
chan->vIntCbArg = (Int)INV;
chan->bufSz = 0;
chan->autoSyncEnable = params->autoSyncEnable;
/* configure channel A capture settings */
vcCtl = VP_VCACTL_RMK(0,1,0,params->fldInv,
params->extCtl, params->fldDect, params->vCtRst,
params->hCtRst, 0, params->bpk10Bit, 0, 0,
params->resmpl,params->scale,1,
((params->fldOp & 4) >> 2),
((params->fldOp & 2) >> 1),
(params->fldOp & 1),
params->cmode);
fld1Strt = params->fldXStrt1 + (params->fldYStrt1 << 16);
fld1Stop = params->fldXStop1 + (params->fldYStop1 << 16);
fld2Strt = params->fldXStrt2 + (params->fldYStrt2 << 16);
fld2Stop = params->fldXStop2 + (params->fldYStop2 << 16);
if(params->fldOp == VPORT_FLDOP_FRAME) {
assert(params->fldXStop1 == params->fldXStop2);
assert(params->fldXStrt1 == params->fldXStrt2);
}
/* reset channel */
base[_VP_VCACTL_OFFSETA] |=
VP_VCACTL_RSTCH_RESET << _VP_VCACTL_RSTCH_SHIFT;
_delay(2000);
base[_VP_VCACTL_OFFSETA] = vcCtl;
base[_VP_VCASTRT1_OFFSETA] = fld1Strt;
base[_VP_VCASTOP1_OFFSETA] = fld1Stop;
base[_VP_VCASTRT2_OFFSETA] = fld2Strt;
base[_VP_VCASTOP2_OFFSETA] = fld2Stop;
numPixels = params->fldXStop1 - params->fldXStrt1 + 1;/* line size */
numLines = 0;
if(params->fldOp != VPORT_FLDOP_FLD2){
numLines += params->fldYStop1 - params->fldYStrt1 + 1;
}
chan->numLinesFld1 = numLines;
chan->numTotalLinesFld1 = params->fldYStop1;
if(params->fldOp == VPORT_FLDOP_FLD2
|| params->fldOp == VPORT_FLDOP_FRAME){
numLines += params->fldYStop2 - params->fldYStrt2 + 1;
}
chan->resmpl = params->resmpl;
chan->scale = params->scale;
chan->numLines = numLines;
numPixels >>= params->scale;
numCPixels = numPixels >> 1;
/* set both field1 and field2 threshold to the line size */
chan->numPixels = numPixels;
chan->lastLineNum = chan->numLines;
if(params->cmode & _VPORT_MASK_10BIT){
/* 10-bit BT.656 or 20-bit Y/C mode */
if( params->bpk10Bit == VPORTCAP_BPK_10BIT_ZERO_EXTENDED
|| params->bpk10Bit == VPORTCAP_BPK_10BIT_SIGN_EXTENDED){
chan->yPitch = (numPixels * 2 + 7) & (~ 7);
chan->cPitch = (numCPixels * 2 + 7) & (~ 7);
}else {
chan->yPitch = (numPixels * 4 / 3 + 7) & (~ 7);
chan->cPitch = (numCPixels* 4 / 3 + 7) & (~ 7);
}
} else {/* 8-bit BT.656 or 16-bit Y/C mode */
chan->yPitch = (numPixels + 7) & (~ 7);
chan->cPitch = (numCPixels + 7) & (~ 7);
}
chan->yThrld = params->thrld;
chan->interlaced = TRUE;
if(params->fldOp == VPORT_FLDOP_FRAME && params->mergeFlds) {
/* merge field comments */
/* frame capture and merge 2 fields into one frame */
/* set threshold is same as line size */
chan->yThrld = chan->yPitch >> 3;
chan->numEventsFld1 = chan->numLinesFld1;
chan->numEvents = chan->numLines;
}else {
assert(((chan->yPitch*chan->numLinesFld1) / (chan->yThrld << 3))
*(chan->yThrld << 3) == (chan->yPitch * chan->numLinesFld1));
assert(((chan->yPitch * chan->numLines) / (chan->yThrld << 3))
*(chan->yThrld << 3) == (chan->yPitch * chan->numLines));
chan->numEventsFld1 =
chan->yPitch * chan->numLinesFld1 / (chan->yThrld << 3);
chan->numEvents =
chan->yPitch * chan->numLines / (chan->yThrld << 3);
if(params->fldOp != VPORT_FLDOP_FRAME) {
chan->interlaced = FALSE;
}
}
chan->mergeFlds = params->mergeFlds;
chan->cThrld = (chan->yThrld + 1) >> 1;
base[_VP_VCATHRLD_OFFSETA] = VP_VCATHRLD_RMK(chan->yThrld,chan->yThrld);
base[_VP_VCAEVTCT_OFFSETA] = VP_VCAEVTCT_RMK(
(chan->numEvents-chan->numEventsFld1), chan->numEventsFld1 );
chan->status|=_VPORT_CFGED;
retVal = IOM_COMPLETED;
}
return retVal;
}
/*
* ======== _configChan ========
* configure channel settings
*/
static Int _configChan(Ptr chanp, Ptr args)
{
VPORTCAP_Params* params = (VPORTCAP_Params*)args;
/* configure video port channel A/B control register */
_configCh(chanp, params);
/* configure EDMA and frame buffer */
_configTransfer(chanp, params);
return IOM_COMPLETED;
}
/*
* ======== _configPort ========
* configure port level registers
*/
static Int _configPort(Ptr chanp, Ptr args)
{
PortObj* port = (PortObj *)chanp;
volatile Int *base = (volatile Int *)port->base;
/* configure video port control register */
VPORT_PortParams* portParams = (VPORT_PortParams*)args;
/* enable video port */
base[_VP_PCR_OFFSET] |= VP_PCR_PEREN_ENABLE << _VP_PCR_PEREN_SHIFT;
/* reset video port */
base[_VP_VPCTL_OFFSET] |=
VP_VPCTL_VPRST_RESET << _VP_VPCTL_VPRST_SHIFT;
while(base[_VP_VPCTL_OFFSET] & (VP_VPCTL_VPRST_RESET << _VP_VPCTL_VPRST_SHIFT));
base[_VP_VPCTL_OFFSET] = VP_VPCTL_RMK(0,0,0,portParams->vc3Polarity,
portParams->vc2Polarity,portParams->vc1Polarity,0,0,
portParams->dualChanEnable);
/* enable video port */
base[_VP_VPCTL_OFFSET] |= (VP_VPCTL_VPHLT_CLEAR << _VP_VPCTL_VPHLT_SHIFT);
port->chanObj[0].edcFxns = portParams->edcTbl[0];
port->chanObj[1].edcFxns = portParams->edcTbl[1];
IRQ_clear(IRQ_EVT_EDMAINT);
return IOM_COMPLETED;
}
/*
* ======== _configTransfer ========
* configure channel EDMA settings
*/
static Int _configTransfer(
Ptr chanp,
VPORTCAP_Params *params
)
{
_VPORT_ChanObj* chan = (_VPORT_ChanObj *)chanp;
Int i;
EDMA_Config cfgEdma;
Int thrld;
Int8* curAddr;
if(chan->status & _VPORT_CFGED) {
assert(params->numFrmBufs >= 2 && params->numFrmBufs
<= VPORT_MAX_NUM_FRMBUFS);
QUE_new(&chan->qIn);
chan->queEmpty = FALSE;
chan->mrViop = INV;
chan->packetIOM = INV;
chan->segId = params->segId;
EDMA_intDisable(chan->tcc[0]);
EDMA_intDisable(chan->tcc[1]);
if(chan->numFrms == 0) {
chan->numFrms = params->numFrmBufs;
/* allocate frame buffer */
chan->bufSz = chan->yPitch * chan->numLines
+ chan->cPitch * chan->numLines * 2;
for(i = 0; i < chan->numFrms; i ++) {
if((curAddr = MEM_calloc(params->segId,chan->bufSz,
params->alignment)) == MEM_ILLEGAL){
return IOM_EALLOC;
}
/* field 1 */
chan->viops[i].frame.iFrm.y1 = curAddr;
curAddr += chan->numLines*chan->yPitch;
chan->viops[i].frame.iFrm.cb1 = curAddr;
curAddr += chan->numLines*chan->cPitch;
chan->viops[i].frame.iFrm.cr1 = curAddr;
curAddr += chan->numLines*chan->cPitch;
/* field 2 */
if(params->fldOp == VPORT_FLDOP_FLD2) {
chan->viops[i].frame.iFrm.y2 =
chan->viops[i].frame.iFrm.y1;
chan->viops[i].frame.iFrm.cb2 =
chan->viops[i].frame.iFrm.cb1;
chan->viops[i].frame.iFrm.cr2 =
chan->viops[i].frame.iFrm.cr1;
}
else if(! chan->mergeFlds) {
chan->viops[i].frame.iFrm.y2 =
chan->viops[i].frame.iFrm.y1
+ chan->numLinesFld1*chan->yPitch;
chan->viops[i].frame.iFrm.cb2 =
chan->viops[i].frame.iFrm.cb1
+ (chan->numLinesFld1*chan->cPitch);
chan->viops[i].frame.iFrm.cr2 =
chan->viops[i].frame.iFrm.cr1
+ (chan->numLinesFld1*chan->cPitch);
}else {
chan->viops[i].frame.iFrm.y2 =
chan->viops[i].frame.iFrm.y1 + chan->yPitch;
chan->viops[i].frame.iFrm.cb2 =
chan->viops[i].frame.iFrm.cb1 + chan->cPitch;
chan->viops[i].frame.iFrm.cr2 =
chan->viops[i].frame.iFrm.cr1 + chan->cPitch;
}
}
}
for(i = 2; i < chan->numFrms; i ++) {
/* don't put the first 2 viop into the queue */
QUE_enqueue(&chan->qIn, (QUE_Handle)&chan->viops[i]);
}
chan->curViop = &chan->viops[0];
chan->nextViop = &chan->viops[1];
for(i = 0; i < _VPORT_NUM_EDMA_CHANS; i ++) {
Int optFld1 = EDMA_OPT_RMK(
params->edmaPri,
EDMA_OPT_ESIZE_32BIT,
?? 快捷鍵說明
復(fù)制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -