Commit 1f9cd915 authored by Maxime Ripard's avatar Maxime Ripard Committed by Vinod Koul

dmaengine: sun6i: Fix memcpy operation

The prep_memcpy call was not setting any meaningful burst and width because it
was relying on the dma_slave_config was not set already.

Rework the needed conversion functions, and hardcode the width and burst to
use.
Signed-off-by: default avatarMaxime Ripard <maxime.ripard@free-electrons.com>
Cc: stable@vger.kernel.org
Signed-off-by: default avatarVinod Koul <vinod.koul@intel.com>
parent 0df1f248
...@@ -230,30 +230,25 @@ static inline void sun6i_dma_dump_chan_regs(struct sun6i_dma_dev *sdev, ...@@ -230,30 +230,25 @@ static inline void sun6i_dma_dump_chan_regs(struct sun6i_dma_dev *sdev,
readl(pchan->base + DMA_CHAN_CUR_PARA)); readl(pchan->base + DMA_CHAN_CUR_PARA));
} }
static inline int convert_burst(u32 maxburst, u8 *burst) static inline s8 convert_burst(u32 maxburst)
{ {
switch (maxburst) { switch (maxburst) {
case 1: case 1:
*burst = 0; return 0;
break;
case 8: case 8:
*burst = 2; return 2;
break;
default: default:
return -EINVAL; return -EINVAL;
} }
return 0;
} }
static inline int convert_buswidth(enum dma_slave_buswidth addr_width, u8 *width) static inline s8 convert_buswidth(enum dma_slave_buswidth addr_width)
{ {
if ((addr_width < DMA_SLAVE_BUSWIDTH_1_BYTE) || if ((addr_width < DMA_SLAVE_BUSWIDTH_1_BYTE) ||
(addr_width > DMA_SLAVE_BUSWIDTH_4_BYTES)) (addr_width > DMA_SLAVE_BUSWIDTH_4_BYTES))
return -EINVAL; return -EINVAL;
*width = addr_width >> 1; return addr_width >> 1;
return 0;
} }
static void *sun6i_dma_lli_add(struct sun6i_dma_lli *prev, static void *sun6i_dma_lli_add(struct sun6i_dma_lli *prev,
...@@ -284,26 +279,25 @@ static inline int sun6i_dma_cfg_lli(struct sun6i_dma_lli *lli, ...@@ -284,26 +279,25 @@ static inline int sun6i_dma_cfg_lli(struct sun6i_dma_lli *lli,
struct dma_slave_config *config) struct dma_slave_config *config)
{ {
u8 src_width, dst_width, src_burst, dst_burst; u8 src_width, dst_width, src_burst, dst_burst;
int ret;
if (!config) if (!config)
return -EINVAL; return -EINVAL;
ret = convert_burst(config->src_maxburst, &src_burst); src_burst = convert_burst(config->src_maxburst);
if (ret) if (src_burst)
return ret; return src_burst;
ret = convert_burst(config->dst_maxburst, &dst_burst); dst_burst = convert_burst(config->dst_maxburst);
if (ret) if (dst_burst)
return ret; return dst_burst;
ret = convert_buswidth(config->src_addr_width, &src_width); src_width = convert_buswidth(config->src_addr_width);
if (ret) if (src_width)
return ret; return src_width;
ret = convert_buswidth(config->dst_addr_width, &dst_width); dst_width = convert_buswidth(config->dst_addr_width);
if (ret) if (dst_width)
return ret; return dst_width;
lli->cfg = DMA_CHAN_CFG_SRC_BURST(src_burst) | lli->cfg = DMA_CHAN_CFG_SRC_BURST(src_burst) |
DMA_CHAN_CFG_SRC_WIDTH(src_width) | DMA_CHAN_CFG_SRC_WIDTH(src_width) |
...@@ -542,11 +536,10 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy( ...@@ -542,11 +536,10 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy(
{ {
struct sun6i_dma_dev *sdev = to_sun6i_dma_dev(chan->device); struct sun6i_dma_dev *sdev = to_sun6i_dma_dev(chan->device);
struct sun6i_vchan *vchan = to_sun6i_vchan(chan); struct sun6i_vchan *vchan = to_sun6i_vchan(chan);
struct dma_slave_config *sconfig = &vchan->cfg;
struct sun6i_dma_lli *v_lli; struct sun6i_dma_lli *v_lli;
struct sun6i_desc *txd; struct sun6i_desc *txd;
dma_addr_t p_lli; dma_addr_t p_lli;
int ret; s8 burst, width;
dev_dbg(chan2dev(chan), dev_dbg(chan2dev(chan),
"%s; chan: %d, dest: %pad, src: %pad, len: %zu. flags: 0x%08lx\n", "%s; chan: %d, dest: %pad, src: %pad, len: %zu. flags: 0x%08lx\n",
...@@ -565,14 +558,21 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy( ...@@ -565,14 +558,21 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy(
goto err_txd_free; goto err_txd_free;
} }
ret = sun6i_dma_cfg_lli(v_lli, src, dest, len, sconfig); v_lli->src = src;
if (ret) v_lli->dst = dest;
goto err_dma_free; v_lli->len = len;
v_lli->para = NORMAL_WAIT;
burst = convert_burst(8);
width = convert_buswidth(DMA_SLAVE_BUSWIDTH_4_BYTES);
v_lli->cfg |= DMA_CHAN_CFG_SRC_DRQ(DRQ_SDRAM) | v_lli->cfg |= DMA_CHAN_CFG_SRC_DRQ(DRQ_SDRAM) |
DMA_CHAN_CFG_DST_DRQ(DRQ_SDRAM) | DMA_CHAN_CFG_DST_DRQ(DRQ_SDRAM) |
DMA_CHAN_CFG_DST_LINEAR_MODE | DMA_CHAN_CFG_DST_LINEAR_MODE |
DMA_CHAN_CFG_SRC_LINEAR_MODE; DMA_CHAN_CFG_SRC_LINEAR_MODE |
DMA_CHAN_CFG_SRC_BURST(burst) |
DMA_CHAN_CFG_SRC_WIDTH(width) |
DMA_CHAN_CFG_DST_BURST(burst) |
DMA_CHAN_CFG_DST_WIDTH(width);
sun6i_dma_lli_add(NULL, v_lli, p_lli, txd); sun6i_dma_lli_add(NULL, v_lli, p_lli, txd);
...@@ -580,8 +580,6 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy( ...@@ -580,8 +580,6 @@ static struct dma_async_tx_descriptor *sun6i_dma_prep_dma_memcpy(
return vchan_tx_prep(&vchan->vc, &txd->vd, flags); return vchan_tx_prep(&vchan->vc, &txd->vd, flags);
err_dma_free:
dma_pool_free(sdev->pool, v_lli, p_lli);
err_txd_free: err_txd_free:
kfree(txd); kfree(txd);
return NULL; return NULL;
...@@ -915,6 +913,7 @@ static int sun6i_dma_probe(struct platform_device *pdev) ...@@ -915,6 +913,7 @@ static int sun6i_dma_probe(struct platform_device *pdev)
sdc->slave.device_prep_dma_memcpy = sun6i_dma_prep_dma_memcpy; sdc->slave.device_prep_dma_memcpy = sun6i_dma_prep_dma_memcpy;
sdc->slave.device_control = sun6i_dma_control; sdc->slave.device_control = sun6i_dma_control;
sdc->slave.chancnt = NR_MAX_VCHANS; sdc->slave.chancnt = NR_MAX_VCHANS;
sdc->slave.copy_align = 4;
sdc->slave.dev = &pdev->dev; sdc->slave.dev = &pdev->dev;
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment