ASoC: qcom: remove hardcoded dma channel

This patch removes hardcoded dma channel value in lpass driver, Now the
dma channel allocation happens in the SOC specific layer. This will
allow different LPASS integrations to use the lpass driver in more
generic way.

Signed-off-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Tested-by: Kenneth Westfield <kwestfie@codeaurora.org>
Acked-by: Kenneth Westfield <kwestfie@codeaurora.org>
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/qcom/lpass-ipq806x.c b/sound/soc/qcom/lpass-ipq806x.c
index cc5f3b4857eb8dc7323fcfa5c0bb42fa977e8505..2eab828644e86a197cfb9c98791945375b966edc 100644 (file)
--- a/sound/soc/qcom/lpass-ipq806x.c
+++ b/sound/soc/qcom/lpass-ipq806x.c
@@ -63,6 +63,16 @@ static struct snd_soc_dai_driver ipq806x_lpass_cpu_dai_driver = {
        .ops    = &asoc_qcom_lpass_cpu_dai_ops,
 };
 
+int ipq806x_lpass_alloc_dma_channel(struct lpass_data *drvdata)
+{
+       return IPQ806X_LPAIF_RDMA_CHAN_MI2S;
+}
+
+int ipq806x_lpass_free_dma_channel(struct lpass_data *drvdata, int chan)
+{
+       return 0;
+}
+
 struct lpass_variant ipq806x_data = {
        .i2sctrl_reg_base       = 0x0010,
        .i2sctrl_reg_stride     = 0x04,
@@ -75,6 +85,8 @@ struct lpass_variant ipq806x_data = {
        .rdma_channels          = 4,
        .dai_driver             = &ipq806x_lpass_cpu_dai_driver,
        .num_dai                = 1,
+       .alloc_dma_channel      = ipq806x_lpass_alloc_dma_channel,
+       .free_dma_channel       = ipq806x_lpass_free_dma_channel,
 };
 
 static const struct of_device_id ipq806x_lpass_cpu_device_id[] = {

diff --git a/sound/soc/qcom/lpass-platform.c b/sound/soc/qcom/lpass-platform.c
index a38e7ecf244fd5fcf732472ae3c042c3351a41c4..fc0889196e7ae3c54165465a340cbdd816ee0630 100644 (file)
--- a/sound/soc/qcom/lpass-platform.c
+++ b/sound/soc/qcom/lpass-platform.c
@@ -24,6 +24,11 @@
 #include "lpass-lpaif-reg.h"
 #include "lpass.h"
 
+struct lpass_pcm_data {
+       int rdma_ch;
+       int i2s_port;
+};
+
 #define LPASS_PLATFORM_BUFFER_SIZE     (16 * 1024)
 #define LPASS_PLATFORM_PERIODS         2
 
@@ -78,6 +83,7 @@ static int lpass_platform_pcmops_hw_params(struct snd_pcm_substream *substream,
                struct snd_pcm_hw_params *params)
 {
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
@@ -85,7 +91,7 @@ static int lpass_platform_pcmops_hw_params(struct snd_pcm_substream *substream,
        unsigned int channels = params_channels(params);
        unsigned int regval;
        int bitwidth;
-       int ret;
+       int ret, rdma_port = pcm_data->i2s_port;
 
        bitwidth = snd_pcm_format_width(format);
        if (bitwidth < 0) {
@@ -95,7 +101,7 @@ static int lpass_platform_pcmops_hw_params(struct snd_pcm_substream *substream,
        }
 
        regval = LPAIF_RDMACTL_BURSTEN_INCR4 |
-                       LPAIF_RDMACTL_AUDINTF_MI2S |
+                       LPAIF_RDMACTL_AUDINTF(rdma_port) |
                        LPAIF_RDMACTL_FIFOWM_8;
 
        switch (bitwidth) {
@@ -151,7 +157,7 @@ static int lpass_platform_pcmops_hw_params(struct snd_pcm_substream *substream,
        }
 
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S), regval);
+                       LPAIF_RDMACTL_REG(v, pcm_data->rdma_ch), regval);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmactl reg: %d\n",
                                __func__, ret);
@@ -164,13 +170,14 @@ static int lpass_platform_pcmops_hw_params(struct snd_pcm_substream *substream,
 static int lpass_platform_pcmops_hw_free(struct snd_pcm_substream *substream)
 {
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
        int ret;
 
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S), 0);
+                       LPAIF_RDMACTL_REG(v, pcm_data->rdma_ch), 0);
        if (ret)
                dev_err(soc_runtime->dev, "%s() error writing to rdmactl reg: %d\n",
                                __func__, ret);
@@ -182,13 +189,14 @@ static int lpass_platform_pcmops_prepare(struct snd_pcm_substream *substream)
 {
        struct snd_pcm_runtime *runtime = substream->runtime;
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
-       int ret;
+       int ret, ch = pcm_data->rdma_ch;
 
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMABASE_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                       LPAIF_RDMABASE_REG(v, ch),
                        runtime->dma_addr);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmabase reg: %d\n",
@@ -197,7 +205,7 @@ static int lpass_platform_pcmops_prepare(struct snd_pcm_substream *substream)
        }
 
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMABUFF_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                       LPAIF_RDMABUFF_REG(v, ch),
                        (snd_pcm_lib_buffer_bytes(substream) >> 2) - 1);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmabuff reg: %d\n",
