|
@@ -27,12 +27,13 @@
|
|
|
|
|
|
#include <config.h>
|
|
#include <config.h>
|
|
#include <common.h>
|
|
#include <common.h>
|
|
|
|
+#include <asm/io.h>
|
|
#include <asm/fsl_dma.h>
|
|
#include <asm/fsl_dma.h>
|
|
|
|
|
|
#if defined(CONFIG_MPC85xx)
|
|
#if defined(CONFIG_MPC85xx)
|
|
-volatile ccsr_dma_t *dma_base = (void *)(CONFIG_SYS_MPC85xx_DMA_ADDR);
|
|
|
|
|
|
+ccsr_dma_t *dma_base = (void *)(CONFIG_SYS_MPC85xx_DMA_ADDR);
|
|
#elif defined(CONFIG_MPC86xx)
|
|
#elif defined(CONFIG_MPC86xx)
|
|
-volatile ccsr_dma_t *dma_base = (void *)(CONFIG_SYS_MPC86xx_DMA_ADDR);
|
|
|
|
|
|
+ccsr_dma_t *dma_base = (void *)(CONFIG_SYS_MPC86xx_DMA_ADDR);
|
|
#else
|
|
#else
|
|
#error "Freescale DMA engine not supported on your processor"
|
|
#error "Freescale DMA engine not supported on your processor"
|
|
#endif
|
|
#endif
|
|
@@ -48,14 +49,15 @@ static void dma_sync(void)
|
|
|
|
|
|
static uint dma_check(void) {
|
|
static uint dma_check(void) {
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
- volatile uint status = dma->sr;
|
|
|
|
|
|
+ uint status;
|
|
|
|
|
|
/* While the channel is busy, spin */
|
|
/* While the channel is busy, spin */
|
|
- while (status & FSL_DMA_SR_CB)
|
|
|
|
- status = dma->sr;
|
|
|
|
|
|
+ do {
|
|
|
|
+ status = in_be32(&dma->sr);
|
|
|
|
+ } while (status & FSL_DMA_SR_CB);
|
|
|
|
|
|
/* clear MR[CS] channel start bit */
|
|
/* clear MR[CS] channel start bit */
|
|
- dma->mr &= FSL_DMA_MR_CS;
|
|
|
|
|
|
+ out_be32(&dma->mr, in_be32(&dma->mr) & FSL_DMA_MR_CS);
|
|
dma_sync();
|
|
dma_sync();
|
|
|
|
|
|
if (status != 0)
|
|
if (status != 0)
|
|
@@ -67,25 +69,27 @@ static uint dma_check(void) {
|
|
void dma_init(void) {
|
|
void dma_init(void) {
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
|
|
|
|
- dma->satr = FSL_DMA_SATR_SREAD_NO_SNOOP;
|
|
|
|
- dma->datr = FSL_DMA_DATR_DWRITE_NO_SNOOP;
|
|
|
|
- dma->sr = 0xffffffff; /* clear any errors */
|
|
|
|
|
|
+ out_be32(&dma->satr, FSL_DMA_SATR_SREAD_NO_SNOOP);
|
|
|
|
+ out_be32(&dma->datr, FSL_DMA_DATR_DWRITE_NO_SNOOP);
|
|
|
|
+ out_be32(&dma->sr, 0xffffffff); /* clear any errors */
|
|
dma_sync();
|
|
dma_sync();
|
|
}
|
|
}
|
|
|
|
|
|
int dma_xfer(void *dest, uint count, void *src) {
|
|
int dma_xfer(void *dest, uint count, void *src) {
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
volatile fsl_dma_t *dma = &dma_base->dma[0];
|
|
|
|
|
|
- dma->dar = (uint) dest;
|
|
|
|
- dma->sar = (uint) src;
|
|
|
|
- dma->bcr = count;
|
|
|
|
|
|
+ out_be32(&dma->dar, (uint) dest);
|
|
|
|
+ out_be32(&dma->sar, (uint) src);
|
|
|
|
+ out_be32(&dma->bcr, count);
|
|
|
|
|
|
/* Disable bandwidth control, use direct transfer mode */
|
|
/* Disable bandwidth control, use direct transfer mode */
|
|
- dma->mr = FSL_DMA_MR_BWC_DIS | FSL_DMA_MR_CTM_DIRECT;
|
|
|
|
|
|
+ out_be32(&dma->mr, FSL_DMA_MR_BWC_DIS | FSL_DMA_MR_CTM_DIRECT);
|
|
dma_sync();
|
|
dma_sync();
|
|
|
|
|
|
/* Start the transfer */
|
|
/* Start the transfer */
|
|
- dma->mr = FSL_DMA_MR_BWC_DIS | FSL_DMA_MR_CTM_DIRECT | FSL_DMA_MR_CS;
|
|
|
|
|
|
+ out_be32(&dma->mr, FSL_DMA_MR_BWC_DIS |
|
|
|
|
+ FSL_DMA_MR_CTM_DIRECT |
|
|
|
|
+ FSL_DMA_MR_CS);
|
|
dma_sync();
|
|
dma_sync();
|
|
|
|
|
|
return dma_check();
|
|
return dma_check();
|