]> git.proxmox.com Git - mirror_ubuntu-kernels.git/commitdiff
ASoC: qcom: Add lpass CPU driver for codec dma control
authorSrinivasa Rao Mandadapu <quic_srivasam@quicinc.com>
Thu, 24 Feb 2022 15:33:46 +0000 (21:03 +0530)
committerMark Brown <broonie@kernel.org>
Thu, 24 Feb 2022 20:21:46 +0000 (20:21 +0000)
Add lpass cpu driver to support audio over codec dma for
ADSP bypass usecase.

Signed-off-by: Srinivasa Rao Mandadapu <quic_srivasam@quicinc.com>
Co-developed-by: Venkata Prasad Potturu <quic_potturu@quicinc.com>
Signed-off-by: Venkata Prasad Potturu <quic_potturu@quicinc.com>
Reviewed-by: Srinivas Kandagatla <srinivas.kandagatla@linaro.org>
Link: https://lore.kernel.org/r/1645716828-15305-8-git-send-email-quic_srivasam@quicinc.com
Signed-off-by: Mark Brown <broonie@kernel.org>
sound/soc/qcom/Kconfig
sound/soc/qcom/Makefile
sound/soc/qcom/lpass-cdc-dma.c [new file with mode: 0644]
sound/soc/qcom/lpass.h

index f09dc0fcff0b3d58f50ba202db704381c7949327..4ab3ead3472d628500c2270a049bf0191a50a2c5 100644 (file)
@@ -20,6 +20,10 @@ config SND_SOC_LPASS_PLATFORM
        tristate
        select REGMAP_MMIO
 
+config SND_SOC_LPASS_CDC_DMA
+       tristate
+       select REGMAP_MMIO
+
 config SND_SOC_LPASS_IPQ806X
        tristate
        select SND_SOC_LPASS_CPU
index 625aec63b4eee09c59cd07b3994d58cf970ced85..010b44cc65a04eb5f6463d43ffb1e586a129c716 100644 (file)
@@ -1,6 +1,7 @@
 # SPDX-License-Identifier: GPL-2.0
 # Platform
 snd-soc-lpass-cpu-objs := lpass-cpu.o
+snd-soc-lpass-cdc-dma-objs := lpass-cdc-dma.o
 snd-soc-lpass-hdmi-objs := lpass-hdmi.o
 snd-soc-lpass-platform-objs := lpass-platform.o
 snd-soc-lpass-ipq806x-objs := lpass-ipq806x.o
@@ -8,6 +9,7 @@ snd-soc-lpass-apq8016-objs := lpass-apq8016.o
 snd-soc-lpass-sc7180-objs := lpass-sc7180.o
 
 obj-$(CONFIG_SND_SOC_LPASS_CPU) += snd-soc-lpass-cpu.o
+obj-$(CONFIG_SND_SOC_LPASS_CDC_DMA) += snd-soc-lpass-cdc-dma.o
 obj-$(CONFIG_SND_SOC_LPASS_HDMI) += snd-soc-lpass-hdmi.o
 obj-$(CONFIG_SND_SOC_LPASS_PLATFORM) += snd-soc-lpass-platform.o
 obj-$(CONFIG_SND_SOC_LPASS_IPQ806X) += snd-soc-lpass-ipq806x.o