@@ -206,7 +214,7 @@ static int lpass_platform_pcmops_prepare(struct snd_pcm_substream *substream)
        }
 
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMAPER_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                       LPAIF_RDMAPER_REG(v, ch),
                        (snd_pcm_lib_period_bytes(substream) >> 2) - 1);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmaper reg: %d\n",
@@ -215,7 +223,7 @@ static int lpass_platform_pcmops_prepare(struct snd_pcm_substream *substream)
        }
 
        ret = regmap_update_bits(drvdata->lpaif_map,
-                       LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                       LPAIF_RDMACTL_REG(v, ch),
                        LPAIF_RDMACTL_ENABLE_MASK, LPAIF_RDMACTL_ENABLE_ON);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmactl reg: %d\n",
@@ -230,10 +238,11 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
                int cmd)
 {
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
-       int ret;
+       int ret, ch = pcm_data->rdma_ch;
 
        switch (cmd) {
        case SNDRV_PCM_TRIGGER_START:
@@ -242,7 +251,7 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
                /* clear status before enabling interrupts */
                ret = regmap_write(drvdata->lpaif_map,
                                LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_ALL(LPAIF_RDMA_CHAN_MI2S));
+                               LPAIF_IRQ_ALL(ch));
                if (ret) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqclear reg: %d\n",
                                        __func__, ret);
@@ -251,8 +260,8 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
 
                ret = regmap_update_bits(drvdata->lpaif_map,
                                LPAIF_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_ALL(LPAIF_RDMA_CHAN_MI2S),
-                               LPAIF_IRQ_ALL(LPAIF_RDMA_CHAN_MI2S));
+                               LPAIF_IRQ_ALL(ch),
+                               LPAIF_IRQ_ALL(ch));
                if (ret) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqen reg: %d\n",
                                        __func__, ret);
@@ -260,7 +269,7 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
                }
 
                ret = regmap_update_bits(drvdata->lpaif_map,
-                               LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                               LPAIF_RDMACTL_REG(v, ch),
                                LPAIF_RDMACTL_ENABLE_MASK,
                                LPAIF_RDMACTL_ENABLE_ON);
                if (ret) {
@@ -273,7 +282,7 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
        case SNDRV_PCM_TRIGGER_SUSPEND:
        case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
                ret = regmap_update_bits(drvdata->lpaif_map,
-                               LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S),
+                               LPAIF_RDMACTL_REG(v, ch),
                                LPAIF_RDMACTL_ENABLE_MASK,
                                LPAIF_RDMACTL_ENABLE_OFF);
                if (ret) {
@@ -284,7 +293,7 @@ static int lpass_platform_pcmops_trigger(struct snd_pcm_substream *substream,
 
                ret = regmap_update_bits(drvdata->lpaif_map,
                                LPAIF_IRQEN_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_ALL(LPAIF_RDMA_CHAN_MI2S), 0);
+                               LPAIF_IRQ_ALL(ch), 0);
                if (ret) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqen reg: %d\n",
                                        __func__, ret);
