On 02-06-22, 17:53, Shengjiu Wang wrote:
subsystem tag should be dmaengine
> The peripheral may have several FIFOs, but some case just select
> some FIFOs from them for data transfer, which means FIFO0 and FIFO2
> may be selected. So add FIFO address offset support, 0 means all FIFOs
> are continuous, 1 means 1 word offset between FIFOs. All offset between
> FIFOs should be same.
>
> Another option words_per_fifo means how many audio channel data copied
> to one FIFO one time, 0 means one channel per FIFO, 1 means 2 channels
> per FIFO.
>
> If 'n_fifos_src = 4' and 'words_per_fifo = 1', it means the first two
> words(channels) fetch from FIFO0 and then jump to FIFO1 for next two words,
> and so on after the last FIFO3 fetched, roll back to FIFO0.
>
> Signed-off-by: Joy Zou <joy.zou@xxxxxxx>
> Signed-off-by: Shengjiu Wang <shengjiu.wang@xxxxxxx>
> ---
> drivers/dma/imx-sdma.c | 26 ++++++++++++++++++++++++--
> include/linux/dma/imx-dma.h | 13 +++++++++++++
> 2 files changed, 37 insertions(+), 2 deletions(-)
>
> diff --git a/drivers/dma/imx-sdma.c b/drivers/dma/imx-sdma.c
> index 111beb7138e0..3c95719286bc 100644
> --- a/drivers/dma/imx-sdma.c
> +++ b/drivers/dma/imx-sdma.c
> @@ -183,6 +183,8 @@
> BIT(DMA_DEV_TO_DEV))
>
> #define SDMA_WATERMARK_LEVEL_N_FIFOS GENMASK(15, 12)
> +#define SDMA_WATERMARK_LEVEL_OFF_FIFOS GENMASK(19, 16)
> +#define SDMA_WATERMARK_LEVEL_WORDS_PER_FIFO GENMASK(31, 28)
> #define SDMA_WATERMARK_LEVEL_SW_DONE BIT(23)
>
> #define SDMA_DONE0_CONFIG_DONE_SEL BIT(7)
> @@ -429,6 +431,9 @@ struct sdma_desc {
> * @n_fifos_src: number of source device fifos
> * @n_fifos_dst: number of destination device fifos
> * @sw_done: software done flag
> + * @off_fifos_src: offset for source device FIFOs
> + * @off_fifos_dst: offset for destination device FIFOs
Will both of these be used together...?
> + * @words_per_fifo: copy number of words one time for one FIFO
> */
> struct sdma_channel {
> struct virt_dma_chan vc;
> @@ -456,6 +461,9 @@ struct sdma_channel {
> bool is_ram_script;
> unsigned int n_fifos_src;
> unsigned int n_fifos_dst;
> + unsigned int off_fifos_src;
> + unsigned int off_fifos_dst;
> + unsigned int words_per_fifo;
> bool sw_done;
> };
>
> @@ -1245,17 +1253,28 @@ static void sdma_set_watermarklevel_for_p2p(struct sdma_channel *sdmac)
> static void sdma_set_watermarklevel_for_sais(struct sdma_channel *sdmac)
> {
> unsigned int n_fifos;
> + unsigned int off_fifos;
> + unsigned int words_per_fifo;
>
> if (sdmac->sw_done)
> sdmac->watermark_level |= SDMA_WATERMARK_LEVEL_SW_DONE;
>
> - if (sdmac->direction == DMA_DEV_TO_MEM)
> + if (sdmac->direction == DMA_DEV_TO_MEM) {
> n_fifos = sdmac->n_fifos_src;
> - else
> + off_fifos = sdmac->off_fifos_src;
> + } else {
> n_fifos = sdmac->n_fifos_dst;
> + off_fifos = sdmac->off_fifos_dst;
> + }
> +
> + words_per_fifo = sdmac->words_per_fifo;
>
> sdmac->watermark_level |=
> FIELD_PREP(SDMA_WATERMARK_LEVEL_N_FIFOS, n_fifos);
> + sdmac->watermark_level |=
> + FIELD_PREP(SDMA_WATERMARK_LEVEL_OFF_FIFOS, off_fifos);
> + sdmac->watermark_level |=
> + FIELD_PREP(SDMA_WATERMARK_LEVEL_WORDS_PER_FIFO, (words_per_fifo - 1));
> }
>
> static int sdma_config_channel(struct dma_chan *chan)
> @@ -1769,6 +1788,9 @@ static int sdma_config(struct dma_chan *chan,
> }
> sdmac->n_fifos_src = sdmacfg->n_fifos_src;
> sdmac->n_fifos_dst = sdmacfg->n_fifos_dst;
> + sdmac->off_fifos_src = sdmacfg->off_fifos_src;
> + sdmac->off_fifos_dst = sdmacfg->off_fifos_dst;
> + sdmac->words_per_fifo = sdmacfg->words_per_fifo;
> sdmac->sw_done = sdmacfg->sw_done;
> }
>
> diff --git a/include/linux/dma/imx-dma.h b/include/linux/dma/imx-dma.h
> index 8887762360d4..0c739d571956 100644
> --- a/include/linux/dma/imx-dma.h
> +++ b/include/linux/dma/imx-dma.h
> @@ -70,6 +70,16 @@ static inline int imx_dma_is_general_purpose(struct dma_chan *chan)
> * struct sdma_peripheral_config - SDMA config for audio
> * @n_fifos_src: Number of FIFOs for recording
> * @n_fifos_dst: Number of FIFOs for playback
> + * @off_fifos_src: FIFO address offset for recording, 0 means all FIFOs are
> + * continuous, 1 means 1 word offset between FIFOs. All offset
> + * between FIFOs should be same.
> + * @off_fifos_dst: FIFO address offset for playback
> + * @words_per_fifo: numbers of words per FIFO fetch/fill, 0 means
> + * one channel per FIFO, 1 means 2 channels per FIFO..
> + * If 'n_fifos_src = 4' and 'words_per_fifo = 1', it
> + * means the first two words(channels) fetch from FIFO0
> + * and then jump to FIFO1 for next two words, and so on
> + * after the last FIFO3 fetched, roll back to FIFO0.
> * @sw_done: Use software done. Needed for PDM (micfil)
> *
> * Some i.MX Audio devices (SAI, micfil) have multiple successive FIFO
> @@ -82,6 +92,9 @@ static inline int imx_dma_is_general_purpose(struct dma_chan *chan)
> struct sdma_peripheral_config {
> int n_fifos_src;
> int n_fifos_dst;
> + int off_fifos_src;
> + int off_fifos_dst;
> + int words_per_fifo;
> bool sw_done;
> };
>
> --
> 2.17.1
--
~Vinod
