|
|
|
|
@@ -29,25 +29,21 @@ extern TaskTableEntry MCD_modelTaskTableSrc[NUMOFVARIANTS];
|
|
|
|
|
volatile TaskTableEntry *MCD_taskTable;
|
|
|
|
|
TaskTableEntry *MCD_modelTaskTable;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* MCD_chStatus[] is an array of status indicators for remembering
|
|
|
|
|
* whether a DMA has ever been attempted on each channel, pausing
|
|
|
|
|
* status, etc.
|
|
|
|
|
*/
|
|
|
|
|
static int MCD_chStatus[NCHANNELS] =
|
|
|
|
|
{
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA,
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA,
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA,
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA
|
|
|
|
|
};
|
|
|
|
|
{ MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA,
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA,
|
|
|
|
|
MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA, MCD_NO_DMA };
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Prototypes for local functions
|
|
|
|
|
*/
|
|
|
|
|
static void MCD_memcpy (int *dest, int *src, u32 size);
|
|
|
|
|
static void MCD_resmActions (int channel);
|
|
|
|
|
static void MCD_memcpy(int *dest, int *src, u32 size);
|
|
|
|
|
static void MCD_resmActions(int channel);
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Buffer descriptors used for storage of progress info for single Dmas
|
|
|
|
|
@@ -61,7 +57,6 @@ MCD_bufDesc MCD_singleBufDescs[NCHANNELS];
|
|
|
|
|
#endif
|
|
|
|
|
MCD_bufDesc *MCD_relocBuffDesc;
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
|
* Defines for the debug control register's functions
|
|
|
|
|
*/
|
|
|
|
|
@@ -145,7 +140,7 @@ MCD_remVariant MCD_remVariants;
|
|
|
|
|
*/
|
|
|
|
|
extern u32 MCD_funcDescTab0[];
|
|
|
|
|
|
|
|
|
|
int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
int MCD_initDma(dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
{
|
|
|
|
|
int i;
|
|
|
|
|
TaskTableEntry *entryPtr;
|
|
|
|
|
@@ -167,8 +162,8 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
int i;
|
|
|
|
|
|
|
|
|
|
/* check if physical address is aligned on 512 byte boundary */
|
|
|
|
|
if (((u32)taskTableDest & 0x000001ff) != 0)
|
|
|
|
|
return(MCD_TABLE_UNALIGNED);
|
|
|
|
|
if (((u32) taskTableDest & 0x000001ff) != 0)
|
|
|
|
|
return (MCD_TABLE_UNALIGNED);
|
|
|
|
|
|
|
|
|
|
MCD_taskTable = taskTableDest; /* set up local pointer to task Table */
|
|
|
|
|
|
|
|
|
|
@@ -183,7 +178,7 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
|
|
|
|
|
taskTableSize = NCHANNELS * sizeof(TaskTableEntry);
|
|
|
|
|
/* align variable tables to size */
|
|
|
|
|
varTabsOffset = taskTableSize + (u32)taskTableDest;
|
|
|
|
|
varTabsOffset = taskTableSize + (u32) taskTableDest;
|
|
|
|
|
if ((varTabsOffset & (VAR_TAB_SIZE - 1)) != 0)
|
|
|
|
|
varTabsOffset = (varTabsOffset + VAR_TAB_SIZE) & (~VAR_TAB_SIZE);
|
|
|
|
|
/* align function descriptor tables */
|
|
|
|
|
@@ -191,27 +186,28 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
funcDescTabsOffset = varTabsOffset + varTabsSize;
|
|
|
|
|
|
|
|
|
|
if ((funcDescTabsOffset & (FUNCDESC_TAB_SIZE - 1)) != 0)
|
|
|
|
|
funcDescTabsOffset = (funcDescTabsOffset + FUNCDESC_TAB_SIZE) &
|
|
|
|
|
(~FUNCDESC_TAB_SIZE);
|
|
|
|
|
funcDescTabsOffset = (funcDescTabsOffset + FUNCDESC_TAB_SIZE)
|
|
|
|
|
& (~FUNCDESC_TAB_SIZE);
|
|
|
|
|
|
|
|
|
|
funcDescTabsSize = FUNCDESC_TAB_NUM * FUNCDESC_TAB_SIZE;
|
|
|
|
|
contextSavesOffset = funcDescTabsOffset + funcDescTabsSize;
|
|
|
|
|
contextSavesSize = (NCHANNELS * CONTEXT_SAVE_SIZE);
|
|
|
|
|
fixedSize = taskTableSize + varTabsSize + funcDescTabsSize +
|
|
|
|
|
contextSavesSize;
|
|
|
|
|
fixedSize = taskTableSize + varTabsSize + funcDescTabsSize
|
|
|
|
|
+ contextSavesSize;
|
|
|
|
|
|
|
|
|
|
/* zero the thing out */
|
|
|
|
|
fixedPtr = (u32 *)taskTableDest;
|
|
|
|
|
for (i = 0;i<(fixedSize/4);i++)
|
|
|
|
|
fixedPtr = (u32 *) taskTableDest;
|
|
|
|
|
for (i = 0; i < (fixedSize / 4); i++)
|
|
|
|
|
fixedPtr[i] = 0;
|
|
|
|
|
|
|
|
|
|
entryPtr = (TaskTableEntry*)MCD_taskTable;
|
|
|
|
|
entryPtr = (TaskTableEntry*) MCD_taskTable;
|
|
|
|
|
/* set up fixed pointers */
|
|
|
|
|
for (i = 0; i < NCHANNELS; i++)
|
|
|
|
|
{
|
|
|
|
|
entryPtr[i].varTab = (u32)varTabsOffset; /* update ptr to local value */
|
|
|
|
|
entryPtr[i].FDTandFlags = (u32)funcDescTabsOffset | MCD_TT_FLAGS_DEF;
|
|
|
|
|
entryPtr[i].contextSaveSpace = (u32)contextSavesOffset;
|
|
|
|
|
entryPtr[i].varTab = (u32) varTabsOffset; /* update ptr to local value */
|
|
|
|
|
entryPtr[i].FDTandFlags = (u32) funcDescTabsOffset
|
|
|
|
|
| MCD_TT_FLAGS_DEF;
|
|
|
|
|
entryPtr[i].contextSaveSpace = (u32) contextSavesOffset;
|
|
|
|
|
varTabsOffset += VAR_TAB_SIZE;
|
|
|
|
|
#ifdef MCD_INCLUDE_EU /* if not there is only one, just point to the same one */
|
|
|
|
|
funcDescTabsOffset += FUNCDESC_TAB_SIZE;
|
|
|
|
|
@@ -219,31 +215,32 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
contextSavesOffset += CONTEXT_SAVE_SIZE;
|
|
|
|
|
}
|
|
|
|
|
/* copy over the function descriptor table */
|
|
|
|
|
for ( i = 0; i < FUNCDESC_TAB_NUM; i++)
|
|
|
|
|
for (i = 0; i < FUNCDESC_TAB_NUM; i++)
|
|
|
|
|
{
|
|
|
|
|
MCD_memcpy((void*)(entryPtr[i].FDTandFlags & ~MCD_TT_FLAGS_MASK),
|
|
|
|
|
(void*)MCD_funcDescTab0, FUNCDESC_TAB_SIZE);
|
|
|
|
|
MCD_memcpy((void*) (entryPtr[i].FDTandFlags & ~MCD_TT_FLAGS_MASK),
|
|
|
|
|
(void*) MCD_funcDescTab0, FUNCDESC_TAB_SIZE);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* copy model task table to where the context saves stuff leaves off*/
|
|
|
|
|
MCD_modelTaskTable = (TaskTableEntry*)contextSavesOffset;
|
|
|
|
|
MCD_modelTaskTable = (TaskTableEntry*) contextSavesOffset;
|
|
|
|
|
|
|
|
|
|
MCD_memcpy ((void*)MCD_modelTaskTable, (void*)MCD_modelTaskTableSrc,
|
|
|
|
|
MCD_memcpy((void*) MCD_modelTaskTable, (void*) MCD_modelTaskTableSrc,
|
|
|
|
|
NUMOFVARIANTS * sizeof(TaskTableEntry));
|
|
|
|
|
|
|
|
|
|
entryPtr = MCD_modelTaskTable; /* point to local version of
|
|
|
|
|
model task table */
|
|
|
|
|
taskDescTabsOffset = (u32)MCD_modelTaskTable +
|
|
|
|
|
(NUMOFVARIANTS * sizeof(TaskTableEntry));
|
|
|
|
|
taskDescTabsOffset = (u32) MCD_modelTaskTable
|
|
|
|
|
+ (NUMOFVARIANTS * sizeof(TaskTableEntry));
|
|
|
|
|
|
|
|
|
|
/* copy actual task code and update TDT ptrs in local model task table */
|
|
|
|
|
for (i = 0; i < NUMOFVARIANTS; i++)
|
|
|
|
|
{
|
|
|
|
|
taskDescTabSize = entryPtr[i].TDTend - entryPtr[i].TDTstart + 4;
|
|
|
|
|
MCD_memcpy ((void*)taskDescTabsOffset, (void*)entryPtr[i].TDTstart, taskDescTabSize);
|
|
|
|
|
entryPtr[i].TDTstart = (u32)taskDescTabsOffset;
|
|
|
|
|
MCD_memcpy((void*) taskDescTabsOffset, (void*) entryPtr[i].TDTstart,
|
|
|
|
|
taskDescTabSize);
|
|
|
|
|
entryPtr[i].TDTstart = (u32) taskDescTabsOffset;
|
|
|
|
|
taskDescTabsOffset += taskDescTabSize;
|
|
|
|
|
entryPtr[i].TDTend = (u32)taskDescTabsOffset - 4;
|
|
|
|
|
entryPtr[i].TDTend = (u32) taskDescTabsOffset - 4;
|
|
|
|
|
}
|
|
|
|
|
#ifdef MCD_INCLUDE_EU /* Tack single DMA BDs onto end of code so API controls
|
|
|
|
|
where they are since DMA might write to them */
|
|
|
|
|
@@ -258,8 +255,8 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
/* point the would-be relocated task tables and the
|
|
|
|
|
buffer descriptors to the ones the linker generated */
|
|
|
|
|
|
|
|
|
|
if (((u32)MCD_realTaskTableSrc & 0x000001ff) != 0)
|
|
|
|
|
return(MCD_TABLE_UNALIGNED);
|
|
|
|
|
if (((u32) MCD_realTaskTableSrc & 0x000001ff) != 0)
|
|
|
|
|
return (MCD_TABLE_UNALIGNED);
|
|
|
|
|
|
|
|
|
|
/* need to add code to make sure that every thing else is aligned properly TBD*/
|
|
|
|
|
/* this is problematic if we init more than once or after running tasks,
|
|
|
|
|
@@ -267,9 +264,9 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
entryPtr = MCD_realTaskTableSrc;
|
|
|
|
|
for (i = 0; i < NCHANNELS; i++)
|
|
|
|
|
{
|
|
|
|
|
if (((entryPtr[i].varTab & (VAR_TAB_SIZE - 1)) != 0) ||
|
|
|
|
|
((entryPtr[i].FDTandFlags & (FUNCDESC_TAB_SIZE - 1)) != 0))
|
|
|
|
|
return(MCD_TABLE_UNALIGNED);
|
|
|
|
|
if (((entryPtr[i].varTab & (VAR_TAB_SIZE - 1)) != 0)
|
|
|
|
|
|| ((entryPtr[i].FDTandFlags & (FUNCDESC_TAB_SIZE - 1)) != 0))
|
|
|
|
|
return (MCD_TABLE_UNALIGNED);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
MCD_taskTable = MCD_realTaskTableSrc;
|
|
|
|
|
@@ -277,7 +274,6 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
MCD_relocBuffDesc = MCD_singleBufDescs;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Make all channels as totally inactive, and remember them as such: */
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->taskbar = (u32) MCD_taskTable;
|
|
|
|
|
@@ -300,7 +296,7 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
else
|
|
|
|
|
MCD_dmaBar->ptdControl |= PTD_CTL_COMM_PREFETCH;
|
|
|
|
|
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/*********************** End of MCD_initDma() ***********************/
|
|
|
|
|
|
|
|
|
|
@@ -310,31 +306,31 @@ int MCD_initDma (dmaRegs *dmaBarAddr, void *taskTableDest, u32 flags)
|
|
|
|
|
* Arguments: channel - channel number
|
|
|
|
|
* Returns: Predefined status indicators
|
|
|
|
|
*/
|
|
|
|
|
int MCD_dmaStatus (int channel)
|
|
|
|
|
int MCD_dmaStatus(int channel)
|
|
|
|
|
{
|
|
|
|
|
u16 tcrValue;
|
|
|
|
|
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
tcrValue = MCD_dmaBar->taskControl[channel];
|
|
|
|
|
if ((tcrValue & TASK_CTL_EN) == 0)
|
|
|
|
|
{ /* nothing running */
|
|
|
|
|
/* if last reported with task enabled */
|
|
|
|
|
if ( MCD_chStatus[channel] == MCD_RUNNING
|
|
|
|
|
if (MCD_chStatus[channel] == MCD_RUNNING
|
|
|
|
|
|| MCD_chStatus[channel] == MCD_IDLE)
|
|
|
|
|
MCD_chStatus[channel] = MCD_DONE;
|
|
|
|
|
}
|
|
|
|
|
else /* something is running */
|
|
|
|
|
{
|
|
|
|
|
/* There are three possibilities: paused, running or idle. */
|
|
|
|
|
if ( MCD_chStatus[channel] == MCD_RUNNING
|
|
|
|
|
if (MCD_chStatus[channel] == MCD_RUNNING
|
|
|
|
|
|| MCD_chStatus[channel] == MCD_IDLE)
|
|
|
|
|
{
|
|
|
|
|
MCD_dmaBar->ptdDebug = PTD_DBG_TSK_VLD_INIT;
|
|
|
|
|
/* This register is selected to know which initiator is
|
|
|
|
|
actually asserted. */
|
|
|
|
|
if ((MCD_dmaBar->ptdDebug >> channel ) & 0x1 )
|
|
|
|
|
if ((MCD_dmaBar->ptdDebug >> channel) & 0x1)
|
|
|
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
|
|
|
|
else
|
|
|
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
|
|
|
|
@@ -352,22 +348,21 @@ int MCD_dmaStatus (int channel)
|
|
|
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
|
|
|
|
*/
|
|
|
|
|
|
|
|
|
|
int MCD_startDma (
|
|
|
|
|
int channel, /* the channel on which to run the DMA */
|
|
|
|
|
s8 *srcAddr, /* the address to move data from, or physical buffer-descriptor address */
|
|
|
|
|
s16 srcIncr, /* the amount to increment the source address per transfer */
|
|
|
|
|
s8 *destAddr, /* the address to move data to */
|
|
|
|
|
s16 destIncr, /* the amount to increment the destination address per transfer */
|
|
|
|
|
u32 dmaSize, /* the number of bytes to transfer independent of the transfer size */
|
|
|
|
|
u32 xferSize, /* the number bytes in of each data movement (1, 2, or 4) */
|
|
|
|
|
u32 initiator, /* what device initiates the DMA */
|
|
|
|
|
int priority, /* priority of the DMA */
|
|
|
|
|
u32 flags, /* flags describing the DMA */
|
|
|
|
|
u32 funcDesc /* a description of byte swapping, bit swapping, and CRC actions */
|
|
|
|
|
int MCD_startDma(int channel, /* the channel on which to run the DMA */
|
|
|
|
|
s8 *srcAddr, /* the address to move data from, or physical buffer-descriptor address */
|
|
|
|
|
s16 srcIncr, /* the amount to increment the source address per transfer */
|
|
|
|
|
s8 *destAddr, /* the address to move data to */
|
|
|
|
|
s16 destIncr, /* the amount to increment the destination address per transfer */
|
|
|
|
|
u32 dmaSize, /* the number of bytes to transfer independent of the transfer size */
|
|
|
|
|
u32 xferSize, /* the number bytes in of each data movement (1, 2, or 4) */
|
|
|
|
|
u32 initiator, /* what device initiates the DMA */
|
|
|
|
|
int priority, /* priority of the DMA */
|
|
|
|
|
u32 flags, /* flags describing the DMA */
|
|
|
|
|
u32 funcDesc /* a description of byte swapping, bit swapping, and CRC actions */
|
|
|
|
|
#ifdef MCD_NEED_ADDR_TRANS
|
|
|
|
|
s8 *srcAddrVirt /* virtual buffer descriptor address TBD*/
|
|
|
|
|
#endif
|
|
|
|
|
)
|
|
|
|
|
)
|
|
|
|
|
{
|
|
|
|
|
int srcRsdIncr, destRsdIncr;
|
|
|
|
|
int *cSave;
|
|
|
|
|
@@ -377,8 +372,8 @@ int MCD_startDma (
|
|
|
|
|
u32 *realFuncArray;
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
/* tbd - need to determine the proper response to a bad funcDesc when not
|
|
|
|
|
including EU functions, for now, assign a benign funcDesc, but maybe
|
|
|
|
|
@@ -388,7 +383,7 @@ int MCD_startDma (
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
#ifdef MCD_DEBUG
|
|
|
|
|
printf("startDma:Setting up params\n");
|
|
|
|
|
printf("startDma:Setting up params\n");
|
|
|
|
|
#endif
|
|
|
|
|
/* Set us up for task-wise priority. We don't technically need to do this on every start, but
|
|
|
|
|
since the register involved is in the same longword as other registers that users are in control
|
|
|
|
|
@@ -410,7 +405,8 @@ printf("startDma:Setting up params\n");
|
|
|
|
|
MCD_remVariants.remXferSize[channel] = xferSize;
|
|
|
|
|
#endif
|
|
|
|
|
|
|
|
|
|
cSave = (int*)(MCD_taskTable[channel].contextSaveSpace) + CSAVE_OFFSET + CURRBD;
|
|
|
|
|
cSave = (int*) (MCD_taskTable[channel].contextSaveSpace) + CSAVE_OFFSET
|
|
|
|
|
+ CURRBD;
|
|
|
|
|
|
|
|
|
|
#ifdef MCD_INCLUDE_EU /* may move this to EU specific calls */
|
|
|
|
|
realFuncArray = (u32 *) (MCD_taskTable[channel].FDTandFlags & 0xffffff00);
|
|
|
|
|
@@ -425,32 +421,32 @@ printf("startDma:Setting up params\n");
|
|
|
|
|
MDE access to the initiator-register file, so we have to verify that the write
|
|
|
|
|
reads back correctly. */
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->taskControl[channel] =
|
|
|
|
|
(initiator << 8) | TASK_CTL_HIPRITSKEN | TASK_CTL_HLDINITNUM;
|
|
|
|
|
MCD_dmaBar->taskControl[channel] = (initiator << 8) | TASK_CTL_HIPRITSKEN
|
|
|
|
|
| TASK_CTL_HLDINITNUM;
|
|
|
|
|
|
|
|
|
|
while(((MCD_dmaBar->taskControl[channel] & 0x1fff) !=
|
|
|
|
|
((initiator << 8) | TASK_CTL_HIPRITSKEN | TASK_CTL_HLDINITNUM)) &&
|
|
|
|
|
(tcrCount < 1000))
|
|
|
|
|
while (((MCD_dmaBar->taskControl[channel] & 0x1fff)
|
|
|
|
|
!= ((initiator << 8) | TASK_CTL_HIPRITSKEN | TASK_CTL_HLDINITNUM))
|
|
|
|
|
&& (tcrCount < 1000))
|
|
|
|
|
{
|
|
|
|
|
tcrCount++;
|
|
|
|
|
/*MCD_dmaBar->ptd_tcr[channel] = (initiator << 8) | 0x0020;*/
|
|
|
|
|
MCD_dmaBar->taskControl[channel] =
|
|
|
|
|
(initiator << 8) | TASK_CTL_HIPRITSKEN | TASK_CTL_HLDINITNUM;
|
|
|
|
|
MCD_dmaBar->taskControl[channel] = (initiator << 8)
|
|
|
|
|
| TASK_CTL_HIPRITSKEN | TASK_CTL_HLDINITNUM;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->priority[channel] = (u8)priority & PRIORITY_PRI_MASK;
|
|
|
|
|
MCD_dmaBar->priority[channel] = (u8) priority & PRIORITY_PRI_MASK;
|
|
|
|
|
/* should be albe to handle this stuff with only one write to ts reg - tbd */
|
|
|
|
|
if (channel < 8 && channel >= 0)
|
|
|
|
|
{
|
|
|
|
|
MCD_dmaBar->taskSize0 &= ~(0xf << (7-channel)*4);
|
|
|
|
|
MCD_dmaBar->taskSize0 |= (xferSize & 3) << (((7 - channel)*4) + 2);
|
|
|
|
|
MCD_dmaBar->taskSize0 |= (xferSize & 3) << ((7 - channel)*4);
|
|
|
|
|
MCD_dmaBar->taskSize0 &= ~(0xf << (7 - channel) * 4);
|
|
|
|
|
MCD_dmaBar->taskSize0 |= (xferSize & 3) << (((7 - channel) * 4) + 2);
|
|
|
|
|
MCD_dmaBar->taskSize0 |= (xferSize & 3) << ((7 - channel) * 4);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
MCD_dmaBar->taskSize1 &= ~(0xf << (15-channel)*4);
|
|
|
|
|
MCD_dmaBar->taskSize1 |= (xferSize & 3) << (((15 - channel)*4) + 2);
|
|
|
|
|
MCD_dmaBar->taskSize1 |= (xferSize & 3) << ((15 - channel)*4);
|
|
|
|
|
MCD_dmaBar->taskSize1 &= ~(0xf << (15 - channel) * 4);
|
|
|
|
|
MCD_dmaBar->taskSize1 |= (xferSize & 3) << (((15 - channel) * 4) + 2);
|
|
|
|
|
MCD_dmaBar->taskSize1 |= (xferSize & 3) << ((15 - channel) * 4);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* setup task table flags/options which mostly control the line buffers */
|
|
|
|
|
@@ -460,18 +456,21 @@ printf("startDma:Setting up params\n");
|
|
|
|
|
if (flags & MCD_FECTX_DMA)
|
|
|
|
|
{
|
|
|
|
|
/* TDTStart and TDTEnd */
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_FECTX].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_FECTX].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_FECTX].TDTend;
|
|
|
|
|
MCD_startDmaENetXmit(srcAddr, srcAddr, destAddr, MCD_taskTable, channel);
|
|
|
|
|
MCD_startDmaENetXmit(srcAddr, srcAddr, destAddr, MCD_taskTable,
|
|
|
|
|
channel);
|
|
|
|
|
}
|
|
|
|
|
else if (flags & MCD_FECRX_DMA)
|
|
|
|
|
{
|
|
|
|
|
/* TDTStart and TDTEnd */
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_FECRX].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_FECRX].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_FECRX].TDTend;
|
|
|
|
|
MCD_startDmaENetRcv(srcAddr, srcAddr, destAddr, MCD_taskTable, channel);
|
|
|
|
|
}
|
|
|
|
|
else if(flags & MCD_SINGLE_DMA)
|
|
|
|
|
else if (flags & MCD_SINGLE_DMA)
|
|
|
|
|
{
|
|
|
|
|
/* this buffer descriptor is used for storing off initial parameters for later
|
|
|
|
|
progress query calculation and for the DMA to write the resulting checksum
|
|
|
|
|
@@ -486,68 +485,82 @@ printf("startDma:Setting up params\n");
|
|
|
|
|
MCD_relocBuffDesc[channel].next = 0; /* not used */
|
|
|
|
|
|
|
|
|
|
/* Initialize the progress-querying stuff to show no progress:*/
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[SRCPTR + CSAVE_OFFSET] = (int)srcAddr;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[DESTPTR + CSAVE_OFFSET] = (int)destAddr;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[DCOUNT + CSAVE_OFFSET] = 0;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[CURRBD + CSAVE_OFFSET] =
|
|
|
|
|
(u32) &(MCD_relocBuffDesc[channel]);
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[SRCPTR
|
|
|
|
|
+ CSAVE_OFFSET] = (int) srcAddr;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[DESTPTR
|
|
|
|
|
+ CSAVE_OFFSET] = (int) destAddr;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[DCOUNT
|
|
|
|
|
+ CSAVE_OFFSET] = 0;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[CURRBD
|
|
|
|
|
+ CSAVE_OFFSET] = (u32) &(MCD_relocBuffDesc[channel]);
|
|
|
|
|
/* tbd - need to keep the user from trying to call the EU routine
|
|
|
|
|
when MCD_INCLUDE_EU is not defined */
|
|
|
|
|
if( funcDesc == MCD_FUNC_NOEU1 || funcDesc == MCD_FUNC_NOEU2)
|
|
|
|
|
if (funcDesc == MCD_FUNC_NOEU1 || funcDesc == MCD_FUNC_NOEU2)
|
|
|
|
|
{
|
|
|
|
|
/* TDTStart and TDTEnd */
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_SINGLENOEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_SINGLENOEU].TDTend;
|
|
|
|
|
MCD_startDmaSingleNoEu(srcAddr, srcIncr, destAddr, destIncr, dmaSize,
|
|
|
|
|
xferSizeIncr, flags, (int *)&(MCD_relocBuffDesc[channel]), cSave,
|
|
|
|
|
MCD_taskTable, channel);
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_SINGLENOEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend =
|
|
|
|
|
MCD_modelTaskTable[TASK_SINGLENOEU].TDTend;
|
|
|
|
|
MCD_startDmaSingleNoEu(srcAddr, srcIncr, destAddr, destIncr,
|
|
|
|
|
dmaSize, xferSizeIncr, flags,
|
|
|
|
|
(int *) &(MCD_relocBuffDesc[channel]), cSave, MCD_taskTable,
|
|
|
|
|
channel);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
/* TDTStart and TDTEnd */
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_SINGLEEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_SINGLEEU].TDTend;
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_SINGLEEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend =
|
|
|
|
|
MCD_modelTaskTable[TASK_SINGLEEU].TDTend;
|
|
|
|
|
MCD_startDmaSingleEu(srcAddr, srcIncr, destAddr, destIncr, dmaSize,
|
|
|
|
|
xferSizeIncr, flags, (int *)&(MCD_relocBuffDesc[channel]), cSave,
|
|
|
|
|
MCD_taskTable, channel);
|
|
|
|
|
xferSizeIncr, flags, (int *) &(MCD_relocBuffDesc[channel]),
|
|
|
|
|
cSave, MCD_taskTable, channel);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{ /* chained DMAS */
|
|
|
|
|
/* Initialize the progress-querying stuff to show no progress:*/
|
|
|
|
|
#if 1 /* (!defined(MCD_NEED_ADDR_TRANS)) */
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[SRCPTR + CSAVE_OFFSET]
|
|
|
|
|
= (int)((MCD_bufDesc*) srcAddr)->srcAddr;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[DESTPTR + CSAVE_OFFSET]
|
|
|
|
|
= (int)((MCD_bufDesc*) srcAddr)->destAddr;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[SRCPTR
|
|
|
|
|
+ CSAVE_OFFSET] = (int) ((MCD_bufDesc*) srcAddr)->srcAddr;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[DESTPTR
|
|
|
|
|
+ CSAVE_OFFSET] = (int) ((MCD_bufDesc*) srcAddr)->destAddr;
|
|
|
|
|
#else /* if using address translation, need the virtual addr of the first buffdesc */
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[SRCPTR + CSAVE_OFFSET]
|
|
|
|
|
= (int)((MCD_bufDesc*) srcAddrVirt)->srcAddr;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[DESTPTR + CSAVE_OFFSET]
|
|
|
|
|
= (int)((MCD_bufDesc*) srcAddrVirt)->destAddr;
|
|
|
|
|
#endif
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[DCOUNT + CSAVE_OFFSET] = 0;
|
|
|
|
|
((volatile int *)MCD_taskTable[channel].contextSaveSpace)[CURRBD + CSAVE_OFFSET] = (u32) srcAddr;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[DCOUNT
|
|
|
|
|
+ CSAVE_OFFSET] = 0;
|
|
|
|
|
((volatile int *) MCD_taskTable[channel].contextSaveSpace)[CURRBD
|
|
|
|
|
+ CSAVE_OFFSET] = (u32) srcAddr;
|
|
|
|
|
|
|
|
|
|
if( funcDesc == MCD_FUNC_NOEU1 || funcDesc == MCD_FUNC_NOEU2)
|
|
|
|
|
if (funcDesc == MCD_FUNC_NOEU1 || funcDesc == MCD_FUNC_NOEU2)
|
|
|
|
|
{
|
|
|
|
|
/*TDTStart and TDTEnd*/
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_CHAINNOEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_CHAINNOEU].TDTend;
|
|
|
|
|
MCD_startDmaChainNoEu((int *)srcAddr, srcIncr, destIncr, xferSize,
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_CHAINNOEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend =
|
|
|
|
|
MCD_modelTaskTable[TASK_CHAINNOEU].TDTend;
|
|
|
|
|
MCD_startDmaChainNoEu((int *) srcAddr, srcIncr, destIncr, xferSize,
|
|
|
|
|
xferSizeIncr, cSave, MCD_taskTable, channel);
|
|
|
|
|
}
|
|
|
|
|
else
|
|
|
|
|
{
|
|
|
|
|
/*TDTStart and TDTEnd*/
|
|
|
|
|
MCD_taskTable[channel].TDTstart = MCD_modelTaskTable[TASK_CHAINEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend = MCD_modelTaskTable[TASK_CHAINEU].TDTend;
|
|
|
|
|
MCD_startDmaChainEu((int *)srcAddr, srcIncr, destIncr, xferSize,
|
|
|
|
|
MCD_taskTable[channel].TDTstart =
|
|
|
|
|
MCD_modelTaskTable[TASK_CHAINEU].TDTstart;
|
|
|
|
|
MCD_taskTable[channel].TDTend =
|
|
|
|
|
MCD_modelTaskTable[TASK_CHAINEU].TDTend;
|
|
|
|
|
MCD_startDmaChainEu((int *) srcAddr, srcIncr, destIncr, xferSize,
|
|
|
|
|
xferSizeIncr, cSave, MCD_taskTable, channel);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/************************ End of MCD_startDma() *********************/
|
|
|
|
|
@@ -584,7 +597,7 @@ printf("startDma:Setting up params\n");
|
|
|
|
|
*/
|
|
|
|
|
#define STABTIME 0
|
|
|
|
|
|
|
|
|
|
int MCD_XferProgrQuery (int channel, MCD_XferProg *progRep)
|
|
|
|
|
int MCD_XferProgrQuery(int channel, MCD_XferProg *progRep)
|
|
|
|
|
{
|
|
|
|
|
MCD_XferProg prevRep;
|
|
|
|
|
int again; /* true if we are to try again to get consistent results */
|
|
|
|
|
@@ -596,32 +609,43 @@ int MCD_XferProgrQuery (int channel, MCD_XferProg *progRep)
|
|
|
|
|
int subModVal, addModVal; /* Mode values to added and subtracted from the
|
|
|
|
|
final destAddr */
|
|
|
|
|
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
/* Read a trial value for the progress-reporting values*/
|
|
|
|
|
prevRep.lastSrcAddr =
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[SRCPTR + CSAVE_OFFSET];
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[SRCPTR
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
prevRep.lastDestAddr =
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DESTPTR + CSAVE_OFFSET];
|
|
|
|
|
prevRep.dmaSize = ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DCOUNT + CSAVE_OFFSET];
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DESTPTR
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
prevRep.dmaSize =
|
|
|
|
|
((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DCOUNT
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
prevRep.currBufDesc =
|
|
|
|
|
(MCD_bufDesc*) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[CURRBD + CSAVE_OFFSET];
|
|
|
|
|
(MCD_bufDesc*) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[CURRBD
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
/* Repeatedly reread those values until they match previous values: */
|
|
|
|
|
do {
|
|
|
|
|
do
|
|
|
|
|
{
|
|
|
|
|
/* Waste a little bit of time to ensure stability: */
|
|
|
|
|
for (i = 0; i < STABTIME; i++)
|
|
|
|
|
i += i >> 2; /* make sure this loop does something so that it doesn't get optimized out */
|
|
|
|
|
/* Check them again: */
|
|
|
|
|
progRep->lastSrcAddr =
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[SRCPTR + CSAVE_OFFSET];
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[SRCPTR
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
progRep->lastDestAddr =
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DESTPTR + CSAVE_OFFSET];
|
|
|
|
|
progRep->dmaSize = ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DCOUNT + CSAVE_OFFSET];
|
|
|
|
|
(s8 *) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DESTPTR
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
progRep->dmaSize =
|
|
|
|
|
((volatile int*) MCD_taskTable[channel].contextSaveSpace)[DCOUNT
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
progRep->currBufDesc =
|
|
|
|
|
(MCD_bufDesc*) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[CURRBD + CSAVE_OFFSET];
|
|
|
|
|
(MCD_bufDesc*) ((volatile int*) MCD_taskTable[channel].contextSaveSpace)[CURRBD
|
|
|
|
|
+ CSAVE_OFFSET];
|
|
|
|
|
/* See if they match: */
|
|
|
|
|
if ( prevRep.lastSrcAddr != progRep->lastSrcAddr
|
|
|
|
|
if (prevRep.lastSrcAddr != progRep->lastSrcAddr
|
|
|
|
|
|| prevRep.lastDestAddr != progRep->lastDestAddr
|
|
|
|
|
|| prevRep.dmaSize != progRep->dmaSize
|
|
|
|
|
|| prevRep.currBufDesc != progRep->currBufDesc)
|
|
|
|
|
@@ -637,36 +661,42 @@ int MCD_XferProgrQuery (int channel, MCD_XferProg *progRep)
|
|
|
|
|
again = MCD_FALSE;
|
|
|
|
|
} while (again == MCD_TRUE);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* Update the dCount, srcAddr and destAddr */
|
|
|
|
|
/* To calculate dmaCount, we consider destination address. C
|
|
|
|
|
overs M1,P1,Z for destination */
|
|
|
|
|
switch(MCD_remVariants.remDestRsdIncr[channel]) {
|
|
|
|
|
switch (MCD_remVariants.remDestRsdIncr[channel])
|
|
|
|
|
{
|
|
|
|
|
case MINUS1:
|
|
|
|
|
subModVal = ((int)progRep->lastDestAddr) & ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
addModVal = ((int)progRep->currBufDesc->destAddr) & ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
subModVal = ((int) progRep->lastDestAddr)
|
|
|
|
|
& ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
addModVal = ((int) progRep->currBufDesc->destAddr)
|
|
|
|
|
& ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
LWAlignedInitDestAddr = (progRep->currBufDesc->destAddr) - addModVal;
|
|
|
|
|
LWAlignedCurrDestAddr = (progRep->lastDestAddr) - subModVal;
|
|
|
|
|
destDiffBytes = LWAlignedInitDestAddr - LWAlignedCurrDestAddr;
|
|
|
|
|
bytesNotXfered = (destDiffBytes/MCD_remVariants.remDestIncr[channel]) *
|
|
|
|
|
( MCD_remVariants.remDestIncr[channel]
|
|
|
|
|
bytesNotXfered = (destDiffBytes / MCD_remVariants.remDestIncr[channel])
|
|
|
|
|
* (MCD_remVariants.remDestIncr[channel]
|
|
|
|
|
+ MCD_remVariants.remXferSize[channel]);
|
|
|
|
|
progRep->dmaSize = destDiffBytes - bytesNotXfered + addModVal - subModVal;
|
|
|
|
|
progRep->dmaSize = destDiffBytes - bytesNotXfered + addModVal
|
|
|
|
|
- subModVal;
|
|
|
|
|
break;
|
|
|
|
|
case ZERO:
|
|
|
|
|
progRep->lastDestAddr = progRep->currBufDesc->destAddr;
|
|
|
|
|
break;
|
|
|
|
|
case PLUS1:
|
|
|
|
|
/* This value has to be subtracted from the final calculated dCount. */
|
|
|
|
|
subModVal = ((int)progRep->currBufDesc->destAddr) & ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
subModVal = ((int) progRep->currBufDesc->destAddr)
|
|
|
|
|
& ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
/* These bytes are already in lastDestAddr. */
|
|
|
|
|
addModVal = ((int)progRep->lastDestAddr) & ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
addModVal = ((int) progRep->lastDestAddr)
|
|
|
|
|
& ((MCD_remVariants.remXferSize[channel]) - 1);
|
|
|
|
|
LWAlignedInitDestAddr = (progRep->currBufDesc->destAddr) - subModVal;
|
|
|
|
|
LWAlignedCurrDestAddr = (progRep->lastDestAddr) - addModVal;
|
|
|
|
|
destDiffBytes = (progRep->lastDestAddr - LWAlignedInitDestAddr);
|
|
|
|
|
numIterations = ( LWAlignedCurrDestAddr - LWAlignedInitDestAddr)/MCD_remVariants.remDestIncr[channel];
|
|
|
|
|
bytesNotXfered = numIterations *
|
|
|
|
|
( MCD_remVariants.remDestIncr[channel]
|
|
|
|
|
numIterations = (LWAlignedCurrDestAddr - LWAlignedInitDestAddr)
|
|
|
|
|
/ MCD_remVariants.remDestIncr[channel];
|
|
|
|
|
bytesNotXfered = numIterations
|
|
|
|
|
* (MCD_remVariants.remDestIncr[channel]
|
|
|
|
|
- MCD_remVariants.remXferSize[channel]);
|
|
|
|
|
progRep->dmaSize = destDiffBytes - bytesNotXfered - subModVal;
|
|
|
|
|
break;
|
|
|
|
|
@@ -675,26 +705,28 @@ int MCD_XferProgrQuery (int channel, MCD_XferProg *progRep)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* This covers M1,P1,Z for source */
|
|
|
|
|
switch(MCD_remVariants.remSrcRsdIncr[channel]) {
|
|
|
|
|
switch (MCD_remVariants.remSrcRsdIncr[channel])
|
|
|
|
|
{
|
|
|
|
|
case MINUS1:
|
|
|
|
|
progRep->lastSrcAddr =
|
|
|
|
|
progRep->currBufDesc->srcAddr +
|
|
|
|
|
( MCD_remVariants.remSrcIncr[channel] *
|
|
|
|
|
(progRep->dmaSize/MCD_remVariants.remXferSize[channel]));
|
|
|
|
|
progRep->lastSrcAddr = progRep->currBufDesc->srcAddr
|
|
|
|
|
+ (MCD_remVariants.remSrcIncr[channel]
|
|
|
|
|
* (progRep->dmaSize
|
|
|
|
|
/ MCD_remVariants.remXferSize[channel]));
|
|
|
|
|
break;
|
|
|
|
|
case ZERO:
|
|
|
|
|
progRep->lastSrcAddr = progRep->currBufDesc->srcAddr;
|
|
|
|
|
break;
|
|
|
|
|
case PLUS1:
|
|
|
|
|
progRep->lastSrcAddr =
|
|
|
|
|
progRep->currBufDesc->srcAddr +
|
|
|
|
|
( MCD_remVariants.remSrcIncr[channel] *
|
|
|
|
|
(progRep->dmaSize/MCD_remVariants.remXferSize[channel]));
|
|
|
|
|
progRep->lastSrcAddr = progRep->currBufDesc->srcAddr
|
|
|
|
|
+ (MCD_remVariants.remSrcIncr[channel]
|
|
|
|
|
* (progRep->dmaSize
|
|
|
|
|
/ MCD_remVariants.remXferSize[channel]));
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
break;
|
|
|
|
|
default: break;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/******************* End of MCD_XferProgrQuery() ********************/
|
|
|
|
|
|
|
|
|
|
@@ -705,13 +737,16 @@ int MCD_XferProgrQuery (int channel, MCD_XferProg *progRep)
|
|
|
|
|
* enable before resuming it, but the resume function has to do nothing
|
|
|
|
|
* if there is no DMA on that channel (i.e., if the enable bit is 0).
|
|
|
|
|
*/
|
|
|
|
|
static void MCD_resmActions (int channel)
|
|
|
|
|
static void MCD_resmActions(int channel)
|
|
|
|
|
{
|
|
|
|
|
u32 debugStatus;
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->debugControl = DBG_CTL_DISABLE;
|
|
|
|
|
MCD_dmaBar->debugStatus = MCD_dmaBar->debugStatus;
|
|
|
|
|
debugStatus = MCD_dmaBar->debugStatus;
|
|
|
|
|
MCD_dmaBar->debugStatus = debugStatus;
|
|
|
|
|
MCD_dmaBar->ptdDebug = PTD_DBG_TSK_VLD_INIT; /* This register is selected to know
|
|
|
|
|
which initiator is actually asserted. */
|
|
|
|
|
if((MCD_dmaBar->ptdDebug >> channel ) & 0x1)
|
|
|
|
|
if ((MCD_dmaBar->ptdDebug >> channel) & 0x1)
|
|
|
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
|
|
|
|
else
|
|
|
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
|
|
|
|
@@ -730,15 +765,15 @@ static void MCD_resmActions (int channel)
|
|
|
|
|
* always goes to the MCD_HALTED state even if it is killed while in
|
|
|
|
|
* the MCD_NO_DMA or MCD_IDLE states.
|
|
|
|
|
*/
|
|
|
|
|
int MCD_killDma (int channel)
|
|
|
|
|
int MCD_killDma(int channel)
|
|
|
|
|
{
|
|
|
|
|
/* MCD_XferProg progRep; */
|
|
|
|
|
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->taskControl[channel] = 0x0;
|
|
|
|
|
MCD_resumeDma (channel);
|
|
|
|
|
MCD_resumeDma(channel);
|
|
|
|
|
/*
|
|
|
|
|
* This must be after the write to the TCR so that the task doesn't
|
|
|
|
|
* start up again momentarily, and before the status assignment so
|
|
|
|
|
@@ -753,7 +788,7 @@ int MCD_killDma (int channel)
|
|
|
|
|
* MCD_XferProgrQuery (channel, &progRep);
|
|
|
|
|
* progRep.currBufDesc->lastDestAddr = progRep.lastDestAddr;
|
|
|
|
|
*/
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/************************ End of MCD_killDma() **********************/
|
|
|
|
|
|
|
|
|
|
@@ -768,15 +803,15 @@ int MCD_killDma (int channel)
|
|
|
|
|
* This routine does not check to see if there is a task which can
|
|
|
|
|
* be continued. Also this routine should not be used with single DMAs.
|
|
|
|
|
*/
|
|
|
|
|
int MCD_continDma (int channel)
|
|
|
|
|
int MCD_continDma(int channel)
|
|
|
|
|
{
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
MCD_dmaBar->taskControl[channel] |= TASK_CTL_EN;
|
|
|
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
|
|
|
|
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/********************** End of MCD_continDma() **********************/
|
|
|
|
|
|
|
|
|
|
@@ -819,12 +854,12 @@ int MCD_continDma (int channel)
|
|
|
|
|
* Arguments: channel
|
|
|
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
|
|
|
|
*/
|
|
|
|
|
int MCD_pauseDma (int channel)
|
|
|
|
|
int MCD_pauseDma(int channel)
|
|
|
|
|
{
|
|
|
|
|
/* MCD_XferProg progRep; */
|
|
|
|
|
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
if (MCD_dmaBar->taskControl[channel] & TASK_CTL_EN)
|
|
|
|
|
{
|
|
|
|
|
@@ -839,7 +874,7 @@ int MCD_pauseDma (int channel)
|
|
|
|
|
* progRep.currBufDesc->lastDestAddr = progRep.lastDestAddr;
|
|
|
|
|
*/
|
|
|
|
|
}
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/************************* End of MCD_pauseDma() ********************/
|
|
|
|
|
|
|
|
|
|
@@ -850,15 +885,15 @@ int MCD_pauseDma (int channel)
|
|
|
|
|
* Arguments: channel - channel on which to resume DMA
|
|
|
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
|
|
|
|
*/
|
|
|
|
|
int MCD_resumeDma (int channel)
|
|
|
|
|
int MCD_resumeDma(int channel)
|
|
|
|
|
{
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return(MCD_CHANNEL_INVALID);
|
|
|
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
return (MCD_CHANNEL_INVALID);
|
|
|
|
|
|
|
|
|
|
if (MCD_dmaBar->taskControl[channel] & TASK_CTL_EN)
|
|
|
|
|
MCD_resmActions (channel);
|
|
|
|
|
MCD_resmActions(channel);
|
|
|
|
|
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
return (MCD_OK);
|
|
|
|
|
}
|
|
|
|
|
/************************ End of MCD_resumeDma() ********************/
|
|
|
|
|
|
|
|
|
|
@@ -872,7 +907,7 @@ int MCD_resumeDma (int channel)
|
|
|
|
|
* Notes:
|
|
|
|
|
*
|
|
|
|
|
*/
|
|
|
|
|
int MCD_csumQuery (int channel, u32 *csum)
|
|
|
|
|
int MCD_csumQuery(int channel, u32 *csum)
|
|
|
|
|
{
|
|
|
|
|
#ifdef MCD_INCLUDE_EU
|
|
|
|
|
if((channel < 0) || (channel >= NCHANNELS))
|
|
|
|
|
@@ -881,7 +916,7 @@ int MCD_csumQuery (int channel, u32 *csum)
|
|
|
|
|
*csum = MCD_relocBuffDesc[channel].csumResult;
|
|
|
|
|
return(MCD_OK);
|
|
|
|
|
#else
|
|
|
|
|
return(MCD_ERROR);
|
|
|
|
|
return (MCD_ERROR);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
/*********************** End of MCD_resumeDma() *********************/
|
|
|
|
|
@@ -896,7 +931,7 @@ int MCD_getCodeSize(void)
|
|
|
|
|
#ifdef MCD_INCLUDE_EU
|
|
|
|
|
return(0x2b5c);
|
|
|
|
|
#else
|
|
|
|
|
return(0x173c);
|
|
|
|
|
return (0x173c);
|
|
|
|
|
#endif
|
|
|
|
|
}
|
|
|
|
|
/********************** End of MCD_getCodeSize() ********************/
|
|
|
|
|
@@ -915,7 +950,7 @@ char MCD_versionString[] = "Multi-channel DMA API Alpha v0.3 (2004-04-26)";
|
|
|
|
|
int MCD_getVersion(char **longVersion)
|
|
|
|
|
{
|
|
|
|
|
*longVersion = MCD_versionString;
|
|
|
|
|
return((MCD_REV_MAJOR << 8) | MCD_REV_MINOR);
|
|
|
|
|
return ((MCD_REV_MAJOR << 8) | MCD_REV_MINOR);
|
|
|
|
|
}
|
|
|
|
|
/********************** End of MCD_getVersion() *********************/
|
|
|
|
|
|
|
|
|
|
@@ -923,7 +958,7 @@ int MCD_getVersion(char **longVersion)
|
|
|
|
|
/* Private version of memcpy()
|
|
|
|
|
* Note that everything this is used for is longword-aligned.
|
|
|
|
|
*/
|
|
|
|
|
static void MCD_memcpy (int *dest, int *src, u32 size)
|
|
|
|
|
static void MCD_memcpy(int *dest, int *src, u32 size)
|
|
|
|
|
{
|
|
|
|
|
u32 i;
|
|
|
|
|
|
|
|
|
|
|