@@ -300,15 +309,15 @@ static snd_pcm_uframes_t lpass_platform_pcmops_pointer(
                struct snd_pcm_substream *substream)
 {
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        struct lpass_data *drvdata =
                        snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
        unsigned int base_addr, curr_addr;
-       int ret;
+       int ret, ch = pcm_data->rdma_ch;
 
        ret = regmap_read(drvdata->lpaif_map,
-                        LPAIF_RDMABASE_REG(v, LPAIF_RDMA_CHAN_MI2S),
-                        &base_addr);
+                       LPAIF_RDMABASE_REG(v, ch), &base_addr);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error reading from rdmabase reg: %d\n",
                                __func__, ret);
@@ -316,8 +325,7 @@ static snd_pcm_uframes_t lpass_platform_pcmops_pointer(
        }
 
        ret = regmap_read(drvdata->lpaif_map,
-                        LPAIF_RDMACURR_REG(v, LPAIF_RDMA_CHAN_MI2S),
-                        &curr_addr);
+                       LPAIF_RDMACURR_REG(v, ch), &curr_addr);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error reading from rdmacurr reg: %d\n",
                                __func__, ret);
@@ -355,9 +363,10 @@ static irqreturn_t lpass_platform_lpaif_irq(int irq, void *data)
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
+       struct lpass_pcm_data *pcm_data = snd_soc_pcm_get_drvdata(soc_runtime);
        unsigned int interrupts;
        irqreturn_t ret = IRQ_NONE;
-       int rv;
+       int rv, chan = pcm_data->rdma_ch;
 
        rv = regmap_read(drvdata->lpaif_map,
                        LPAIF_IRQSTAT_REG(v, LPAIF_IRQ_PORT_HOST), &interrupts);
@@ -366,12 +375,13 @@ static irqreturn_t lpass_platform_lpaif_irq(int irq, void *data)
                                __func__, rv);
                return IRQ_NONE;
        }
-       interrupts &= LPAIF_IRQ_ALL(LPAIF_RDMA_CHAN_MI2S);
 
-       if (interrupts & LPAIF_IRQ_PER(LPAIF_RDMA_CHAN_MI2S)) {
+       interrupts &= LPAIF_IRQ_ALL(chan);
+
+       if (interrupts & LPAIF_IRQ_PER(chan)) {
                rv = regmap_write(drvdata->lpaif_map,
                                LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_PER(LPAIF_RDMA_CHAN_MI2S));
+                               LPAIF_IRQ_PER(chan));
                if (rv) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqclear reg: %d\n",
                                        __func__, rv);
@@ -381,10 +391,10 @@ static irqreturn_t lpass_platform_lpaif_irq(int irq, void *data)
                ret = IRQ_HANDLED;
        }
 
-       if (interrupts & LPAIF_IRQ_XRUN(LPAIF_RDMA_CHAN_MI2S)) {
+       if (interrupts & LPAIF_IRQ_XRUN(chan)) {
                rv = regmap_write(drvdata->lpaif_map,
                                LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_XRUN(LPAIF_RDMA_CHAN_MI2S));
+                               LPAIF_IRQ_XRUN(chan));
                if (rv) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqclear reg: %d\n",
                                        __func__, rv);
@@ -395,10 +405,10 @@ static irqreturn_t lpass_platform_lpaif_irq(int irq, void *data)
                ret = IRQ_HANDLED;
        }
 
