918 lines
28 KiB
C
918 lines
28 KiB
C
|
/*****************************************************************************
|
||
|
* Copyright 2003 - 2008 Broadcom Corporation. All rights reserved.
|
||
|
*
|
||
|
* Unless you and Broadcom execute a separate written software license
|
||
|
* agreement governing use of this software, this software is licensed to you
|
||
|
* under the terms of the GNU General Public License version 2, available at
|
||
|
* http://www.broadcom.com/licenses/GPLv2.php (the "GPL").
|
||
|
*
|
||
|
* Notwithstanding the above, under no circumstances may you combine this
|
||
|
* software in any way with any other Broadcom software provided under a
|
||
|
* license other than the GPL, without Broadcom's express prior written
|
||
|
* consent.
|
||
|
*****************************************************************************/
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @file dmacHw.c
|
||
|
*
|
||
|
* @brief Low level DMA controller driver routines
|
||
|
*
|
||
|
* @note
|
||
|
*
|
||
|
* These routines provide basic DMA functionality only.
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
|
||
|
/* ---- Include Files ---------------------------------------------------- */
|
||
|
#include <csp/stdint.h>
|
||
|
#include <csp/string.h>
|
||
|
#include <stddef.h>
|
||
|
|
||
|
#include <csp/dmacHw.h>
|
||
|
#include <mach/csp/dmacHw_reg.h>
|
||
|
#include <mach/csp/dmacHw_priv.h>
|
||
|
#include <mach/csp/chipcHw_inline.h>
|
||
|
|
||
|
/* ---- External Function Prototypes ------------------------------------- */
|
||
|
|
||
|
/* Allocate DMA control blocks */
|
||
|
dmacHw_CBLK_t dmacHw_gCblk[dmacHw_MAX_CHANNEL_COUNT];
|
||
|
|
||
|
uint32_t dmaChannelCount_0 = dmacHw_MAX_CHANNEL_COUNT / 2;
|
||
|
uint32_t dmaChannelCount_1 = dmacHw_MAX_CHANNEL_COUNT / 2;
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Get maximum FIFO for a DMA channel
|
||
|
*
|
||
|
* @return Maximum allowable FIFO size
|
||
|
*
|
||
|
*
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
static uint32_t GetFifoSize(dmacHw_HANDLE_t handle /* [ IN ] DMA Channel handle */
|
||
|
) {
|
||
|
uint32_t val = 0;
|
||
|
dmacHw_CBLK_t *pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
dmacHw_MISC_t *pMiscReg =
|
||
|
(dmacHw_MISC_t *) dmacHw_REG_MISC_BASE(pCblk->module);
|
||
|
|
||
|
switch (pCblk->channel) {
|
||
|
case 0:
|
||
|
val = (pMiscReg->CompParm2.lo & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 1:
|
||
|
val = (pMiscReg->CompParm3.hi & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 2:
|
||
|
val = (pMiscReg->CompParm3.lo & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 3:
|
||
|
val = (pMiscReg->CompParm4.hi & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 4:
|
||
|
val = (pMiscReg->CompParm4.lo & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 5:
|
||
|
val = (pMiscReg->CompParm5.hi & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 6:
|
||
|
val = (pMiscReg->CompParm5.lo & 0x70000000) >> 28;
|
||
|
break;
|
||
|
case 7:
|
||
|
val = (pMiscReg->CompParm6.hi & 0x70000000) >> 28;
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (val <= 0x4) {
|
||
|
return 8 << val;
|
||
|
} else {
|
||
|
dmacHw_ASSERT(0);
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Program channel register to initiate transfer
|
||
|
*
|
||
|
* @return void
|
||
|
*
|
||
|
*
|
||
|
* @note
|
||
|
* - Descriptor buffer MUST ALWAYS be flushed before calling this function
|
||
|
* - This function should also be called from ISR to program the channel with
|
||
|
* pending descriptors
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
void dmacHw_initiateTransfer(dmacHw_HANDLE_t handle, /* [ IN ] DMA Channel handle */
|
||
|
dmacHw_CONFIG_t *pConfig, /* [ IN ] Configuration settings */
|
||
|
void *pDescriptor /* [ IN ] Descriptor buffer */
|
||
|
) {
|
||
|
dmacHw_DESC_RING_t *pRing;
|
||
|
dmacHw_DESC_t *pProg;
|
||
|
dmacHw_CBLK_t *pCblk;
|
||
|
|
||
|
pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
pRing = dmacHw_GET_DESC_RING(pDescriptor);
|
||
|
|
||
|
if (CHANNEL_BUSY(pCblk->module, pCblk->channel)) {
|
||
|
/* Not safe yet to program the channel */
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (pCblk->varDataStarted) {
|
||
|
if (pCblk->descUpdated) {
|
||
|
pCblk->descUpdated = 0;
|
||
|
pProg =
|
||
|
(dmacHw_DESC_t *) ((uint32_t)
|
||
|
dmacHw_REG_LLP(pCblk->module,
|
||
|
pCblk->channel) +
|
||
|
pRing->virt2PhyOffset);
|
||
|
|
||
|
/* Load descriptor if not loaded */
|
||
|
if (!(pProg->ctl.hi & dmacHw_REG_CTL_DONE)) {
|
||
|
dmacHw_SET_SAR(pCblk->module, pCblk->channel,
|
||
|
pProg->sar);
|
||
|
dmacHw_SET_DAR(pCblk->module, pCblk->channel,
|
||
|
pProg->dar);
|
||
|
dmacHw_REG_CTL_LO(pCblk->module,
|
||
|
pCblk->channel) =
|
||
|
pProg->ctl.lo;
|
||
|
dmacHw_REG_CTL_HI(pCblk->module,
|
||
|
pCblk->channel) =
|
||
|
pProg->ctl.hi;
|
||
|
} else if (pProg == (dmacHw_DESC_t *) pRing->pEnd->llp) {
|
||
|
/* Return as end descriptor is processed */
|
||
|
return;
|
||
|
} else {
|
||
|
dmacHw_ASSERT(0);
|
||
|
}
|
||
|
} else {
|
||
|
return;
|
||
|
}
|
||
|
} else {
|
||
|
if (pConfig->transferMode == dmacHw_TRANSFER_MODE_PERIODIC) {
|
||
|
/* Do not make a single chain, rather process one descriptor at a time */
|
||
|
pProg = pRing->pHead;
|
||
|
/* Point to the next descriptor for next iteration */
|
||
|
dmacHw_NEXT_DESC(pRing, pHead);
|
||
|
} else {
|
||
|
/* Return if no more pending descriptor */
|
||
|
if (pRing->pEnd == NULL) {
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
pProg = pRing->pProg;
|
||
|
if (pConfig->transferMode ==
|
||
|
dmacHw_TRANSFER_MODE_CONTINUOUS) {
|
||
|
/* Make sure a complete ring can be formed */
|
||
|
dmacHw_ASSERT((dmacHw_DESC_t *) pRing->pEnd->
|
||
|
llp == pRing->pProg);
|
||
|
/* Make sure pProg pointing to the pHead */
|
||
|
dmacHw_ASSERT((dmacHw_DESC_t *) pRing->pProg ==
|
||
|
pRing->pHead);
|
||
|
/* Make a complete ring */
|
||
|
do {
|
||
|
pRing->pProg->ctl.lo |=
|
||
|
(dmacHw_REG_CTL_LLP_DST_EN |
|
||
|
dmacHw_REG_CTL_LLP_SRC_EN);
|
||
|
pRing->pProg =
|
||
|
(dmacHw_DESC_t *) pRing->pProg->llp;
|
||
|
} while (pRing->pProg != pRing->pHead);
|
||
|
} else {
|
||
|
/* Make a single long chain */
|
||
|
while (pRing->pProg != pRing->pEnd) {
|
||
|
pRing->pProg->ctl.lo |=
|
||
|
(dmacHw_REG_CTL_LLP_DST_EN |
|
||
|
dmacHw_REG_CTL_LLP_SRC_EN);
|
||
|
pRing->pProg =
|
||
|
(dmacHw_DESC_t *) pRing->pProg->llp;
|
||
|
}
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Program the channel registers */
|
||
|
dmacHw_SET_SAR(pCblk->module, pCblk->channel, pProg->sar);
|
||
|
dmacHw_SET_DAR(pCblk->module, pCblk->channel, pProg->dar);
|
||
|
dmacHw_SET_LLP(pCblk->module, pCblk->channel,
|
||
|
(uint32_t) pProg - pRing->virt2PhyOffset);
|
||
|
dmacHw_REG_CTL_LO(pCblk->module, pCblk->channel) =
|
||
|
pProg->ctl.lo;
|
||
|
dmacHw_REG_CTL_HI(pCblk->module, pCblk->channel) =
|
||
|
pProg->ctl.hi;
|
||
|
if (pRing->pEnd) {
|
||
|
/* Remember the descriptor to use next */
|
||
|
pRing->pProg = (dmacHw_DESC_t *) pRing->pEnd->llp;
|
||
|
}
|
||
|
/* Indicate no more pending descriptor */
|
||
|
pRing->pEnd = (dmacHw_DESC_t *) NULL;
|
||
|
}
|
||
|
/* Start DMA operation */
|
||
|
dmacHw_DMA_START(pCblk->module, pCblk->channel);
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Initializes DMA
|
||
|
*
|
||
|
* This function initializes DMA CSP driver
|
||
|
*
|
||
|
* @note
|
||
|
* Must be called before using any DMA channel
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
void dmacHw_initDma(void)
|
||
|
{
|
||
|
|
||
|
uint32_t i = 0;
|
||
|
|
||
|
dmaChannelCount_0 = dmacHw_GET_NUM_CHANNEL(0);
|
||
|
dmaChannelCount_1 = dmacHw_GET_NUM_CHANNEL(1);
|
||
|
|
||
|
/* Enable access to the DMA block */
|
||
|
chipcHw_busInterfaceClockEnable(chipcHw_REG_BUS_CLOCK_DMAC0);
|
||
|
chipcHw_busInterfaceClockEnable(chipcHw_REG_BUS_CLOCK_DMAC1);
|
||
|
|
||
|
if ((dmaChannelCount_0 + dmaChannelCount_1) > dmacHw_MAX_CHANNEL_COUNT) {
|
||
|
dmacHw_ASSERT(0);
|
||
|
}
|
||
|
|
||
|
memset((void *)dmacHw_gCblk, 0,
|
||
|
sizeof(dmacHw_CBLK_t) * (dmaChannelCount_0 + dmaChannelCount_1));
|
||
|
for (i = 0; i < dmaChannelCount_0; i++) {
|
||
|
dmacHw_gCblk[i].module = 0;
|
||
|
dmacHw_gCblk[i].channel = i;
|
||
|
}
|
||
|
for (i = 0; i < dmaChannelCount_1; i++) {
|
||
|
dmacHw_gCblk[i + dmaChannelCount_0].module = 1;
|
||
|
dmacHw_gCblk[i + dmaChannelCount_0].channel = i;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Exit function for DMA
|
||
|
*
|
||
|
* This function isolates DMA from the system
|
||
|
*
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
void dmacHw_exitDma(void)
|
||
|
{
|
||
|
/* Disable access to the DMA block */
|
||
|
chipcHw_busInterfaceClockDisable(chipcHw_REG_BUS_CLOCK_DMAC0);
|
||
|
chipcHw_busInterfaceClockDisable(chipcHw_REG_BUS_CLOCK_DMAC1);
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Gets a handle to a DMA channel
|
||
|
*
|
||
|
* This function returns a handle, representing a control block of a particular DMA channel
|
||
|
*
|
||
|
* @return -1 - On Failure
|
||
|
* handle - On Success, representing a channel control block
|
||
|
*
|
||
|
* @note
|
||
|
* None Channel ID must be created using "dmacHw_MAKE_CHANNEL_ID" macro
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
dmacHw_HANDLE_t dmacHw_getChannelHandle(dmacHw_ID_t channelId /* [ IN ] DMA Channel Id */
|
||
|
) {
|
||
|
int idx;
|
||
|
|
||
|
switch ((channelId >> 8)) {
|
||
|
case 0:
|
||
|
dmacHw_ASSERT((channelId & 0xff) < dmaChannelCount_0);
|
||
|
idx = (channelId & 0xff);
|
||
|
break;
|
||
|
case 1:
|
||
|
dmacHw_ASSERT((channelId & 0xff) < dmaChannelCount_1);
|
||
|
idx = dmaChannelCount_0 + (channelId & 0xff);
|
||
|
break;
|
||
|
default:
|
||
|
dmacHw_ASSERT(0);
|
||
|
return (dmacHw_HANDLE_t) -1;
|
||
|
}
|
||
|
|
||
|
return dmacHw_CBLK_TO_HANDLE(&dmacHw_gCblk[idx]);
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Initializes a DMA channel for use
|
||
|
*
|
||
|
* This function initializes and resets a DMA channel for use
|
||
|
*
|
||
|
* @return -1 - On Failure
|
||
|
* 0 - On Success
|
||
|
*
|
||
|
* @note
|
||
|
* None
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
int dmacHw_initChannel(dmacHw_HANDLE_t handle /* [ IN ] DMA Channel handle */
|
||
|
) {
|
||
|
dmacHw_CBLK_t *pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
int module = pCblk->module;
|
||
|
int channel = pCblk->channel;
|
||
|
|
||
|
/* Reinitialize the control block */
|
||
|
memset((void *)pCblk, 0, sizeof(dmacHw_CBLK_t));
|
||
|
pCblk->module = module;
|
||
|
pCblk->channel = channel;
|
||
|
|
||
|
/* Enable DMA controller */
|
||
|
dmacHw_DMA_ENABLE(pCblk->module);
|
||
|
/* Reset DMA channel */
|
||
|
dmacHw_RESET_CONTROL_LO(pCblk->module, pCblk->channel);
|
||
|
dmacHw_RESET_CONTROL_HI(pCblk->module, pCblk->channel);
|
||
|
dmacHw_RESET_CONFIG_LO(pCblk->module, pCblk->channel);
|
||
|
dmacHw_RESET_CONFIG_HI(pCblk->module, pCblk->channel);
|
||
|
|
||
|
/* Clear all raw interrupt status */
|
||
|
dmacHw_TRAN_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
dmacHw_BLOCK_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
dmacHw_ERROR_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
|
||
|
/* Mask event specific interrupts */
|
||
|
dmacHw_TRAN_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
dmacHw_BLOCK_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
dmacHw_STRAN_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
dmacHw_DTRAN_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
dmacHw_ERROR_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Finds amount of memory required to form a descriptor ring
|
||
|
*
|
||
|
*
|
||
|
* @return Number of bytes required to form a descriptor ring
|
||
|
*
|
||
|
*
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
uint32_t dmacHw_descriptorLen(uint32_t descCnt /* [ IN ] Number of descriptor in the ring */
|
||
|
) {
|
||
|
/* Need extra 4 byte to ensure 32 bit alignment */
|
||
|
return (descCnt * sizeof(dmacHw_DESC_t)) + sizeof(dmacHw_DESC_RING_t) +
|
||
|
sizeof(uint32_t);
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Initializes descriptor ring
|
||
|
*
|
||
|
* This function will initializes the descriptor ring of a DMA channel
|
||
|
*
|
||
|
*
|
||
|
* @return -1 - On failure
|
||
|
* 0 - On success
|
||
|
* @note
|
||
|
* - "len" parameter should be obtained from "dmacHw_descriptorLen"
|
||
|
* - Descriptor buffer MUST be 32 bit aligned and uncached as it is
|
||
|
* accessed by ARM and DMA
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
int dmacHw_initDescriptor(void *pDescriptorVirt, /* [ IN ] Virtual address of uncahced buffer allocated to form descriptor ring */
|
||
|
uint32_t descriptorPhyAddr, /* [ IN ] Physical address of pDescriptorVirt (descriptor buffer) */
|
||
|
uint32_t len, /* [ IN ] Size of the pBuf */
|
||
|
uint32_t num /* [ IN ] Number of descriptor in the ring */
|
||
|
) {
|
||
|
uint32_t i;
|
||
|
dmacHw_DESC_RING_t *pRing;
|
||
|
dmacHw_DESC_t *pDesc;
|
||
|
|
||
|
/* Check the alignment of the descriptor */
|
||
|
if ((uint32_t) pDescriptorVirt & 0x00000003) {
|
||
|
dmacHw_ASSERT(0);
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
/* Check if enough space has been allocated for descriptor ring */
|
||
|
if (len < dmacHw_descriptorLen(num)) {
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
pRing = dmacHw_GET_DESC_RING(pDescriptorVirt);
|
||
|
pRing->pHead =
|
||
|
(dmacHw_DESC_t *) ((uint32_t) pRing + sizeof(dmacHw_DESC_RING_t));
|
||
|
pRing->pFree = pRing->pTail = pRing->pEnd = pRing->pHead;
|
||
|
pRing->pProg = dmacHw_DESC_INIT;
|
||
|
/* Initialize link item chain, starting from the head */
|
||
|
pDesc = pRing->pHead;
|
||
|
/* Find the offset between virtual to physical address */
|
||
|
pRing->virt2PhyOffset = (uint32_t) pDescriptorVirt - descriptorPhyAddr;
|
||
|
|
||
|
/* Form the descriptor ring */
|
||
|
for (i = 0; i < num - 1; i++) {
|
||
|
/* Clear link list item */
|
||
|
memset((void *)pDesc, 0, sizeof(dmacHw_DESC_t));
|
||
|
/* Point to the next item in the physical address */
|
||
|
pDesc->llpPhy = (uint32_t) (pDesc + 1) - pRing->virt2PhyOffset;
|
||
|
/* Point to the next item in the virtual address */
|
||
|
pDesc->llp = (uint32_t) (pDesc + 1);
|
||
|
/* Mark descriptor is ready to use */
|
||
|
pDesc->ctl.hi = dmacHw_DESC_FREE;
|
||
|
/* Look into next link list item */
|
||
|
pDesc++;
|
||
|
}
|
||
|
|
||
|
/* Clear last link list item */
|
||
|
memset((void *)pDesc, 0, sizeof(dmacHw_DESC_t));
|
||
|
/* Last item pointing to the first item in the
|
||
|
physical address to complete the ring */
|
||
|
pDesc->llpPhy = (uint32_t) pRing->pHead - pRing->virt2PhyOffset;
|
||
|
/* Last item pointing to the first item in the
|
||
|
virtual address to complete the ring
|
||
|
*/
|
||
|
pDesc->llp = (uint32_t) pRing->pHead;
|
||
|
/* Mark descriptor is ready to use */
|
||
|
pDesc->ctl.hi = dmacHw_DESC_FREE;
|
||
|
/* Set the number of descriptors in the ring */
|
||
|
pRing->num = num;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Configure DMA channel
|
||
|
*
|
||
|
* @return 0 : On success
|
||
|
* -1 : On failure
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
int dmacHw_configChannel(dmacHw_HANDLE_t handle, /* [ IN ] DMA Channel handle */
|
||
|
dmacHw_CONFIG_t *pConfig /* [ IN ] Configuration settings */
|
||
|
) {
|
||
|
dmacHw_CBLK_t *pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
uint32_t cfgHigh = 0;
|
||
|
int srcTrSize;
|
||
|
int dstTrSize;
|
||
|
|
||
|
pCblk->varDataStarted = 0;
|
||
|
pCblk->userData = NULL;
|
||
|
|
||
|
/* Configure
|
||
|
- Burst transaction when enough data in available in FIFO
|
||
|
- AHB Access protection 1
|
||
|
- Source and destination peripheral ports
|
||
|
*/
|
||
|
cfgHigh =
|
||
|
dmacHw_REG_CFG_HI_FIFO_ENOUGH | dmacHw_REG_CFG_HI_AHB_HPROT_1 |
|
||
|
dmacHw_SRC_PERI_INTF(pConfig->
|
||
|
srcPeripheralPort) |
|
||
|
dmacHw_DST_PERI_INTF(pConfig->dstPeripheralPort);
|
||
|
/* Set priority */
|
||
|
dmacHw_SET_CHANNEL_PRIORITY(pCblk->module, pCblk->channel,
|
||
|
pConfig->channelPriority);
|
||
|
|
||
|
if (pConfig->dstStatusRegisterAddress != 0) {
|
||
|
/* Destination status update enable */
|
||
|
cfgHigh |= dmacHw_REG_CFG_HI_UPDATE_DST_STAT;
|
||
|
/* Configure status registers */
|
||
|
dmacHw_SET_DSTATAR(pCblk->module, pCblk->channel,
|
||
|
pConfig->dstStatusRegisterAddress);
|
||
|
}
|
||
|
|
||
|
if (pConfig->srcStatusRegisterAddress != 0) {
|
||
|
/* Source status update enable */
|
||
|
cfgHigh |= dmacHw_REG_CFG_HI_UPDATE_SRC_STAT;
|
||
|
/* Source status update enable */
|
||
|
dmacHw_SET_SSTATAR(pCblk->module, pCblk->channel,
|
||
|
pConfig->srcStatusRegisterAddress);
|
||
|
}
|
||
|
/* Configure the config high register */
|
||
|
dmacHw_GET_CONFIG_HI(pCblk->module, pCblk->channel) = cfgHigh;
|
||
|
|
||
|
/* Clear all raw interrupt status */
|
||
|
dmacHw_TRAN_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
dmacHw_BLOCK_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
dmacHw_ERROR_INT_CLEAR(pCblk->module, pCblk->channel);
|
||
|
|
||
|
/* Configure block interrupt */
|
||
|
if (pConfig->blockTransferInterrupt == dmacHw_INTERRUPT_ENABLE) {
|
||
|
dmacHw_BLOCK_INT_ENABLE(pCblk->module, pCblk->channel);
|
||
|
} else {
|
||
|
dmacHw_BLOCK_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
}
|
||
|
/* Configure complete transfer interrupt */
|
||
|
if (pConfig->completeTransferInterrupt == dmacHw_INTERRUPT_ENABLE) {
|
||
|
dmacHw_TRAN_INT_ENABLE(pCblk->module, pCblk->channel);
|
||
|
} else {
|
||
|
dmacHw_TRAN_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
}
|
||
|
/* Configure error interrupt */
|
||
|
if (pConfig->errorInterrupt == dmacHw_INTERRUPT_ENABLE) {
|
||
|
dmacHw_ERROR_INT_ENABLE(pCblk->module, pCblk->channel);
|
||
|
} else {
|
||
|
dmacHw_ERROR_INT_DISABLE(pCblk->module, pCblk->channel);
|
||
|
}
|
||
|
/* Configure gather register */
|
||
|
if (pConfig->srcGatherWidth) {
|
||
|
srcTrSize =
|
||
|
dmacHw_GetTrWidthInBytes(pConfig->srcMaxTransactionWidth);
|
||
|
if (!
|
||
|
((pConfig->srcGatherWidth % srcTrSize)
|
||
|
&& (pConfig->srcGatherJump % srcTrSize))) {
|
||
|
dmacHw_REG_SGR_LO(pCblk->module, pCblk->channel) =
|
||
|
((pConfig->srcGatherWidth /
|
||
|
srcTrSize) << 20) | (pConfig->srcGatherJump /
|
||
|
srcTrSize);
|
||
|
} else {
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
/* Configure scatter register */
|
||
|
if (pConfig->dstScatterWidth) {
|
||
|
dstTrSize =
|
||
|
dmacHw_GetTrWidthInBytes(pConfig->dstMaxTransactionWidth);
|
||
|
if (!
|
||
|
((pConfig->dstScatterWidth % dstTrSize)
|
||
|
&& (pConfig->dstScatterJump % dstTrSize))) {
|
||
|
dmacHw_REG_DSR_LO(pCblk->module, pCblk->channel) =
|
||
|
((pConfig->dstScatterWidth /
|
||
|
dstTrSize) << 20) | (pConfig->dstScatterJump /
|
||
|
dstTrSize);
|
||
|
} else {
|
||
|
return -1;
|
||
|
}
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Indicates whether DMA transfer is in progress or completed
|
||
|
*
|
||
|
* @return DMA transfer status
|
||
|
* dmacHw_TRANSFER_STATUS_BUSY: DMA Transfer ongoing
|
||
|
* dmacHw_TRANSFER_STATUS_DONE: DMA Transfer completed
|
||
|
* dmacHw_TRANSFER_STATUS_ERROR: DMA Transfer error
|
||
|
*
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
dmacHw_TRANSFER_STATUS_e dmacHw_transferCompleted(dmacHw_HANDLE_t handle /* [ IN ] DMA Channel handle */
|
||
|
) {
|
||
|
dmacHw_CBLK_t *pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
|
||
|
if (CHANNEL_BUSY(pCblk->module, pCblk->channel)) {
|
||
|
return dmacHw_TRANSFER_STATUS_BUSY;
|
||
|
} else if (dmacHw_REG_INT_RAW_ERROR(pCblk->module) &
|
||
|
(0x00000001 << pCblk->channel)) {
|
||
|
return dmacHw_TRANSFER_STATUS_ERROR;
|
||
|
}
|
||
|
|
||
|
return dmacHw_TRANSFER_STATUS_DONE;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Set descriptors for known data length
|
||
|
*
|
||
|
* When DMA has to work as a flow controller, this function prepares the
|
||
|
* descriptor chain to transfer data
|
||
|
*
|
||
|
* from:
|
||
|
* - Memory to memory
|
||
|
* - Peripheral to memory
|
||
|
* - Memory to Peripheral
|
||
|
* - Peripheral to Peripheral
|
||
|
*
|
||
|
* @return -1 - On failure
|
||
|
* 0 - On success
|
||
|
*
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
int dmacHw_setDataDescriptor(dmacHw_CONFIG_t *pConfig, /* [ IN ] Configuration settings */
|
||
|
void *pDescriptor, /* [ IN ] Descriptor buffer */
|
||
|
void *pSrcAddr, /* [ IN ] Source (Peripheral/Memory) address */
|
||
|
void *pDstAddr, /* [ IN ] Destination (Peripheral/Memory) address */
|
||
|
size_t dataLen /* [ IN ] Data length in bytes */
|
||
|
) {
|
||
|
dmacHw_TRANSACTION_WIDTH_e dstTrWidth;
|
||
|
dmacHw_TRANSACTION_WIDTH_e srcTrWidth;
|
||
|
dmacHw_DESC_RING_t *pRing = dmacHw_GET_DESC_RING(pDescriptor);
|
||
|
dmacHw_DESC_t *pStart;
|
||
|
dmacHw_DESC_t *pProg;
|
||
|
int srcTs = 0;
|
||
|
int blkTs = 0;
|
||
|
int oddSize = 0;
|
||
|
int descCount = 0;
|
||
|
int count = 0;
|
||
|
int dstTrSize = 0;
|
||
|
int srcTrSize = 0;
|
||
|
uint32_t maxBlockSize = dmacHw_MAX_BLOCKSIZE;
|
||
|
|
||
|
dstTrSize = dmacHw_GetTrWidthInBytes(pConfig->dstMaxTransactionWidth);
|
||
|
srcTrSize = dmacHw_GetTrWidthInBytes(pConfig->srcMaxTransactionWidth);
|
||
|
|
||
|
/* Skip Tx if buffer is NULL or length is unknown */
|
||
|
if ((pSrcAddr == NULL) || (pDstAddr == NULL) || (dataLen == 0)) {
|
||
|
/* Do not initiate transfer */
|
||
|
return -1;
|
||
|
}
|
||
|
|
||
|
/* Ensure scatter and gather are transaction aligned */
|
||
|
if ((pConfig->srcGatherWidth % srcTrSize)
|
||
|
|| (pConfig->dstScatterWidth % dstTrSize)) {
|
||
|
return -2;
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
Background 1: DMAC can not perform DMA if source and destination addresses are
|
||
|
not properly aligned with the channel's transaction width. So, for successful
|
||
|
DMA transfer, transaction width must be set according to the alignment of the
|
||
|
source and destination address.
|
||
|
*/
|
||
|
|
||
|
/* Adjust destination transaction width if destination address is not aligned properly */
|
||
|
dstTrWidth = pConfig->dstMaxTransactionWidth;
|
||
|
while (dmacHw_ADDRESS_MASK(dstTrSize) & (uint32_t) pDstAddr) {
|
||
|
dstTrWidth = dmacHw_GetNextTrWidth(dstTrWidth);
|
||
|
dstTrSize = dmacHw_GetTrWidthInBytes(dstTrWidth);
|
||
|
}
|
||
|
|
||
|
/* Adjust source transaction width if source address is not aligned properly */
|
||
|
srcTrWidth = pConfig->srcMaxTransactionWidth;
|
||
|
while (dmacHw_ADDRESS_MASK(srcTrSize) & (uint32_t) pSrcAddr) {
|
||
|
srcTrWidth = dmacHw_GetNextTrWidth(srcTrWidth);
|
||
|
srcTrSize = dmacHw_GetTrWidthInBytes(srcTrWidth);
|
||
|
}
|
||
|
|
||
|
/* Find the maximum transaction per descriptor */
|
||
|
if (pConfig->maxDataPerBlock
|
||
|
&& ((pConfig->maxDataPerBlock / srcTrSize) <
|
||
|
dmacHw_MAX_BLOCKSIZE)) {
|
||
|
maxBlockSize = pConfig->maxDataPerBlock / srcTrSize;
|
||
|
}
|
||
|
|
||
|
/* Find number of source transactions needed to complete the DMA transfer */
|
||
|
srcTs = dataLen / srcTrSize;
|
||
|
/* Find the odd number of bytes that need to be transferred as single byte transaction width */
|
||
|
if (srcTs && (dstTrSize > srcTrSize)) {
|
||
|
oddSize = dataLen % dstTrSize;
|
||
|
/* Adjust source transaction count due to "oddSize" */
|
||
|
srcTs = srcTs - (oddSize / srcTrSize);
|
||
|
} else {
|
||
|
oddSize = dataLen % srcTrSize;
|
||
|
}
|
||
|
/* Adjust "descCount" due to "oddSize" */
|
||
|
if (oddSize) {
|
||
|
descCount++;
|
||
|
}
|
||
|
/* Find the number of descriptor needed for total "srcTs" */
|
||
|
if (srcTs) {
|
||
|
descCount += ((srcTs - 1) / maxBlockSize) + 1;
|
||
|
}
|
||
|
|
||
|
/* Check the availability of "descCount" discriptors in the ring */
|
||
|
pProg = pRing->pHead;
|
||
|
for (count = 0; (descCount <= pRing->num) && (count < descCount);
|
||
|
count++) {
|
||
|
if ((pProg->ctl.hi & dmacHw_DESC_FREE) == 0) {
|
||
|
/* Sufficient descriptors are not available */
|
||
|
return -3;
|
||
|
}
|
||
|
pProg = (dmacHw_DESC_t *) pProg->llp;
|
||
|
}
|
||
|
|
||
|
/* Remember the link list item to program the channel registers */
|
||
|
pStart = pProg = pRing->pHead;
|
||
|
/* Make a link list with "descCount(=count)" number of descriptors */
|
||
|
while (count) {
|
||
|
/* Reset channel control information */
|
||
|
pProg->ctl.lo = 0;
|
||
|
/* Enable source gather if configured */
|
||
|
if (pConfig->srcGatherWidth) {
|
||
|
pProg->ctl.lo |= dmacHw_REG_CTL_SG_ENABLE;
|
||
|
}
|
||
|
/* Enable destination scatter if configured */
|
||
|
if (pConfig->dstScatterWidth) {
|
||
|
pProg->ctl.lo |= dmacHw_REG_CTL_DS_ENABLE;
|
||
|
}
|
||
|
/* Set source and destination address */
|
||
|
pProg->sar = (uint32_t) pSrcAddr;
|
||
|
pProg->dar = (uint32_t) pDstAddr;
|
||
|
/* Use "devCtl" to mark that user memory need to be freed later if needed */
|
||
|
if (pProg == pRing->pHead) {
|
||
|
pProg->devCtl = dmacHw_FREE_USER_MEMORY;
|
||
|
} else {
|
||
|
pProg->devCtl = 0;
|
||
|
}
|
||
|
|
||
|
blkTs = srcTs;
|
||
|
|
||
|
/* Special treatmeant for last descriptor */
|
||
|
if (count == 1) {
|
||
|
/* Mark the last descriptor */
|
||
|
pProg->ctl.lo &=
|
||
|
~(dmacHw_REG_CTL_LLP_DST_EN |
|
||
|
dmacHw_REG_CTL_LLP_SRC_EN);
|
||
|
/* Treatment for odd data bytes */
|
||
|
if (oddSize) {
|
||
|
/* Adjust for single byte transaction width */
|
||
|
switch (pConfig->transferType) {
|
||
|
case dmacHw_TRANSFER_TYPE_PERIPHERAL_TO_MEM:
|
||
|
dstTrWidth =
|
||
|
dmacHw_DST_TRANSACTION_WIDTH_8;
|
||
|
blkTs =
|
||
|
(oddSize / srcTrSize) +
|
||
|
((oddSize % srcTrSize) ? 1 : 0);
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_MEM_TO_PERIPHERAL:
|
||
|
srcTrWidth =
|
||
|
dmacHw_SRC_TRANSACTION_WIDTH_8;
|
||
|
blkTs = oddSize;
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_MEM_TO_MEM:
|
||
|
srcTrWidth =
|
||
|
dmacHw_SRC_TRANSACTION_WIDTH_8;
|
||
|
dstTrWidth =
|
||
|
dmacHw_DST_TRANSACTION_WIDTH_8;
|
||
|
blkTs = oddSize;
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_PERIPHERAL_TO_PERIPHERAL:
|
||
|
/* Do not adjust the transaction width */
|
||
|
break;
|
||
|
}
|
||
|
} else {
|
||
|
srcTs -= blkTs;
|
||
|
}
|
||
|
} else {
|
||
|
if (srcTs / maxBlockSize) {
|
||
|
blkTs = maxBlockSize;
|
||
|
}
|
||
|
/* Remaining source transactions for next iteration */
|
||
|
srcTs -= blkTs;
|
||
|
}
|
||
|
/* Must have a valid source transactions */
|
||
|
dmacHw_ASSERT(blkTs > 0);
|
||
|
/* Set control information */
|
||
|
if (pConfig->flowControler == dmacHw_FLOW_CONTROL_DMA) {
|
||
|
pProg->ctl.lo |= pConfig->transferType |
|
||
|
pConfig->srcUpdate |
|
||
|
pConfig->dstUpdate |
|
||
|
srcTrWidth |
|
||
|
dstTrWidth |
|
||
|
pConfig->srcMaxBurstWidth |
|
||
|
pConfig->dstMaxBurstWidth |
|
||
|
pConfig->srcMasterInterface |
|
||
|
pConfig->dstMasterInterface | dmacHw_REG_CTL_INT_EN;
|
||
|
} else {
|
||
|
uint32_t transferType = 0;
|
||
|
switch (pConfig->transferType) {
|
||
|
case dmacHw_TRANSFER_TYPE_PERIPHERAL_TO_MEM:
|
||
|
transferType = dmacHw_REG_CTL_TTFC_PM_PERI;
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_MEM_TO_PERIPHERAL:
|
||
|
transferType = dmacHw_REG_CTL_TTFC_MP_PERI;
|
||
|
break;
|
||
|
default:
|
||
|
dmacHw_ASSERT(0);
|
||
|
}
|
||
|
pProg->ctl.lo |= transferType |
|
||
|
pConfig->srcUpdate |
|
||
|
pConfig->dstUpdate |
|
||
|
srcTrWidth |
|
||
|
dstTrWidth |
|
||
|
pConfig->srcMaxBurstWidth |
|
||
|
pConfig->dstMaxBurstWidth |
|
||
|
pConfig->srcMasterInterface |
|
||
|
pConfig->dstMasterInterface | dmacHw_REG_CTL_INT_EN;
|
||
|
}
|
||
|
|
||
|
/* Set block transaction size */
|
||
|
pProg->ctl.hi = blkTs & dmacHw_REG_CTL_BLOCK_TS_MASK;
|
||
|
/* Look for next descriptor */
|
||
|
if (count > 1) {
|
||
|
/* Point to the next descriptor */
|
||
|
pProg = (dmacHw_DESC_t *) pProg->llp;
|
||
|
|
||
|
/* Update source and destination address for next iteration */
|
||
|
switch (pConfig->transferType) {
|
||
|
case dmacHw_TRANSFER_TYPE_PERIPHERAL_TO_MEM:
|
||
|
if (pConfig->dstScatterWidth) {
|
||
|
pDstAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize +
|
||
|
(((blkTs * srcTrSize) /
|
||
|
pConfig->dstScatterWidth) *
|
||
|
pConfig->dstScatterJump);
|
||
|
} else {
|
||
|
pDstAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize;
|
||
|
}
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_MEM_TO_PERIPHERAL:
|
||
|
if (pConfig->srcGatherWidth) {
|
||
|
pSrcAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize +
|
||
|
(((blkTs * srcTrSize) /
|
||
|
pConfig->srcGatherWidth) *
|
||
|
pConfig->srcGatherJump);
|
||
|
} else {
|
||
|
pSrcAddr =
|
||
|
(char *)pSrcAddr +
|
||
|
blkTs * srcTrSize;
|
||
|
}
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_MEM_TO_MEM:
|
||
|
if (pConfig->dstScatterWidth) {
|
||
|
pDstAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize +
|
||
|
(((blkTs * srcTrSize) /
|
||
|
pConfig->dstScatterWidth) *
|
||
|
pConfig->dstScatterJump);
|
||
|
} else {
|
||
|
pDstAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize;
|
||
|
}
|
||
|
|
||
|
if (pConfig->srcGatherWidth) {
|
||
|
pSrcAddr =
|
||
|
(char *)pDstAddr +
|
||
|
blkTs * srcTrSize +
|
||
|
(((blkTs * srcTrSize) /
|
||
|
pConfig->srcGatherWidth) *
|
||
|
pConfig->srcGatherJump);
|
||
|
} else {
|
||
|
pSrcAddr =
|
||
|
(char *)pSrcAddr +
|
||
|
blkTs * srcTrSize;
|
||
|
}
|
||
|
break;
|
||
|
case dmacHw_TRANSFER_TYPE_PERIPHERAL_TO_PERIPHERAL:
|
||
|
/* Do not adjust the address */
|
||
|
break;
|
||
|
default:
|
||
|
dmacHw_ASSERT(0);
|
||
|
}
|
||
|
} else {
|
||
|
/* At the end of transfer "srcTs" must be zero */
|
||
|
dmacHw_ASSERT(srcTs == 0);
|
||
|
}
|
||
|
count--;
|
||
|
}
|
||
|
|
||
|
/* Remember the descriptor to initialize the registers */
|
||
|
if (pRing->pProg == dmacHw_DESC_INIT) {
|
||
|
pRing->pProg = pStart;
|
||
|
}
|
||
|
/* Indicate that the descriptor is updated */
|
||
|
pRing->pEnd = pProg;
|
||
|
/* Head pointing to the next descriptor */
|
||
|
pRing->pHead = (dmacHw_DESC_t *) pProg->llp;
|
||
|
/* Update Tail pointer if destination is a peripheral,
|
||
|
because no one is going to read from the pTail
|
||
|
*/
|
||
|
if (!dmacHw_DST_IS_MEMORY(pConfig->transferType)) {
|
||
|
pRing->pTail = pRing->pHead;
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
/****************************************************************************/
|
||
|
/**
|
||
|
* @brief Provides DMA controller attributes
|
||
|
*
|
||
|
*
|
||
|
* @return DMA controller attributes
|
||
|
*
|
||
|
* @note
|
||
|
* None
|
||
|
*/
|
||
|
/****************************************************************************/
|
||
|
uint32_t dmacHw_getDmaControllerAttribute(dmacHw_HANDLE_t handle, /* [ IN ] DMA Channel handle */
|
||
|
dmacHw_CONTROLLER_ATTRIB_e attr /* [ IN ] DMA Controler attribute of type dmacHw_CONTROLLER_ATTRIB_e */
|
||
|
) {
|
||
|
dmacHw_CBLK_t *pCblk = dmacHw_HANDLE_TO_CBLK(handle);
|
||
|
|
||
|
switch (attr) {
|
||
|
case dmacHw_CONTROLLER_ATTRIB_CHANNEL_NUM:
|
||
|
return dmacHw_GET_NUM_CHANNEL(pCblk->module);
|
||
|
case dmacHw_CONTROLLER_ATTRIB_CHANNEL_MAX_BLOCK_SIZE:
|
||
|
return (1 <<
|
||
|
(dmacHw_GET_MAX_BLOCK_SIZE
|
||
|
(pCblk->module, pCblk->module) + 2)) - 8;
|
||
|
case dmacHw_CONTROLLER_ATTRIB_MASTER_INTF_NUM:
|
||
|
return dmacHw_GET_NUM_INTERFACE(pCblk->module);
|
||
|
case dmacHw_CONTROLLER_ATTRIB_CHANNEL_BUS_WIDTH:
|
||
|
return 32 << dmacHw_GET_CHANNEL_DATA_WIDTH(pCblk->module,
|
||
|
pCblk->channel);
|
||
|
case dmacHw_CONTROLLER_ATTRIB_CHANNEL_FIFO_SIZE:
|
||
|
return GetFifoSize(handle);
|
||
|
}
|
||
|
dmacHw_ASSERT(0);
|
||
|
return 0;
|
||
|
}
|