diff --git a/sound/soc/qcom/lpass-cdc-dma.c b/sound/soc/qcom/lpass-cdc-dma.c
new file mode 100644 (file)
index 0000000..31b9f1c
--- /dev/null
@@ -0,0 +1,301 @@
+// SPDX-License-Identifier: GPL-2.0-only
+/*
+ * Copyright (c) 2021 The Linux Foundation. All rights reserved.
+ *
+ * lpass-cdc-dma.c -- ALSA SoC CDC DMA CPU DAI driver for QTi LPASS
+ */
+
+#include <linux/clk.h>
+#include <linux/module.h>
+#include <linux/export.h>
+#include <sound/soc.h>
+#include <sound/soc-dai.h>
+
+#include "lpass-lpaif-reg.h"
+#include "lpass.h"
+
+#define CODEC_MEM_HZ_NORMAL 153600000
+
+enum codec_dma_interfaces {
+       LPASS_CDC_DMA_INTERFACE1 = 1,
+       LPASS_CDC_DMA_INTERFACE2,
+       LPASS_CDC_DMA_INTERFACE3,
+       LPASS_CDC_DMA_INTERFACE4,
+       LPASS_CDC_DMA_INTERFACE5,
+       LPASS_CDC_DMA_INTERFACE6,
+       LPASS_CDC_DMA_INTERFACE7,
+       LPASS_CDC_DMA_INTERFACE8,
+       LPASS_CDC_DMA_INTERFACE9,
+       LPASS_CDC_DMA_INTERFACE10,
+};
+
+static void __lpass_get_dmactl_handle(struct snd_pcm_substream *substream, struct snd_soc_dai *dai,
+                                     struct lpaif_dmactl **dmactl, int *id)
+{
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+       struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(soc_runtime, 0);
+       struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
+       struct snd_pcm_runtime *rt = substream->runtime;
+       struct lpass_pcm_data *pcm_data = rt->private_data;
+       struct lpass_variant *v = drvdata->variant;
+       unsigned int dai_id = cpu_dai->driver->id;
+
+       switch (dai_id) {
+       case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
+               *dmactl = drvdata->rxtx_rd_dmactl;
+               *id = pcm_data->dma_ch;
+               break;
+       case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
+               *dmactl = drvdata->rxtx_wr_dmactl;
+               *id = pcm_data->dma_ch - v->rxtx_wrdma_channel_start;
+               break;
+       case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX8:
+               *dmactl = drvdata->va_wr_dmactl;
+               *id = pcm_data->dma_ch - v->va_wrdma_channel_start;
+               break;
+       default:
+               dev_err(soc_runtime->dev, "invalid dai id for dma ctl: %d\n", dai_id);
+               break;
+       }
+}
+
+static int __lpass_get_codec_dma_intf_type(int dai_id)
+{
+       int ret;
+
+       switch (dai_id) {
+       case LPASS_CDC_DMA_RX0:
+       case LPASS_CDC_DMA_TX0:
+       case LPASS_CDC_DMA_VA_TX0:
+               ret = LPASS_CDC_DMA_INTERFACE1;
+               break;
+       case LPASS_CDC_DMA_RX1:
+       case LPASS_CDC_DMA_TX1:
+       case LPASS_CDC_DMA_VA_TX1:
+               ret = LPASS_CDC_DMA_INTERFACE2;
+               break;
+       case LPASS_CDC_DMA_RX2:
+       case LPASS_CDC_DMA_TX2:
+       case LPASS_CDC_DMA_VA_TX2:
+               ret = LPASS_CDC_DMA_INTERFACE3;
+               break;
+       case LPASS_CDC_DMA_RX3:
+       case LPASS_CDC_DMA_TX3:
+       case LPASS_CDC_DMA_VA_TX3:
+               ret = LPASS_CDC_DMA_INTERFACE4;
+               break;
+       case LPASS_CDC_DMA_RX4:
+       case LPASS_CDC_DMA_TX4:
+       case LPASS_CDC_DMA_VA_TX4:
+               ret = LPASS_CDC_DMA_INTERFACE5;
+               break;
+       case LPASS_CDC_DMA_RX5:
+       case LPASS_CDC_DMA_TX5:
+       case LPASS_CDC_DMA_VA_TX5:
+               ret = LPASS_CDC_DMA_INTERFACE6;
+               break;
+       case LPASS_CDC_DMA_RX6:
+       case LPASS_CDC_DMA_TX6:
+       case LPASS_CDC_DMA_VA_TX6:
+               ret = LPASS_CDC_DMA_INTERFACE7;
+               break;
+       case LPASS_CDC_DMA_RX7:
+       case LPASS_CDC_DMA_TX7:
+       case LPASS_CDC_DMA_VA_TX7:
+               ret = LPASS_CDC_DMA_INTERFACE8;
+               break;
+       case LPASS_CDC_DMA_RX8:
+       case LPASS_CDC_DMA_TX8:
+       case LPASS_CDC_DMA_VA_TX8:
+               ret = LPASS_CDC_DMA_INTERFACE9;
+               break;
+       case LPASS_CDC_DMA_RX9:
+               ret  = LPASS_CDC_DMA_INTERFACE10;
+               break;
+       default:
+               ret = -EINVAL;
+               break;
+       }
+       return ret;
+}
+
+static int __lpass_platform_codec_intf_init(struct snd_soc_dai *dai,
+                                           struct snd_pcm_substream *substream)
+{
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+       struct snd_soc_dai *cpu_dai = asoc_rtd_to_cpu(soc_runtime, 0);
+       struct lpaif_dmactl *dmactl = NULL;
+       struct device *dev = soc_runtime->dev;
+       int ret, id, codec_intf;
+       unsigned int dai_id = cpu_dai->driver->id;
+
+       codec_intf = __lpass_get_codec_dma_intf_type(dai_id);
+       if (codec_intf < 0) {
+               dev_err(dev, "failed to get codec_intf: %d\n", codec_intf);
+               return codec_intf;
+       }
+
+       __lpass_get_dmactl_handle(substream, dai, &dmactl, &id);
+       if (!dmactl)
+               return -EINVAL;
+
+       ret = regmap_fields_write(dmactl->codec_intf, id, codec_intf);
+       if (ret) {
+               dev_err(dev, "error writing to dmactl codec_intf reg field: %d\n", ret);
+               return ret;
+       }
+       ret = regmap_fields_write(dmactl->codec_fs_sel, id, 0x0);
+       if (ret) {
+               dev_err(dev, "error writing to dmactl codec_fs_sel reg field: %d\n", ret);
+               return ret;
+       }
+       ret = regmap_fields_write(dmactl->codec_fs_delay, id, 0x0);
+       if (ret) {
+               dev_err(dev, "error writing to dmactl codec_fs_delay reg field: %d\n", ret);
+               return ret;
+       }
+       ret = regmap_fields_write(dmactl->codec_pack, id, 0x1);
+       if (ret) {
+               dev_err(dev, "error writing to dmactl codec_pack reg field: %d\n", ret);
+               return ret;
+       }
+       ret = regmap_fields_write(dmactl->codec_enable, id, LPAIF_DMACTL_ENABLE_ON);
+       if (ret) {
+               dev_err(dev, "error writing to dmactl codec_enable reg field: %d\n", ret);
+               return ret;
+       }
+       return 0;
+}
+
+static int lpass_cdc_dma_daiops_startup(struct snd_pcm_substream *substream,
+                                   struct snd_soc_dai *dai)
+{
+       struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+
+       switch (dai->id) {
+       case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
+       case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
+               clk_set_rate(drvdata->codec_mem0, CODEC_MEM_HZ_NORMAL);
+               clk_prepare_enable(drvdata->codec_mem0);
+               break;
+       case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX0:
+               clk_set_rate(drvdata->va_mem0, CODEC_MEM_HZ_NORMAL);
+               clk_prepare_enable(drvdata->va_mem0);
+               break;
+       default:
+               dev_err(soc_runtime->dev, "%s: invalid  interface: %d\n", __func__, dai->id);
+               break;
+       }
+       return 0;
+}
+
+static void lpass_cdc_dma_daiops_shutdown(struct snd_pcm_substream *substream,
+                                     struct snd_soc_dai *dai)
+{
+       struct lpass_data *drvdata = snd_soc_dai_get_drvdata(dai);
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+
+       switch (dai->id) {
+       case LPASS_CDC_DMA_RX0 ... LPASS_CDC_DMA_RX9:
+       case LPASS_CDC_DMA_TX0 ... LPASS_CDC_DMA_TX8:
+               clk_disable_unprepare(drvdata->codec_mem0);
+               break;
+       case LPASS_CDC_DMA_VA_TX0 ... LPASS_CDC_DMA_VA_TX0:
+               clk_disable_unprepare(drvdata->va_mem0);
+               break;
+       default:
+               dev_err(soc_runtime->dev, "%s: invalid  interface: %d\n", __func__, dai->id);
+               break;
+       }
+}
+
+static int lpass_cdc_dma_daiops_hw_params(struct snd_pcm_substream *substream,
+                                     struct snd_pcm_hw_params *params,
+                                     struct snd_soc_dai *dai)
+{
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+       struct lpaif_dmactl *dmactl = NULL;
+       unsigned int ret, regval;
+       unsigned int channels = params_channels(params);
+       int id;
+
+       switch (channels) {
+       case 1:
+               regval = LPASS_CDC_DMA_INTF_ONE_CHANNEL;
+               break;
+       case 2:
+               regval = LPASS_CDC_DMA_INTF_TWO_CHANNEL;
+               break;
+       case 4:
+               regval = LPASS_CDC_DMA_INTF_FOUR_CHANNEL;
+               break;
+       case 6:
+               regval = LPASS_CDC_DMA_INTF_SIX_CHANNEL;
+               break;
+       case 8:
+               regval = LPASS_CDC_DMA_INTF_EIGHT_CHANNEL;
+               break;
+       default:
+               dev_err(soc_runtime->dev, "invalid PCM config\n");
+               return -EINVAL;
+       }
+
+       __lpass_get_dmactl_handle(substream, dai, &dmactl, &id);
+       if (!dmactl)
+               return -EINVAL;
+
+       ret = regmap_fields_write(dmactl->codec_channel, id, regval);
+       if (ret) {
+               dev_err(soc_runtime->dev,
+                       "error writing to dmactl codec_channel reg field: %d\n", ret);
+               return ret;
+       }
+       return 0;
+}
+
+static int lpass_cdc_dma_daiops_trigger(struct snd_pcm_substream *substream,
+                                   int cmd, struct snd_soc_dai *dai)
+{
+       struct snd_soc_pcm_runtime *soc_runtime = asoc_substream_to_rtd(substream);
+       struct lpaif_dmactl *dmactl;
+       int ret = 0, id;
+
+       switch (cmd) {
+       case SNDRV_PCM_TRIGGER_START:
+       case SNDRV_PCM_TRIGGER_RESUME:
+       case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
+               __lpass_platform_codec_intf_init(dai, substream);
+               break;
+       case SNDRV_PCM_TRIGGER_STOP:
+       case SNDRV_PCM_TRIGGER_SUSPEND:
+       case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
+               __lpass_get_dmactl_handle(substream, dai, &dmactl, &id);
+               if (!dmactl)
+                       return -EINVAL;
+
+               ret = regmap_fields_write(dmactl->codec_enable, id, LPAIF_DMACTL_ENABLE_OFF);
+               if (ret) {
+                       dev_err(soc_runtime->dev,
+                               "error writing to dmactl codec_enable reg: %d\n", ret);
+                       return ret;
+               }
+               break;
+       default:
+               ret = -EINVAL;
+               dev_err(soc_runtime->dev, "%s: invalid %d interface\n", __func__, cmd);
+               break;
+       }
+       return ret;
+}
+
+const struct snd_soc_dai_ops asoc_qcom_lpass_cdc_dma_dai_ops = {
+       .startup        = lpass_cdc_dma_daiops_startup,
+       .shutdown       = lpass_cdc_dma_daiops_shutdown,
+       .hw_params      = lpass_cdc_dma_daiops_hw_params,
+       .trigger        = lpass_cdc_dma_daiops_trigger,
+};
+EXPORT_SYMBOL_GPL(asoc_qcom_lpass_cdc_dma_dai_ops);
+
+MODULE_DESCRIPTION("QTi LPASS CDC DMA Driver");
+MODULE_LICENSE("GPL");
index fdcf99256ea83b04bdd0dc9f739ff8e32e0bce9f..dd78600fc7b012ddc30e7d3990397847ce5d325d 100644 (file)
@@ -406,5 +406,6 @@ int asoc_qcom_lpass_cpu_dai_probe(struct snd_soc_dai *dai);
 extern const struct snd_soc_dai_ops asoc_qcom_lpass_cpu_dai_ops;
 int lpass_cpu_pcm_new(struct snd_soc_pcm_runtime *rtd,
                                struct snd_soc_dai *dai);
+extern const struct snd_soc_dai_ops asoc_qcom_lpass_cdc_dma_dai_ops;
 
 #endif /* __LPASS_H__ */