[RFC,1/2] ASoC: qcom: sdw: Add TDM support
Commit Message
Add qcom TDM setup function to support TDM ports for qcom platform.
Signed-off-by: Jianhua Lu <lujianhua000@gmail.com>
---
sound/soc/qcom/sdw.c | 64 ++++++++++++++++++++++++++++++++++++++++++++
1 file changed, 64 insertions(+)
Comments
On Mon, Dec 11, 2023 at 05:53:56PM +0800, Jianhua Lu wrote:
> + }
> +}
> +EXPORT_SYMBOL_GPL(qcom_snd_tdm_hw_params);
> +
Why is this exported?
> @@ -125,6 +186,9 @@ int qcom_snd_sdw_hw_params(struct snd_pcm_substream *substream,
> *psruntime = sruntime;
> }
> break;
> + case PRIMARY_TDM_RX_0...QUINARY_TDM_TX_7:
> + qcom_snd_tdm_hw_params(substream, params);
> + break;
> }
The only caller is in the same file.
On Mon, Dec 11, 2023 at 01:20:25PM +0000, Mark Brown wrote:
> On Mon, Dec 11, 2023 at 05:53:56PM +0800, Jianhua Lu wrote:
>
> > + }
> > +}
> > +EXPORT_SYMBOL_GPL(qcom_snd_tdm_hw_params);
> > +
>
> Why is this exported?
Thanks for spotting it, I will drop it in patch v2.
>
> > @@ -125,6 +186,9 @@ int qcom_snd_sdw_hw_params(struct snd_pcm_substream *substream,
> > *psruntime = sruntime;
> > }
> > break;
> > + case PRIMARY_TDM_RX_0...QUINARY_TDM_TX_7:
> > + qcom_snd_tdm_hw_params(substream, params);
> > + break;
> > }
>
> The only caller is in the same file.
@@ -4,6 +4,7 @@
#include <dt-bindings/sound/qcom,q6afe.h>
#include <linux/module.h>
+#include <sound/pcm_params.h>
#include <sound/soc.h>
#include "sdw.h"
@@ -101,6 +102,66 @@ int qcom_snd_sdw_prepare(struct snd_pcm_substream *substream,
}
EXPORT_SYMBOL_GPL(qcom_snd_sdw_prepare);
+static int qcom_snd_tdm_hw_params(struct snd_pcm_substream *substream,
+ struct snd_pcm_hw_params *params)
+{
+ struct snd_soc_pcm_runtime *rtd = snd_soc_substream_to_rtd(substream);
+ struct snd_soc_dai *cpu_dai = snd_soc_rtd_to_cpu(rtd, 0);
+ unsigned int tdm_slot_offset[8] = { 0, 4, 8, 12, 16, 20, 24, 28 };
+ int channels, slot_width;
+ int ret;
+
+ switch (params_format(params)) {
+ case SNDRV_PCM_FORMAT_S16_LE:
+ slot_width = 16;
+ break;
+ case SNDRV_PCM_FORMAT_S24_LE:
+ slot_width = 24;
+ break;
+ case SNDRV_PCM_FORMAT_S32_LE:
+ slot_width = 32;
+ break;
+ default:
+ dev_err(rtd->dev, "%s: invalid param format 0x%x\n", __func__,
+ params_format(params));
+ return -EINVAL;
+ }
+
+ channels = params_channels(params);
+ if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
+ ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0, 0x3, 8, slot_width);
+ if (ret < 0) {
+ dev_err(rtd->dev, "%s: failed to set tdm slot, err:%d\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = snd_soc_dai_set_channel_map(cpu_dai, 0, NULL, channels,
+ tdm_slot_offset);
+ if (ret < 0) {
+ dev_err(rtd->dev, "%s: failed to set channel map, err:%d\n",
+ __func__, ret);
+ return ret;
+ }
+ } else {
+ ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0xf, 0, 8, slot_width);
+ if (ret < 0) {
+ dev_err(rtd->dev, "%s: failed to set tdm slot, err:%d\n",
+ __func__, ret);
+ return ret;
+ }
+
+ ret = snd_soc_dai_set_channel_map(cpu_dai, channels,
+ tdm_slot_offset, 0, NULL);
+ if (ret < 0) {
+ dev_err(rtd->dev, "%s: failed to set channel map, err:%d\n",
+ __func__, ret);
+ return ret;
+ }
+ }
+}
+EXPORT_SYMBOL_GPL(qcom_snd_tdm_hw_params);
+
int qcom_snd_sdw_hw_params(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params,
struct sdw_stream_runtime **psruntime)
@@ -125,6 +186,9 @@ int qcom_snd_sdw_hw_params(struct snd_pcm_substream *substream,
*psruntime = sruntime;
}
break;
+ case PRIMARY_TDM_RX_0...QUINARY_TDM_TX_7:
+ qcom_snd_tdm_hw_params(substream, params);
+ break;
}
return 0;