-       if (interrupts & LPAIF_IRQ_ERR(LPAIF_RDMA_CHAN_MI2S)) {
+       if (interrupts & LPAIF_IRQ_ERR(chan)) {
                rv = regmap_write(drvdata->lpaif_map,
                                LPAIF_IRQCLEAR_REG(v, LPAIF_IRQ_PORT_HOST),
-                               LPAIF_IRQ_ERR(LPAIF_RDMA_CHAN_MI2S));
+                               LPAIF_IRQ_ERR(chan));
                if (rv) {
                        dev_err(soc_runtime->dev, "%s() error writing to irqclear reg: %d\n",
                                        __func__, rv);
@@ -450,10 +460,26 @@ static int lpass_platform_pcm_new(struct snd_soc_pcm_runtime *soc_runtime)
        struct snd_pcm *pcm = soc_runtime->pcm;
        struct snd_pcm_substream *substream =
                pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream;
+       struct snd_soc_dai *cpu_dai = soc_runtime->cpu_dai;
        struct lpass_data *drvdata =
                snd_soc_platform_get_drvdata(soc_runtime->platform);
        struct lpass_variant *v = drvdata->variant;
        int ret;
+       struct lpass_pcm_data *data;
+
+       data = devm_kzalloc(soc_runtime->dev, sizeof(*data), GFP_KERNEL);
+       if (!data)
+               return -ENOMEM;
+
+       if (v->alloc_dma_channel)
+               data->rdma_ch = v->alloc_dma_channel(drvdata);
+
+       if (IS_ERR_VALUE(data->rdma_ch))
+               return data->rdma_ch;
+
+       data->i2s_port = cpu_dai->driver->id;
+
+       snd_soc_pcm_set_drvdata(soc_runtime, data);
 
        soc_runtime->dev->coherent_dma_mask = DMA_BIT_MASK(32);
        soc_runtime->dev->dma_mask = &soc_runtime->dev->coherent_dma_mask;
@@ -480,7 +506,7 @@ static int lpass_platform_pcm_new(struct snd_soc_pcm_runtime *soc_runtime)
                return ret;
        }
        ret = regmap_write(drvdata->lpaif_map,
-                       LPAIF_RDMACTL_REG(v, LPAIF_RDMA_CHAN_MI2S), 0);
+                       LPAIF_RDMACTL_REG(v, data->rdma_ch), 0);
        if (ret) {
                dev_err(soc_runtime->dev, "%s() error writing to rdmactl reg: %d\n",
                                __func__, ret);
@@ -499,6 +525,13 @@ static void lpass_platform_pcm_free(struct snd_pcm *pcm)
        struct snd_pcm_substream *substream =
                pcm->streams[SNDRV_PCM_STREAM_PLAYBACK].substream;
        struct snd_soc_pcm_runtime *soc_runtime = substream->private_data;
+       struct lpass_data *drvdata =
+               snd_soc_platform_get_drvdata(soc_runtime->platform);
+       struct lpass_pcm_data *data = snd_soc_pcm_get_drvdata(soc_runtime);
+       struct lpass_variant *v = drvdata->variant;
+
+       if (v->free_dma_channel)
+               v->free_dma_channel(drvdata, data->rdma_ch);
 
        lpass_platform_free_buffer(substream, soc_runtime);
 }

diff --git a/sound/soc/qcom/lpass.h b/sound/soc/qcom/lpass.h
index fa00be43e923596ed71bd5b3dde90e2e0c186a8b..caaf17fb0015d23936739232a34f51f711f8812b 100644 (file)
--- a/sound/soc/qcom/lpass.h
+++ b/sound/soc/qcom/lpass.h
@@ -63,6 +63,8 @@ struct lpass_variant {
        /* SOC specific intialization like clocks */
        int (*init)(struct platform_device *pdev);
        int (*exit)(struct platform_device *pdev);
+       int (*alloc_dma_channel)(struct lpass_data *data);
+       int (*free_dma_channel)(struct lpass_data *data, int ch);
 
        /* SOC specific dais */
        struct snd_soc_dai_driver *dai_driver;