upstream u-boot with additional patches for our devices/boards:
https://lists.denx.de/pipermail/u-boot/2017-March/282789.html (AXP crashes) ;
Gbit ethernet patch for some LIME2 revisions ;
with SPI flash support
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
1027 lines
35 KiB
1027 lines
35 KiB
17 years ago
|
/*
|
||
|
|
* Copyright (C) 2004-2007 Freescale Semiconductor, Inc.
|
||
|
|
*
|
||
|
|
* See file CREDITS for list of people who contributed to this
|
||
|
|
* project.
|
||
|
|
*
|
||
|
|
* This program is free software; you can redistribute it and/or
|
||
|
|
* modify it under the terms of the GNU General Public License as
|
||
|
|
* published by the Free Software Foundation; either version 2 of
|
||
|
|
* the License, or (at your option) any later version.
|
||
|
|
*
|
||
|
|
* This program is distributed in the hope that it will be useful,
|
||
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
* GNU General Public License for more details.
|
||
|
|
*
|
||
|
|
* You should have received a copy of the GNU General Public License
|
||
|
|
* along with this program; if not, write to the Free Software
|
||
|
|
* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
|
||
|
|
* MA 02111-1307 USA
|
||
|
|
*/
|
||
|
|
|
||
|
|
/*Main C file for multi-channel DMA API. */
|
||
|
|
|
||
|
|
#include <common.h>
|
||
|
|
|
||
|
|
#ifdef CONFIG_FSLDMAFEC
|
||
|
|
|
||
|
|
#include <MCD_dma.h>
|
||
|
|
#include <MCD_tasksInit.h>
|
||
|
|
#include <MCD_progCheck.h>
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* This is an API-internal pointer to the DMA's registers */
|
||
|
|
dmaRegs *MCD_dmaBar;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* These are the real and model task tables as generated by the
|
||
|
|
* build process
|
||
|
|
*/
|
||
|
|
extern TaskTableEntry MCD_realTaskTableSrc[NCHANNELS];
|
||
|
|
extern TaskTableEntry MCD_modelTaskTableSrc[NUMOFVARIANTS];
|
||
|
|
|
||
|
|
/*
|
||
|
|
* However, this (usually) gets relocated to on-chip SRAM, at which
|
||
|
|
* point we access them as these tables
|
||
|
|
*/
|
||
|
|
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
|
||
|
|
};
|
||
|
|
|
||
|
|
/* Prototypes for local functions */
|
||
|
|
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
|
||
|
|
* Also used as storage for the DMA for CRCs for single DMAs
|
||
|
|
* Otherwise, the DMA does not parse these buffer descriptors
|
||
|
|
*/
|
||
|
|
#ifdef MCD_INCLUDE_EU
|
||
|
|
extern MCD_bufDesc MCD_singleBufDescs[NCHANNELS];
|
||
|
|
#else
|
||
|
|
MCD_bufDesc MCD_singleBufDescs[NCHANNELS];
|
||
|
|
#endif
|
||
|
|
MCD_bufDesc *MCD_relocBuffDesc;
|
||
|
|
|
||
|
|
/* Defines for the debug control register's functions */
|
||
|
|
#define DBG_CTL_COMP1_TASK (0x00002000)
|
||
|
|
#define DBG_CTL_ENABLE (DBG_CTL_AUTO_ARM | \
|
||
|
|
DBG_CTL_BREAK | \
|
||
|
|
DBG_CTL_INT_BREAK | \
|
||
|
|
DBG_CTL_COMP1_TASK)
|
||
|
|
#define DBG_CTL_DISABLE (DBG_CTL_AUTO_ARM | \
|
||
|
|
DBG_CTL_INT_BREAK | \
|
||
|
|
DBG_CTL_COMP1_TASK)
|
||
|
|
#define DBG_KILL_ALL_STAT (0xFFFFFFFF)
|
||
|
|
|
||
|
|
/* Offset to context save area where progress info is stored */
|
||
|
|
#define CSAVE_OFFSET 10
|
||
|
|
|
||
|
|
/* Defines for Byte Swapping */
|
||
|
|
#define MCD_BYTE_SWAP_KILLER 0xFFF8888F
|
||
|
|
#define MCD_NO_BYTE_SWAP_ATALL 0x00040000
|
||
|
|
|
||
|
|
/* Execution Unit Identifiers */
|
||
|
|
#define MAC 0 /* legacy - not used */
|
||
|
|
#define LUAC 1 /* legacy - not used */
|
||
|
|
#define CRC 2 /* legacy - not used */
|
||
|
|
#define LURC 3 /* Logic Unit with CRC */
|
||
|
|
|
||
|
|
/* Task Identifiers */
|
||
|
|
#define TASK_CHAINNOEU 0
|
||
|
|
#define TASK_SINGLENOEU 1
|
||
|
|
#ifdef MCD_INCLUDE_EU
|
||
|
|
#define TASK_CHAINEU 2
|
||
|
|
#define TASK_SINGLEEU 3
|
||
|
|
#define TASK_FECRX 4
|
||
|
|
#define TASK_FECTX 5
|
||
|
|
#else
|
||
|
|
#define TASK_CHAINEU 0
|
||
|
|
#define TASK_SINGLEEU 1
|
||
|
|
#define TASK_FECRX 2
|
||
|
|
#define TASK_FECTX 3
|
||
|
|
#endif
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Structure to remember which variant is on which channel
|
||
|
|
* TBD- need this?
|
||
|
|
*/
|
||
|
|
typedef struct MCD_remVariants_struct MCD_remVariant;
|
||
|
|
struct MCD_remVariants_struct {
|
||
|
|
int remDestRsdIncr[NCHANNELS]; /* -1,0,1 */
|
||
|
|
int remSrcRsdIncr[NCHANNELS]; /* -1,0,1 */
|
||
|
|
s16 remDestIncr[NCHANNELS]; /* DestIncr */
|
||
|
|
s16 remSrcIncr[NCHANNELS]; /* srcIncr */
|
||
|
|
u32 remXferSize[NCHANNELS]; /* xferSize */
|
||
|
|
};
|
||
|
|
|
||
|
|
/* Structure to remember the startDma parameters for each channel */
|
||
|
|
MCD_remVariant MCD_remVariants;
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_initDma
|
||
|
|
* Purpose: Initializes the DMA API by setting up a pointer to the DMA
|
||
|
|
* registers, relocating and creating the appropriate task
|
||
|
|
* structures, and setting up some global settings
|
||
|
|
* Arguments:
|
||
|
|
* dmaBarAddr - pointer to the multichannel DMA registers
|
||
|
|
* taskTableDest - location to move DMA task code and structs to
|
||
|
|
* flags - operational parameters
|
||
|
|
* Return Value:
|
||
|
|
* MCD_TABLE_UNALIGNED if taskTableDest is not 512-byte aligned
|
||
|
|
* MCD_OK otherwise
|
||
|
|
*/
|
||
|
|
extern u32 MCD_funcDescTab0[];
|
||
|
|
|
||
|
|
int MCD_initDma(dmaRegs * dmaBarAddr, void *taskTableDest, u32 flags)
|
||
|
|
{
|
||
|
|
int i;
|
||
|
|
TaskTableEntry *entryPtr;
|
||
|
|
|
||
|
|
/* setup the local pointer to register set */
|
||
|
|
MCD_dmaBar = dmaBarAddr;
|
||
|
|
|
||
|
|
/* do we need to move/create a task table */
|
||
|
|
if ((flags & MCD_RELOC_TASKS) != 0) {
|
||
|
|
int fixedSize;
|
||
|
|
u32 *fixedPtr;
|
||
|
|
/*int *tablePtr = taskTableDest;TBD */
|
||
|
|
int varTabsOffset, funcDescTabsOffset, contextSavesOffset;
|
||
|
|
int taskDescTabsOffset;
|
||
|
|
int taskTableSize, varTabsSize, funcDescTabsSize,
|
||
|
|
contextSavesSize;
|
||
|
|
int taskDescTabSize;
|
||
|
|
|
||
|
|
int i;
|
||
|
|
|
||
|
|
/* check if physical address is aligned on 512 byte boundary */
|
||
|
|
if (((u32) taskTableDest & 0x000001ff) != 0)
|
||
|
|
return (MCD_TABLE_UNALIGNED);
|
||
|
|
|
||
|
|
/* set up local pointer to task Table */
|
||
|
|
MCD_taskTable = taskTableDest;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Create a task table:
|
||
|
|
* - compute aligned base offsets for variable tables and
|
||
|
|
* function descriptor tables, then
|
||
|
|
* - loop through the task table and setup the pointers
|
||
|
|
* - copy over model task table with the the actual task
|
||
|
|
* descriptor tables
|
||
|
|
*/
|
||
|
|
|
||
|
|
taskTableSize = NCHANNELS * sizeof(TaskTableEntry);
|
||
|
|
/* align variable tables to size */
|
||
|
|
varTabsOffset = taskTableSize + (u32) taskTableDest;
|
||
|
|
if ((varTabsOffset & (VAR_TAB_SIZE - 1)) != 0)
|
||
|
|
varTabsOffset =
|
||
|
|
(varTabsOffset + VAR_TAB_SIZE) & (~VAR_TAB_SIZE);
|
||
|
|
/* align function descriptor tables */
|
||
|
|
varTabsSize = NCHANNELS * VAR_TAB_SIZE;
|
||
|
|
funcDescTabsOffset = varTabsOffset + varTabsSize;
|
||
|
|
|
||
|
|
if ((funcDescTabsOffset & (FUNCDESC_TAB_SIZE - 1)) != 0)
|
||
|
|
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;
|
||
|
|
|
||
|
|
/* zero the thing out */
|
||
|
|
fixedPtr = (u32 *) taskTableDest;
|
||
|
|
for (i = 0; i < (fixedSize / 4); i++)
|
||
|
|
fixedPtr[i] = 0;
|
||
|
|
|
||
|
|
entryPtr = (TaskTableEntry *) MCD_taskTable;
|
||
|
|
/* set up fixed pointers */
|
||
|
|
for (i = 0; i < NCHANNELS; i++) {
|
||
|
|
/* update ptr to local value */
|
||
|
|
entryPtr[i].varTab = (u32) varTabsOffset;
|
||
|
|
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;
|
||
|
|
#endif
|
||
|
|
contextSavesOffset += CONTEXT_SAVE_SIZE;
|
||
|
|
}
|
||
|
|
/* copy over the function descriptor table */
|
||
|
|
for (i = 0; i < FUNCDESC_TAB_NUM; i++) {
|
||
|
|
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_memcpy((void *)MCD_modelTaskTable,
|
||
|
|
(void *)MCD_modelTaskTableSrc,
|
||
|
|
NUMOFVARIANTS * sizeof(TaskTableEntry));
|
||
|
|
|
||
|
|
/* point to local version of model task table */
|
||
|
|
entryPtr = MCD_modelTaskTable;
|
||
|
|
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;
|
||
|
|
taskDescTabsOffset += taskDescTabSize;
|
||
|
|
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 */
|
||
|
|
MCD_relocBuffDesc =
|
||
|
|
(MCD_bufDesc *) (entryPtr[NUMOFVARIANTS - 1].TDTend + 4);
|
||
|
|
#else
|
||
|
|
/* DMA does not touch them so they can be wherever and we
|
||
|
|
don't need to waste SRAM on them */
|
||
|
|
MCD_relocBuffDesc = MCD_singleBufDescs;
|
||
|
|
#endif
|
||
|
|
} else {
|
||
|
|
/* 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);
|
||
|
|
|
||
|
|
/* 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, need to add
|
||
|
|
variable to see if we have aleady init'd */
|
||
|
|
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);
|
||
|
|
}
|
||
|
|
|
||
|
|
MCD_taskTable = MCD_realTaskTableSrc;
|
||
|
|
MCD_modelTaskTable = MCD_modelTaskTableSrc;
|
||
|
|
MCD_relocBuffDesc = MCD_singleBufDescs;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Make all channels as totally inactive, and remember them as such: */
|
||
|
|
|
||
|
|
MCD_dmaBar->taskbar = (u32) MCD_taskTable;
|
||
|
|
for (i = 0; i < NCHANNELS; i++) {
|
||
|
|
MCD_dmaBar->taskControl[i] = 0x0;
|
||
|
|
MCD_chStatus[i] = MCD_NO_DMA;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Set up pausing mechanism to inactive state: */
|
||
|
|
/* no particular values yet for either comparator registers */
|
||
|
|
MCD_dmaBar->debugComp1 = 0;
|
||
|
|
MCD_dmaBar->debugComp2 = 0;
|
||
|
|
MCD_dmaBar->debugControl = DBG_CTL_DISABLE;
|
||
|
|
MCD_dmaBar->debugStatus = DBG_KILL_ALL_STAT;
|
||
|
|
|
||
|
|
/* enable or disable commbus prefetch, really need an ifdef or
|
||
|
|
something to keep from trying to set this in the 8220 */
|
||
|
|
if ((flags & MCD_COMM_PREFETCH_EN) != 0)
|
||
|
|
MCD_dmaBar->ptdControl &= ~PTD_CTL_COMM_PREFETCH;
|
||
|
|
else
|
||
|
|
MCD_dmaBar->ptdControl |= PTD_CTL_COMM_PREFETCH;
|
||
|
|
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/*********************** End of MCD_initDma() ***********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_dmaStatus
|
||
|
|
* Purpose: Returns the status of the DMA on the requested channel
|
||
|
|
* Arguments: channel - channel number
|
||
|
|
* Returns: Predefined status indicators
|
||
|
|
*/
|
||
|
|
int MCD_dmaStatus(int channel)
|
||
|
|
{
|
||
|
|
u16 tcrValue;
|
||
|
|
|
||
|
|
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
|
||
|
|
|| 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
|
||
|
|
|| 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)
|
||
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
||
|
|
else
|
||
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
||
|
|
/* do not change the status if it is already paused. */
|
||
|
|
}
|
||
|
|
}
|
||
|
|
return MCD_chStatus[channel];
|
||
|
|
}
|
||
|
|
|
||
|
|
/******************** End of MCD_dmaStatus() ************************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_startDma
|
||
|
|
* Ppurpose: Starts a particular kind of DMA
|
||
|
|
* Arguments:
|
||
|
|
* srcAddr - the channel on which to run the DMA
|
||
|
|
* srcIncr - the address to move data from, or buffer-descriptor address
|
||
|
|
* destAddr - the amount to increment the source address per transfer
|
||
|
|
* destIncr - the address to move data to
|
||
|
|
* dmaSize - the amount to increment the destination address per transfer
|
||
|
|
* xferSize - the number bytes in of each data movement (1, 2, or 4)
|
||
|
|
* initiator - what device initiates the DMA
|
||
|
|
* priority - priority of the DMA
|
||
|
|
* flags - flags describing the DMA
|
||
|
|
* funcDesc - description of byte swapping, bit swapping, and CRC actions
|
||
|
|
* srcAddrVirt - virtual buffer descriptor address TBD
|
||
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
||
|
|
*/
|
||
|
|
|
||
|
|
int MCD_startDma(int channel, s8 * srcAddr, s16 srcIncr, s8 * destAddr,
|
||
|
|
s16 destIncr, u32 dmaSize, u32 xferSize, u32 initiator,
|
||
|
|
int priority, u32 flags, u32 funcDesc
|
||
|
|
#ifdef MCD_NEED_ADDR_TRANS
|
||
|
|
s8 * srcAddrVirt
|
||
|
|
#endif
|
||
|
|
)
|
||
|
|
{
|
||
|
|
int srcRsdIncr, destRsdIncr;
|
||
|
|
int *cSave;
|
||
|
|
short xferSizeIncr;
|
||
|
|
int tcrCount = 0;
|
||
|
|
#ifdef MCD_INCLUDE_EU
|
||
|
|
u32 *realFuncArray;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
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 should return an error */
|
||
|
|
#ifndef MCD_INCLUDE_EU
|
||
|
|
funcDesc = MCD_FUNC_NOEU1;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
#ifdef MCD_DEBUG
|
||
|
|
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 of, setting
|
||
|
|
it more than once is probably preferable. That since the
|
||
|
|
documentation doesn't seem to be completely consistent about the
|
||
|
|
nature of the PTD control register. */
|
||
|
|
MCD_dmaBar->ptdControl |= (u16) 0x8000;
|
||
|
|
|
||
|
|
/* Not sure what we need to keep here rtm TBD */
|
||
|
|
#if 1
|
||
|
|
/* Calculate additional parameters to the regular DMA calls. */
|
||
|
|
srcRsdIncr = srcIncr < 0 ? -1 : (srcIncr > 0 ? 1 : 0);
|
||
|
|
destRsdIncr = destIncr < 0 ? -1 : (destIncr > 0 ? 1 : 0);
|
||
|
|
|
||
|
|
xferSizeIncr = (xferSize & 0xffff) | 0x20000000;
|
||
|
|
|
||
|
|
/* Remember for each channel which variant is running. */
|
||
|
|
MCD_remVariants.remSrcRsdIncr[channel] = srcRsdIncr;
|
||
|
|
MCD_remVariants.remDestRsdIncr[channel] = destRsdIncr;
|
||
|
|
MCD_remVariants.remDestIncr[channel] = destIncr;
|
||
|
|
MCD_remVariants.remSrcIncr[channel] = srcIncr;
|
||
|
|
MCD_remVariants.remXferSize[channel] = xferSize;
|
||
|
|
#endif
|
||
|
|
|
||
|
|
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);
|
||
|
|
/* Modify the LURC's normal and byte-residue-loop functions according
|
||
|
|
to parameter. */
|
||
|
|
realFuncArray[(LURC * 16)] = xferSize == 4 ?
|
||
|
|
funcDesc : xferSize == 2 ?
|
||
|
|
funcDesc & 0xfffff00f : funcDesc & 0xffff000f;
|
||
|
|
realFuncArray[(LURC * 16 + 1)] =
|
||
|
|
(funcDesc & MCD_BYTE_SWAP_KILLER) | MCD_NO_BYTE_SWAP_ATALL;
|
||
|
|
#endif
|
||
|
|
/* Write the initiator field in the TCR, and also set the
|
||
|
|
initiator-hold bit. Note that,due to a hardware quirk, this could
|
||
|
|
collide with an 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;
|
||
|
|
|
||
|
|
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->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);
|
||
|
|
} 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);
|
||
|
|
}
|
||
|
|
|
||
|
|
/* setup task table flags/options which mostly control the line
|
||
|
|
buffers */
|
||
|
|
MCD_taskTable[channel].FDTandFlags &= ~MCD_TT_FLAGS_MASK;
|
||
|
|
MCD_taskTable[channel].FDTandFlags |= (MCD_TT_FLAGS_MASK & flags);
|
||
|
|
|
||
|
|
if (flags & MCD_FECTX_DMA) {
|
||
|
|
/* TDTStart and TDTEnd */
|
||
|
|
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);
|
||
|
|
} else if (flags & MCD_FECRX_DMA) {
|
||
|
|
/* TDTStart and TDTEnd */
|
||
|
|
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) {
|
||
|
|
/* this buffer descriptor is used for storing off initial
|
||
|
|
parameters for later progress query calculation and for the
|
||
|
|
DMA to write the resulting checksum. The DMA does not use
|
||
|
|
this to determine how to operate, that info is passed with
|
||
|
|
the init routine */
|
||
|
|
MCD_relocBuffDesc[channel].srcAddr = srcAddr;
|
||
|
|
MCD_relocBuffDesc[channel].destAddr = destAddr;
|
||
|
|
|
||
|
|
/* definitely not its final value */
|
||
|
|
MCD_relocBuffDesc[channel].lastDestAddr = destAddr;
|
||
|
|
|
||
|
|
MCD_relocBuffDesc[channel].dmaSize = dmaSize;
|
||
|
|
MCD_relocBuffDesc[channel].flags = 0; /* not used */
|
||
|
|
MCD_relocBuffDesc[channel].csumResult = 0; /* not used */
|
||
|
|
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]);
|
||
|
|
/* 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) {
|
||
|
|
/* 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);
|
||
|
|
} else {
|
||
|
|
/* TDTStart and 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);
|
||
|
|
}
|
||
|
|
} 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;
|
||
|
|
#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;
|
||
|
|
|
||
|
|
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,
|
||
|
|
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, xferSizeIncr, cSave,
|
||
|
|
MCD_taskTable, channel);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/************************ End of MCD_startDma() *********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_XferProgrQuery
|
||
|
|
* Purpose: Returns progress of DMA on requested channel
|
||
|
|
* Arguments: channel - channel to retrieve progress for
|
||
|
|
* progRep - pointer to user supplied MCD_XferProg struct
|
||
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
||
|
|
*
|
||
|
|
* Notes:
|
||
|
|
* MCD_XferProgrQuery() upon completing or after aborting a DMA, or
|
||
|
|
* while the DMA is in progress, this function returns the first
|
||
|
|
* DMA-destination address not (or not yet) used in the DMA. When
|
||
|
|
* encountering a non-ready buffer descriptor, the information for
|
||
|
|
* the last completed descriptor is returned.
|
||
|
|
*
|
||
|
|
* MCD_XferProgQuery() has to avoid the possibility of getting
|
||
|
|
* partially-updated information in the event that we should happen
|
||
|
|
* to query DMA progress just as the DMA is updating it. It does that
|
||
|
|
* by taking advantage of the fact context is not saved frequently for
|
||
|
|
* the most part. We therefore read it at least twice until we get the
|
||
|
|
* same information twice in a row.
|
||
|
|
*
|
||
|
|
* Because a small, but not insignificant, amount of time is required
|
||
|
|
* to write out the progress-query information, especially upon
|
||
|
|
* completion of the DMA, it would be wise to guarantee some time lag
|
||
|
|
* between successive readings of the progress-query information.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/* How many iterations of the loop below to execute to stabilize values */
|
||
|
|
#define STABTIME 0
|
||
|
|
|
||
|
|
int MCD_XferProgrQuery(int channel, MCD_XferProg * progRep)
|
||
|
|
{
|
||
|
|
MCD_XferProg prevRep;
|
||
|
|
int again; /* true if we are to try again to ge
|
||
|
|
consistent results */
|
||
|
|
int i; /* used as a time-waste counter */
|
||
|
|
int destDiffBytes; /* Total no of bytes that we think actually
|
||
|
|
got xfered. */
|
||
|
|
int numIterations; /* number of iterations */
|
||
|
|
int bytesNotXfered; /* bytes that did not get xfered. */
|
||
|
|
s8 *LWAlignedInitDestAddr, *LWAlignedCurrDestAddr;
|
||
|
|
int subModVal, addModVal; /* Mode values to added and subtracted
|
||
|
|
from the final destAddr */
|
||
|
|
|
||
|
|
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];
|
||
|
|
prevRep.lastDestAddr =
|
||
|
|
(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];
|
||
|
|
/* Repeatedly reread those values until they match previous values: */
|
||
|
|
do {
|
||
|
|
/* Waste a little bit of time to ensure stability: */
|
||
|
|
for (i = 0; i < STABTIME; i++) {
|
||
|
|
/* make sure this loop does something so that it
|
||
|
|
doesn't get optimized out */
|
||
|
|
i += i >> 2;
|
||
|
|
}
|
||
|
|
/* Check them again: */
|
||
|
|
progRep->lastSrcAddr =
|
||
|
|
(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];
|
||
|
|
progRep->currBufDesc =
|
||
|
|
(MCD_bufDesc *) ((volatile int *)MCD_taskTable[channel].
|
||
|
|
contextSaveSpace)[CURRBD + CSAVE_OFFSET];
|
||
|
|
/* See if they match: */
|
||
|
|
if (prevRep.lastSrcAddr != progRep->lastSrcAddr
|
||
|
|
|| prevRep.lastDestAddr != progRep->lastDestAddr
|
||
|
|
|| prevRep.dmaSize != progRep->dmaSize
|
||
|
|
|| prevRep.currBufDesc != progRep->currBufDesc) {
|
||
|
|
/* If they don't match, remember previous values and
|
||
|
|
try again: */
|
||
|
|
prevRep.lastSrcAddr = progRep->lastSrcAddr;
|
||
|
|
prevRep.lastDestAddr = progRep->lastDestAddr;
|
||
|
|
prevRep.dmaSize = progRep->dmaSize;
|
||
|
|
prevRep.currBufDesc = progRep->currBufDesc;
|
||
|
|
again = MCD_TRUE;
|
||
|
|
} else
|
||
|
|
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]) {
|
||
|
|
case MINUS1:
|
||
|
|
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]
|
||
|
|
+ MCD_remVariants.remXferSize[channel]);
|
||
|
|
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);
|
||
|
|
/* These bytes are already in lastDestAddr. */
|
||
|
|
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]
|
||
|
|
- MCD_remVariants.remXferSize[channel]);
|
||
|
|
progRep->dmaSize = destDiffBytes - bytesNotXfered - subModVal;
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* This covers M1,P1,Z for source */
|
||
|
|
switch (MCD_remVariants.remSrcRsdIncr[channel]) {
|
||
|
|
case MINUS1:
|
||
|
|
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]));
|
||
|
|
break;
|
||
|
|
default:
|
||
|
|
break;
|
||
|
|
}
|
||
|
|
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/******************* End of MCD_XferProgrQuery() ********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* MCD_resmActions() does the majority of the actions of a DMA resume.
|
||
|
|
* It is called from MCD_killDma() and MCD_resumeDma(). It has to be
|
||
|
|
* a separate function because the kill function has to negate the task
|
||
|
|
* 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)
|
||
|
|
{
|
||
|
|
MCD_dmaBar->debugControl = DBG_CTL_DISABLE;
|
||
|
|
MCD_dmaBar->debugStatus = MCD_dmaBar->debugStatus;
|
||
|
|
/* This register is selected to know which initiator is
|
||
|
|
actually asserted. */
|
||
|
|
MCD_dmaBar->ptdDebug = PTD_DBG_TSK_VLD_INIT;
|
||
|
|
|
||
|
|
if ((MCD_dmaBar->ptdDebug >> channel) & 0x1)
|
||
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
||
|
|
else
|
||
|
|
MCD_chStatus[channel] = MCD_IDLE;
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************* End of MCD_resmActions() *********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_killDma
|
||
|
|
* Purpose: Halt the DMA on the requested channel, without any
|
||
|
|
* intention of resuming the DMA.
|
||
|
|
* Arguments: channel - requested channel
|
||
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
||
|
|
*
|
||
|
|
* Notes:
|
||
|
|
* A DMA may be killed from any state, including paused state, and it
|
||
|
|
* 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)
|
||
|
|
{
|
||
|
|
/* MCD_XferProg progRep; */
|
||
|
|
|
||
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
||
|
|
return (MCD_CHANNEL_INVALID);
|
||
|
|
|
||
|
|
MCD_dmaBar->taskControl[channel] = 0x0;
|
||
|
|
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
|
||
|
|
* as to override whatever MCD_resumeDma() may do to the channel
|
||
|
|
* status.
|
||
|
|
*/
|
||
|
|
MCD_chStatus[channel] = MCD_HALTED;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Update the current buffer descriptor's lastDestAddr field
|
||
|
|
*
|
||
|
|
* MCD_XferProgrQuery (channel, &progRep);
|
||
|
|
* progRep.currBufDesc->lastDestAddr = progRep.lastDestAddr;
|
||
|
|
*/
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/************************ End of MCD_killDma() **********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_continDma
|
||
|
|
* Purpose: Continue a DMA which as stopped due to encountering an
|
||
|
|
* unready buffer descriptor.
|
||
|
|
* Arguments: channel - channel to continue the DMA on
|
||
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
||
|
|
*
|
||
|
|
* Notes:
|
||
|
|
* 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)
|
||
|
|
{
|
||
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
||
|
|
return (MCD_CHANNEL_INVALID);
|
||
|
|
|
||
|
|
MCD_dmaBar->taskControl[channel] |= TASK_CTL_EN;
|
||
|
|
MCD_chStatus[channel] = MCD_RUNNING;
|
||
|
|
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************** End of MCD_continDma() **********************/
|
||
|
|
|
||
|
|
/*********************************************************************
|
||
|
|
* MCD_pauseDma() and MCD_resumeDma() below use the DMA's debug unit
|
||
|
|
* to freeze a task and resume it. We freeze a task by breakpointing
|
||
|
|
* on the stated task. That is, not any specific place in the task,
|
||
|
|
* but any time that task executes. In particular, when that task
|
||
|
|
* executes, we want to freeze that task and only that task.
|
||
|
|
*
|
||
|
|
* The bits of the debug control register influence interrupts vs.
|
||
|
|
* breakpoints as follows:
|
||
|
|
* - Bits 14 and 0 enable or disable debug functions. If enabled, you
|
||
|
|
* will get the interrupt but you may or may not get a breakpoint.
|
||
|
|
* - Bits 2 and 1 decide whether you also get a breakpoint in addition
|
||
|
|
* to an interrupt.
|
||
|
|
*
|
||
|
|
* The debug unit can do these actions in response to either internally
|
||
|
|
* detected breakpoint conditions from the comparators, or in response
|
||
|
|
* to the external breakpoint pin, or both.
|
||
|
|
* - Bits 14 and 1 perform the above-described functions for
|
||
|
|
* internally-generated conditions, i.e., the debug comparators.
|
||
|
|
* - Bits 0 and 2 perform the above-described functions for external
|
||
|
|
* conditions, i.e., the breakpoint external pin.
|
||
|
|
*
|
||
|
|
* Note that, although you "always" get the interrupt when you turn
|
||
|
|
* the debug functions, the interrupt can nevertheless, if desired, be
|
||
|
|
* masked by the corresponding bit in the PTD's IMR. Note also that
|
||
|
|
* this means that bits 14 and 0 must enable debug functions before
|
||
|
|
* bits 1 and 2, respectively, have any effect.
|
||
|
|
*
|
||
|
|
* NOTE: It's extremely important to not pause more than one DMA channel
|
||
|
|
* at a time.
|
||
|
|
********************************************************************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_pauseDma
|
||
|
|
* Purpose: Pauses the DMA on a given channel (if any DMA is running
|
||
|
|
* on that channel).
|
||
|
|
* Arguments: channel
|
||
|
|
* Returns: MCD_CHANNEL_INVALID if channel is invalid, else MCD_OK
|
||
|
|
*/
|
||
|
|
int MCD_pauseDma(int channel)
|
||
|
|
{
|
||
|
|
/* MCD_XferProg progRep; */
|
||
|
|
|
||
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
||
|
|
return (MCD_CHANNEL_INVALID);
|
||
|
|
|
||
|
|
if (MCD_dmaBar->taskControl[channel] & TASK_CTL_EN) {
|
||
|
|
MCD_dmaBar->debugComp1 = channel;
|
||
|
|
MCD_dmaBar->debugControl =
|
||
|
|
DBG_CTL_ENABLE | (1 << (channel + 16));
|
||
|
|
MCD_chStatus[channel] = MCD_PAUSED;
|
||
|
|
|
||
|
|
/*
|
||
|
|
* Update the current buffer descriptor's lastDestAddr field
|
||
|
|
*
|
||
|
|
* MCD_XferProgrQuery (channel, &progRep);
|
||
|
|
* progRep.currBufDesc->lastDestAddr = progRep.lastDestAddr;
|
||
|
|
*/
|
||
|
|
}
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/************************* End of MCD_pauseDma() ********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_resumeDma
|
||
|
|
* Purpose: Resumes the DMA on a given channel (if any DMA is
|
||
|
|
* running on that 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)
|
||
|
|
{
|
||
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
||
|
|
return (MCD_CHANNEL_INVALID);
|
||
|
|
|
||
|
|
if (MCD_dmaBar->taskControl[channel] & TASK_CTL_EN)
|
||
|
|
MCD_resmActions(channel);
|
||
|
|
|
||
|
|
return (MCD_OK);
|
||
|
|
}
|
||
|
|
|
||
|
|
/************************ End of MCD_resumeDma() ********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_csumQuery
|
||
|
|
* Purpose: Provide the checksum after performing a non-chained DMA
|
||
|
|
* Arguments: channel - channel to report on
|
||
|
|
* csum - pointer to where to write the checksum/CRC
|
||
|
|
* Returns: MCD_ERROR if the channel is invalid, else MCD_OK
|
||
|
|
*
|
||
|
|
* Notes:
|
||
|
|
*
|
||
|
|
*/
|
||
|
|
int MCD_csumQuery(int channel, u32 * csum)
|
||
|
|
{
|
||
|
|
#ifdef MCD_INCLUDE_EU
|
||
|
|
if ((channel < 0) || (channel >= NCHANNELS))
|
||
|
|
return (MCD_CHANNEL_INVALID);
|
||
|
|
|
||
|
|
*csum = MCD_relocBuffDesc[channel].csumResult;
|
||
|
|
return (MCD_OK);
|
||
|
|
#else
|
||
|
|
return (MCD_ERROR);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/*********************** End of MCD_resumeDma() *********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_getCodeSize
|
||
|
|
* Purpose: Provide the size requirements of the microcoded tasks
|
||
|
|
* Returns: Size in bytes
|
||
|
|
*/
|
||
|
|
int MCD_getCodeSize(void)
|
||
|
|
{
|
||
|
|
#ifdef MCD_INCLUDE_EU
|
||
|
|
return (0x2b5c);
|
||
|
|
#else
|
||
|
|
return (0x173c);
|
||
|
|
#endif
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************** End of MCD_getCodeSize() ********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Function: MCD_getVersion
|
||
|
|
* Purpose: Provide the version string and number
|
||
|
|
* Arguments: longVersion - user supplied pointer to a pointer to a char
|
||
|
|
* which points to the version string
|
||
|
|
* Returns: Version number and version string (by reference)
|
||
|
|
*/
|
||
|
|
char MCD_versionString[] = "Multi-channel DMA API Alpha v0.3 (2004-04-26)";
|
||
|
|
#define MCD_REV_MAJOR 0x00
|
||
|
|
#define MCD_REV_MINOR 0x03
|
||
|
|
|
||
|
|
int MCD_getVersion(char **longVersion)
|
||
|
|
{
|
||
|
|
*longVersion = MCD_versionString;
|
||
|
|
return ((MCD_REV_MAJOR << 8) | MCD_REV_MINOR);
|
||
|
|
}
|
||
|
|
|
||
|
|
/********************** End of MCD_getVersion() *********************/
|
||
|
|
|
||
|
|
/********************************************************************/
|
||
|
|
/* Private version of memcpy()
|
||
|
|
* Note that everything this is used for is longword-aligned.
|
||
|
|
*/
|
||
|
|
static void MCD_memcpy(int *dest, int *src, u32 size)
|
||
|
|
{
|
||
|
|
u32 i;
|
||
|
|
|
||
|
|
for (i = 0; i < size; i += sizeof(int), dest++, src++)
|
||
|
|
*dest = *src;
|
||
|
|
}
|
||
|
|
#endif /* CONFIG_FSLDMAFEC */
|