From mboxrd@z Thu Jan 1 00:00:00 1970 From: =?UTF-8?q?Emilio=20L=C3=B3pez?= Subject: [PATCH 4/9] spi: sun4i: add DMA support Date: 20 Aug 2015 14:19:46 -0000 Message-ID: References: Reply-To: emilio-0Z03zUJReD5OxF6Tv1QG9Q@public.gmane.org Mime-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: quoted-printable To: linux-sunxi-/JYPxA39Uh5TLH3MbocFFw@public.gmane.org, Rob Herring , Pawel Moll , Mark Rutland , Ian Campbell , Kumar Gala , Russell King , Maxime Ripard , Mark Brown , devicetree-u79uwXL29TY76Z2rM5mHXA@public.gmane.org, linux-arm-kernel-IAPFreCvJWM7uuMidbF8XUB+6BGkLq7r@public.gmane.org, linux-kernel-u79uwXL29TY76Z2rM5mHXA@public.gmane.org, linux-spi-u79uwXL29TY76Z2rM5mHXA@public.gmane.org, Return-path: In-Reply-To: List-Post: , List-Help: , List-Archive: , List-Unsubscribe: , List-Id: linux-spi.vger.kernel.org From: Emilio L=C3=B3pez This patch adds support for 64 byte or bigger transfers on the sun4i SPI controller. Said transfers will be performed via DMA. Signed-off-by: Emilio L=C3=B3pez Tested-by: Michal Suchanek --- drivers/spi/spi-sun4i.c | 145 +++++++++++++++++++++++++++++++++++++++++++-= ---- 1 file changed, 130 insertions(+), 15 deletions(-) diff --git a/drivers/spi/spi-sun4i.c b/drivers/spi/spi-sun4i.c index 4dda366..63242a7 100644 --- a/drivers/spi/spi-sun4i.c +++ b/drivers/spi/spi-sun4i.c @@ -14,6 +14,8 @@ #include #include #include +#include +#include #include #include #include @@ -34,6 +36,7 @@ #define SUN4I_CTL_CPHA BIT(2) #define SUN4I_CTL_CPOL BIT(3) #define SUN4I_CTL_CS_ACTIVE_LOW BIT(4) +#define SUN4I_CTL_DMAMC_DEDICATED BIT(5) #define SUN4I_CTL_LMTF BIT(6) #define SUN4I_CTL_TF_RST BIT(8) #define SUN4I_CTL_RF_RST BIT(9) @@ -51,6 +54,8 @@ #define SUN4I_INT_STA_REG 0x10 =20 #define SUN4I_DMA_CTL_REG 0x14 +#define SUN4I_DMA_CTL_RF_READY BIT(0) +#define SUN4I_DMA_CTL_TF_NOT_FULL BIT(10) =20 #define SUN4I_WAIT_REG 0x18 =20 @@ -130,6 +135,13 @@ static inline void sun4i_spi_fill_fifo(struct sun4i_sp= i *sspi, int len) } } =20 +static bool sun4i_spi_can_dma(struct spi_master *master, + struct spi_device *spi, + struct spi_transfer *tfr) +{ + return tfr->len >=3D SUN4I_FIFO_DEPTH; +} + static void sun4i_spi_set_cs(struct spi_device *spi, bool enable) { struct sun4i_spi *sspi =3D spi_master_get_devdata(spi->master); @@ -169,17 +181,12 @@ static int sun4i_spi_transfer_one(struct spi_master *= master, struct spi_transfer *tfr) { struct sun4i_spi *sspi =3D spi_master_get_devdata(master); + struct dma_async_tx_descriptor *desc_tx =3D NULL, *desc_rx =3D NULL; unsigned int speed, mclk_rate, div, timeout; unsigned int start, end, tx_time; unsigned int tx_len =3D 0; + u32 reg, trigger =3D 0; int ret =3D 0; - u32 reg; - - /* We don't support transfer larger than the FIFO */ - if (tfr->len > SUN4I_FIFO_DEPTH) - return -EINVAL; - if (tfr->tx_buf && tfr->len =3D> SUN4I_FIFO_DEPTH) - return -EINVAL; =20 reinit_completion(&sspi->done); sspi->tx_buf =3D tfr->tx_buf; @@ -277,14 +284,67 @@ static int sun4i_spi_transfer_one(struct spi_master *= master, sun4i_spi_write(sspi, SUN4I_BURST_CNT_REG, SUN4I_BURST_CNT(tfr->len)); sun4i_spi_write(sspi, SUN4I_XMIT_CNT_REG, SUN4I_XMIT_CNT(tx_len)); =20 - /* Fill the TX FIFO */ - /* Filling the fifo fully causes timeout for some reason - * at least on spi2 on a10s */ - sun4i_spi_fill_fifo(sspi, SUN4I_FIFO_DEPTH - 1); - /* Enable the interrupts */ sun4i_spi_write(sspi, SUN4I_INT_CTL_REG, SUN4I_INT_CTL_TC); =20 + if (sun4i_spi_can_dma(master, spi, tfr)) { + dev_dbg(&sspi->master->dev, "Using DMA mode for transfer\n"); + + if (sspi->tx_buf) { + desc_tx =3D dmaengine_prep_slave_sg(master->dma_tx, + tfr->tx_sg.sgl, tfr->tx_sg.nents, + DMA_TO_DEVICE, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!desc_tx) { + dev_err(&sspi->master->dev, + "Couldn't prepare dma slave\n"); + return -EIO; + } + + trigger |=3D SUN4I_DMA_CTL_TF_NOT_FULL; + + dmaengine_submit(desc_tx); + dma_async_issue_pending(master->dma_tx); + + } + + if (sspi->rx_buf) { + desc_rx =3D dmaengine_prep_slave_sg(master->dma_rx, + tfr->rx_sg.sgl, tfr->rx_sg.nents, + DMA_FROM_DEVICE, + DMA_PREP_INTERRUPT | DMA_CTRL_ACK); + if (!desc_rx) { + dev_err(&sspi->master->dev, + "Couldn't prepare dma slave\n"); + return -EIO; + } + + trigger |=3D SUN4I_DMA_CTL_RF_READY; + + dmaengine_submit(desc_rx); + dma_async_issue_pending(master->dma_rx); + } + + /* Enable Dedicated DMA requests */ + reg =3D sun4i_spi_read(sspi, SUN4I_CTL_REG); + reg |=3D SUN4I_CTL_DMAMC_DEDICATED; + sun4i_spi_write(sspi, SUN4I_CTL_REG, reg); + sun4i_spi_write(sspi, SUN4I_DMA_CTL_REG, trigger); + } else { + dev_dbg(&sspi->master->dev, "Using PIO mode for transfer\n"); + + /* Disable DMA requests */ + reg =3D sun4i_spi_read(sspi, SUN4I_CTL_REG); + sun4i_spi_write(sspi, SUN4I_CTL_REG, + reg & ~SUN4I_CTL_DMAMC_DEDICATED); + sun4i_spi_write(sspi, SUN4I_DMA_CTL_REG, 0); + + /* Fill the TX FIFO */ + /* Filling the fifo fully causes timeout for some reason + * at least on spi2 on a10s */ + sun4i_spi_fill_fifo(sspi, SUN4I_FIFO_DEPTH - 1); + } + /* Start the transfer */ reg =3D sun4i_spi_read(sspi, SUN4I_CTL_REG); sun4i_spi_write(sspi, SUN4I_CTL_REG, reg | SUN4I_CTL_XCH); @@ -303,7 +363,12 @@ static int sun4i_spi_transfer_one(struct spi_master *m= aster, goto out; } =20 - sun4i_spi_drain_fifo(sspi, SUN4I_FIFO_DEPTH); + if (sun4i_spi_can_dma(master, spi, tfr) && desc_rx) { + /* The receive transfer should be the last one to finish */ + dma_wait_for_async_tx(desc_rx); + } else { + sun4i_spi_drain_fifo(sspi, SUN4I_FIFO_DEPTH); + } =20 out: sun4i_spi_write(sspi, SUN4I_INT_CTL_REG, 0); @@ -368,6 +433,7 @@ static int sun4i_spi_runtime_suspend(struct device *dev= ) =20 static int sun4i_spi_probe(struct platform_device *pdev) { + struct dma_slave_config dma_sconfig; struct spi_master *master; struct sun4i_spi *sspi; struct resource *res; @@ -403,7 +469,9 @@ static int sun4i_spi_probe(struct platform_device *pdev= ) goto err_free_master; } =20 + init_completion(&sspi->done); sspi->master =3D master; + master->can_dma =3D sun4i_spi_can_dma; master->set_cs =3D sun4i_spi_set_cs; master->transfer_one =3D sun4i_spi_transfer_one; master->num_chipselect =3D 4; @@ -426,7 +494,45 @@ static int sun4i_spi_probe(struct platform_device *pde= v) goto err_free_master; } =20 - init_completion(&sspi->done); + master->dma_tx =3D dma_request_slave_channel_reason(&pdev->dev, "tx"); + if (IS_ERR(master->dma_tx)) { + dev_err(&pdev->dev, "Unable to acquire DMA channel TX\n"); + ret =3D PTR_ERR(master->dma_tx); + goto err_free_master; + } + + dma_sconfig.direction =3D DMA_MEM_TO_DEV; + dma_sconfig.src_addr_width =3D DMA_SLAVE_BUSWIDTH_1_BYTE; + dma_sconfig.dst_addr_width =3D DMA_SLAVE_BUSWIDTH_1_BYTE; + dma_sconfig.dst_addr =3D res->start + SUN4I_TXDATA_REG; + dma_sconfig.src_maxburst =3D 1; + dma_sconfig.dst_maxburst =3D 1; + + ret =3D dmaengine_slave_config(master->dma_tx, &dma_sconfig); + if (ret) { + dev_err(&pdev->dev, "Unable to configure TX DMA slave\n"); + goto err_tx_dma_release; + } + + master->dma_rx =3D dma_request_slave_channel_reason(&pdev->dev, "rx"); + if (IS_ERR(master->dma_rx)) { + dev_err(&pdev->dev, "Unable to acquire DMA channel RX\n"); + ret =3D PTR_ERR(master->dma_rx); + goto err_tx_dma_release; + } + + dma_sconfig.direction =3D DMA_DEV_TO_MEM; + dma_sconfig.src_addr_width =3D DMA_SLAVE_BUSWIDTH_1_BYTE; + dma_sconfig.dst_addr_width =3D DMA_SLAVE_BUSWIDTH_1_BYTE; + dma_sconfig.src_addr =3D res->start + SUN4I_RXDATA_REG; + dma_sconfig.src_maxburst =3D 1; + dma_sconfig.dst_maxburst =3D 1; + + ret =3D dmaengine_slave_config(master->dma_rx, &dma_sconfig); + if (ret) { + dev_err(&pdev->dev, "Unable to configure RX DMA slave\n"); + goto err_rx_dma_release; + } =20 /* * This wake-up/shutdown pattern is to be able to have the @@ -435,7 +541,7 @@ static int sun4i_spi_probe(struct platform_device *pdev= ) ret =3D sun4i_spi_runtime_resume(&pdev->dev); if (ret) { dev_err(&pdev->dev, "Couldn't resume the device\n"); - goto err_free_master; + goto err_rx_dma_release; } =20 pm_runtime_set_active(&pdev->dev); @@ -453,6 +559,10 @@ static int sun4i_spi_probe(struct platform_device *pde= v) err_pm_disable: pm_runtime_disable(&pdev->dev); sun4i_spi_runtime_suspend(&pdev->dev); +err_rx_dma_release: + dma_release_channel(master->dma_rx); +err_tx_dma_release: + dma_release_channel(master->dma_tx); err_free_master: spi_master_put(master); return ret; @@ -460,8 +570,13 @@ err_free_master: =20 static int sun4i_spi_remove(struct platform_device *pdev) { + struct spi_master *master =3D platform_get_drvdata(pdev); + pm_runtime_disable(&pdev->dev); =20 + dma_release_channel(master->dma_rx); + dma_release_channel(master->dma_tx); + return 0; } =20 --=20 2.1.4 --=20 You received this message because you are subscribed to the Google Groups "= linux-sunxi" group. To unsubscribe from this group and stop receiving emails from it, send an e= mail to linux-sunxi+unsubscribe-/JYPxA39Uh5TLH3MbocFF+G/Ez6ZCGd0@public.gmane.org For more options, visit https://groups.google.com/d/optout.