-
Notifications
You must be signed in to change notification settings - Fork 0
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
ASoC: mediatek: mt8195: support pcm in platform driver
This patch adds mt8195 pcm dai driver. Signed-off-by: Trevor Wu <trevor.wu@mediatek.com> Link: https://lore.kernel.org/r/20210819084144.18483-6-trevor.wu@mediatek.com Signed-off-by: Mark Brown <broonie@kernel.org>
- Loading branch information
Trevor Wu
authored and
Mark Brown
committed
Aug 24, 2021
1 parent
3de3eba
commit 1f95c01
Showing
1 changed file
with
389 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,389 @@ | ||
| // SPDX-License-Identifier: GPL-2.0 | ||
| /* | ||
| * MediaTek ALSA SoC Audio DAI PCM I/F Control | ||
| * | ||
| * Copyright (c) 2020 MediaTek Inc. | ||
| * Author: Bicycle Tsai <bicycle.tsai@mediatek.com> | ||
| * Trevor Wu <trevor.wu@mediatek.com> | ||
| */ | ||
|
|
||
| #include <linux/regmap.h> | ||
| #include <sound/pcm_params.h> | ||
| #include "mt8195-afe-clk.h" | ||
| #include "mt8195-afe-common.h" | ||
| #include "mt8195-reg.h" | ||
|
|
||
| enum { | ||
| MTK_DAI_PCM_FMT_I2S, | ||
| MTK_DAI_PCM_FMT_EIAJ, | ||
| MTK_DAI_PCM_FMT_MODEA, | ||
| MTK_DAI_PCM_FMT_MODEB, | ||
| }; | ||
|
|
||
| enum { | ||
| MTK_DAI_PCM_CLK_A1SYS, | ||
| MTK_DAI_PCM_CLK_A2SYS, | ||
| MTK_DAI_PCM_CLK_26M_48K, | ||
| MTK_DAI_PCM_CLK_26M_441K, | ||
| }; | ||
|
|
||
| struct mtk_dai_pcm_rate { | ||
| unsigned int rate; | ||
| unsigned int reg_value; | ||
| }; | ||
|
|
||
| struct mtk_dai_pcmif_priv { | ||
| unsigned int slave_mode; | ||
| unsigned int lrck_inv; | ||
| unsigned int bck_inv; | ||
| unsigned int format; | ||
| }; | ||
|
|
||
| static const struct mtk_dai_pcm_rate mtk_dai_pcm_rates[] = { | ||
| { .rate = 8000, .reg_value = 0, }, | ||
| { .rate = 16000, .reg_value = 1, }, | ||
| { .rate = 32000, .reg_value = 2, }, | ||
| { .rate = 48000, .reg_value = 3, }, | ||
| { .rate = 11025, .reg_value = 1, }, | ||
| { .rate = 22050, .reg_value = 2, }, | ||
| { .rate = 44100, .reg_value = 3, }, | ||
| }; | ||
|
|
||
| static int mtk_dai_pcm_mode(unsigned int rate) | ||
| { | ||
| int i; | ||
|
|
||
| for (i = 0; i < ARRAY_SIZE(mtk_dai_pcm_rates); i++) | ||
| if (mtk_dai_pcm_rates[i].rate == rate) | ||
| return mtk_dai_pcm_rates[i].reg_value; | ||
|
|
||
| return -EINVAL; | ||
| } | ||
|
|
||
| static const struct snd_kcontrol_new mtk_dai_pcm_o000_mix[] = { | ||
| SOC_DAPM_SINGLE_AUTODISABLE("I000 Switch", AFE_CONN0, 0, 1, 0), | ||
| SOC_DAPM_SINGLE_AUTODISABLE("I070 Switch", AFE_CONN0_2, 6, 1, 0), | ||
| }; | ||
|
|
||
| static const struct snd_kcontrol_new mtk_dai_pcm_o001_mix[] = { | ||
| SOC_DAPM_SINGLE_AUTODISABLE("I001 Switch", AFE_CONN1, 1, 1, 0), | ||
| SOC_DAPM_SINGLE_AUTODISABLE("I071 Switch", AFE_CONN1_2, 7, 1, 0), | ||
| }; | ||
|
|
||
| static const struct snd_soc_dapm_widget mtk_dai_pcm_widgets[] = { | ||
| SND_SOC_DAPM_MIXER("I002", SND_SOC_NOPM, 0, 0, NULL, 0), | ||
| SND_SOC_DAPM_MIXER("I003", SND_SOC_NOPM, 0, 0, NULL, 0), | ||
| SND_SOC_DAPM_MIXER("O000", SND_SOC_NOPM, 0, 0, | ||
| mtk_dai_pcm_o000_mix, | ||
| ARRAY_SIZE(mtk_dai_pcm_o000_mix)), | ||
| SND_SOC_DAPM_MIXER("O001", SND_SOC_NOPM, 0, 0, | ||
| mtk_dai_pcm_o001_mix, | ||
| ARRAY_SIZE(mtk_dai_pcm_o001_mix)), | ||
|
|
||
| SND_SOC_DAPM_INPUT("PCM1_INPUT"), | ||
| SND_SOC_DAPM_OUTPUT("PCM1_OUTPUT"), | ||
| }; | ||
|
|
||
| static const struct snd_soc_dapm_route mtk_dai_pcm_routes[] = { | ||
| {"I002", NULL, "PCM1 Capture"}, | ||
| {"I003", NULL, "PCM1 Capture"}, | ||
|
|
||
| {"O000", "I000 Switch", "I000"}, | ||
| {"O001", "I001 Switch", "I001"}, | ||
|
|
||
| {"O000", "I070 Switch", "I070"}, | ||
| {"O001", "I071 Switch", "I071"}, | ||
|
|
||
| {"PCM1 Playback", NULL, "O000"}, | ||
| {"PCM1 Playback", NULL, "O001"}, | ||
|
|
||
| {"PCM1_OUTPUT", NULL, "PCM1 Playback"}, | ||
| {"PCM1 Capture", NULL, "PCM1_INPUT"}, | ||
| }; | ||
|
|
||
| static void mtk_dai_pcm_enable(struct mtk_base_afe *afe) | ||
| { | ||
| regmap_update_bits(afe->regmap, PCM_INTF_CON1, | ||
| PCM_INTF_CON1_PCM_EN, PCM_INTF_CON1_PCM_EN); | ||
| } | ||
|
|
||
| static void mtk_dai_pcm_disable(struct mtk_base_afe *afe) | ||
| { | ||
| regmap_update_bits(afe->regmap, PCM_INTF_CON1, | ||
| PCM_INTF_CON1_PCM_EN, 0x0); | ||
| } | ||
|
|
||
| static int mtk_dai_pcm_configure(struct snd_pcm_substream *substream, | ||
| struct snd_soc_dai *dai) | ||
| { | ||
| struct snd_pcm_runtime * const runtime = substream->runtime; | ||
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); | ||
| struct mt8195_afe_private *afe_priv = afe->platform_priv; | ||
| struct mtk_dai_pcmif_priv *pcmif_priv = afe_priv->dai_priv[dai->id]; | ||
| unsigned int slave_mode = pcmif_priv->slave_mode; | ||
| unsigned int lrck_inv = pcmif_priv->lrck_inv; | ||
| unsigned int bck_inv = pcmif_priv->bck_inv; | ||
| unsigned int fmt = pcmif_priv->format; | ||
| unsigned int bit_width = dai->sample_bits; | ||
| unsigned int val = 0; | ||
| unsigned int mask = 0; | ||
| int fs = 0; | ||
| int mode = 0; | ||
|
|
||
| /* sync freq mode */ | ||
| fs = mt8195_afe_fs_timing(runtime->rate); | ||
| if (fs < 0) | ||
| return -EINVAL; | ||
| val |= PCM_INTF_CON2_SYNC_FREQ_MODE(fs); | ||
| mask |= PCM_INTF_CON2_SYNC_FREQ_MODE_MASK; | ||
|
|
||
| /* clk domain sel */ | ||
| if (runtime->rate % 8000) | ||
| val |= PCM_INTF_CON2_CLK_DOMAIN_SEL(MTK_DAI_PCM_CLK_26M_441K); | ||
| else | ||
| val |= PCM_INTF_CON2_CLK_DOMAIN_SEL(MTK_DAI_PCM_CLK_26M_48K); | ||
| mask |= PCM_INTF_CON2_CLK_DOMAIN_SEL_MASK; | ||
|
|
||
| regmap_update_bits(afe->regmap, PCM_INTF_CON2, mask, val); | ||
|
|
||
| val = 0; | ||
| mask = 0; | ||
|
|
||
| /* pcm mode */ | ||
| mode = mtk_dai_pcm_mode(runtime->rate); | ||
| if (mode < 0) | ||
| return -EINVAL; | ||
| val |= PCM_INTF_CON1_PCM_MODE(mode); | ||
| mask |= PCM_INTF_CON1_PCM_MODE_MASK; | ||
|
|
||
| /* pcm format */ | ||
| val |= PCM_INTF_CON1_PCM_FMT(fmt); | ||
| mask |= PCM_INTF_CON1_PCM_FMT_MASK; | ||
|
|
||
| /* pcm sync length */ | ||
| if (fmt == MTK_DAI_PCM_FMT_MODEA || | ||
| fmt == MTK_DAI_PCM_FMT_MODEB) | ||
| val |= PCM_INTF_CON1_SYNC_LENGTH(1); | ||
| else | ||
| val |= PCM_INTF_CON1_SYNC_LENGTH(bit_width); | ||
| mask |= PCM_INTF_CON1_SYNC_LENGTH_MASK; | ||
|
|
||
| /* pcm bits, word length */ | ||
| if (bit_width > 16) { | ||
| val |= PCM_INTF_CON1_PCM_24BIT; | ||
| val |= PCM_INTF_CON1_PCM_WLEN_64BCK; | ||
| } else { | ||
| val |= PCM_INTF_CON1_PCM_16BIT; | ||
| val |= PCM_INTF_CON1_PCM_WLEN_32BCK; | ||
| } | ||
| mask |= PCM_INTF_CON1_PCM_BIT_MASK; | ||
| mask |= PCM_INTF_CON1_PCM_WLEN_MASK; | ||
|
|
||
| /* master/slave */ | ||
| if (!slave_mode) { | ||
| val |= PCM_INTF_CON1_PCM_MASTER; | ||
|
|
||
| if (lrck_inv) | ||
| val |= PCM_INTF_CON1_SYNC_OUT_INV; | ||
| if (bck_inv) | ||
| val |= PCM_INTF_CON1_BCLK_OUT_INV; | ||
| mask |= PCM_INTF_CON1_CLK_OUT_INV_MASK; | ||
| } else { | ||
| val |= PCM_INTF_CON1_PCM_SLAVE; | ||
|
|
||
| if (lrck_inv) | ||
| val |= PCM_INTF_CON1_SYNC_IN_INV; | ||
| if (bck_inv) | ||
| val |= PCM_INTF_CON1_BCLK_IN_INV; | ||
| mask |= PCM_INTF_CON1_CLK_IN_INV_MASK; | ||
|
|
||
| /* TODO: add asrc setting for slave mode */ | ||
| } | ||
| mask |= PCM_INTF_CON1_PCM_M_S_MASK; | ||
|
|
||
| regmap_update_bits(afe->regmap, PCM_INTF_CON1, mask, val); | ||
|
|
||
| return 0; | ||
| } | ||
|
|
||
| /* dai ops */ | ||
| static int mtk_dai_pcm_startup(struct snd_pcm_substream *substream, | ||
| struct snd_soc_dai *dai) | ||
| { | ||
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); | ||
| struct mt8195_afe_private *afe_priv = afe->platform_priv; | ||
|
|
||
| if (dai->component->active) | ||
| return 0; | ||
|
|
||
| mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_ASRC11]); | ||
| mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_ASRC12]); | ||
| mt8195_afe_enable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_PCMIF]); | ||
|
|
||
| return 0; | ||
| } | ||
|
|
||
| static void mtk_dai_pcm_shutdown(struct snd_pcm_substream *substream, | ||
| struct snd_soc_dai *dai) | ||
| { | ||
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); | ||
| struct mt8195_afe_private *afe_priv = afe->platform_priv; | ||
|
|
||
| if (dai->component->active) | ||
| return; | ||
|
|
||
| mtk_dai_pcm_disable(afe); | ||
|
|
||
| mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_PCMIF]); | ||
| mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_ASRC12]); | ||
| mt8195_afe_disable_clk(afe, afe_priv->clk[MT8195_CLK_AUD_ASRC11]); | ||
| } | ||
|
|
||
| static int mtk_dai_pcm_prepare(struct snd_pcm_substream *substream, | ||
| struct snd_soc_dai *dai) | ||
| { | ||
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); | ||
| int ret = 0; | ||
|
|
||
| if (snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_PLAYBACK) && | ||
| snd_soc_dai_stream_active(dai, SNDRV_PCM_STREAM_CAPTURE)) | ||
| return 0; | ||
|
|
||
| ret = mtk_dai_pcm_configure(substream, dai); | ||
| if (ret) | ||
| return ret; | ||
|
|
||
| mtk_dai_pcm_enable(afe); | ||
|
|
||
| return 0; | ||
| } | ||
|
|
||
| static int mtk_dai_pcm_set_fmt(struct snd_soc_dai *dai, unsigned int fmt) | ||
| { | ||
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); | ||
| struct mt8195_afe_private *afe_priv = afe->platform_priv; | ||
| struct mtk_dai_pcmif_priv *pcmif_priv = afe_priv->dai_priv[dai->id]; | ||
|
|
||
| dev_dbg(dai->dev, "%s fmt 0x%x\n", __func__, fmt); | ||
|
|
||
| switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { | ||
| case SND_SOC_DAIFMT_I2S: | ||
| pcmif_priv->format = MTK_DAI_PCM_FMT_I2S; | ||
| break; | ||
| case SND_SOC_DAIFMT_DSP_A: | ||
| pcmif_priv->format = MTK_DAI_PCM_FMT_MODEA; | ||
| break; | ||
| case SND_SOC_DAIFMT_DSP_B: | ||
| pcmif_priv->format = MTK_DAI_PCM_FMT_MODEB; | ||
| break; | ||
| default: | ||
| return -EINVAL; | ||
| } | ||
|
|
||
| switch (fmt & SND_SOC_DAIFMT_INV_MASK) { | ||
| case SND_SOC_DAIFMT_NB_NF: | ||
| pcmif_priv->bck_inv = 0; | ||
| pcmif_priv->lrck_inv = 0; | ||
| break; | ||
| case SND_SOC_DAIFMT_NB_IF: | ||
| pcmif_priv->bck_inv = 0; | ||
| pcmif_priv->lrck_inv = 1; | ||
| break; | ||
| case SND_SOC_DAIFMT_IB_NF: | ||
| pcmif_priv->bck_inv = 1; | ||
| pcmif_priv->lrck_inv = 0; | ||
| break; | ||
| case SND_SOC_DAIFMT_IB_IF: | ||
| pcmif_priv->bck_inv = 1; | ||
| pcmif_priv->lrck_inv = 1; | ||
| break; | ||
| default: | ||
| return -EINVAL; | ||
| } | ||
|
|
||
| switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { | ||
| case SND_SOC_DAIFMT_CBM_CFM: | ||
| pcmif_priv->slave_mode = 1; | ||
| break; | ||
| case SND_SOC_DAIFMT_CBS_CFS: | ||
| pcmif_priv->slave_mode = 0; | ||
| break; | ||
| default: | ||
| return -EINVAL; | ||
| } | ||
|
|
||
| return 0; | ||
| } | ||
|
|
||
| static const struct snd_soc_dai_ops mtk_dai_pcm_ops = { | ||
| .startup = mtk_dai_pcm_startup, | ||
| .shutdown = mtk_dai_pcm_shutdown, | ||
| .prepare = mtk_dai_pcm_prepare, | ||
| .set_fmt = mtk_dai_pcm_set_fmt, | ||
| }; | ||
|
|
||
| /* dai driver */ | ||
| #define MTK_PCM_RATES (SNDRV_PCM_RATE_8000_48000) | ||
|
|
||
| #define MTK_PCM_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ | ||
| SNDRV_PCM_FMTBIT_S24_LE |\ | ||
| SNDRV_PCM_FMTBIT_S32_LE) | ||
|
|
||
| static struct snd_soc_dai_driver mtk_dai_pcm_driver[] = { | ||
| { | ||
| .name = "PCM1", | ||
| .id = MT8195_AFE_IO_PCM, | ||
| .playback = { | ||
| .stream_name = "PCM1 Playback", | ||
| .channels_min = 1, | ||
| .channels_max = 2, | ||
| .rates = MTK_PCM_RATES, | ||
| .formats = MTK_PCM_FORMATS, | ||
| }, | ||
| .capture = { | ||
| .stream_name = "PCM1 Capture", | ||
| .channels_min = 1, | ||
| .channels_max = 2, | ||
| .rates = MTK_PCM_RATES, | ||
| .formats = MTK_PCM_FORMATS, | ||
| }, | ||
| .ops = &mtk_dai_pcm_ops, | ||
| .symmetric_rate = 1, | ||
| .symmetric_sample_bits = 1, | ||
| }, | ||
| }; | ||
|
|
||
| static int init_pcmif_priv_data(struct mtk_base_afe *afe) | ||
| { | ||
| struct mt8195_afe_private *afe_priv = afe->platform_priv; | ||
| struct mtk_dai_pcmif_priv *pcmif_priv; | ||
|
|
||
| pcmif_priv = devm_kzalloc(afe->dev, sizeof(struct mtk_dai_pcmif_priv), | ||
| GFP_KERNEL); | ||
| if (!pcmif_priv) | ||
| return -ENOMEM; | ||
|
|
||
| afe_priv->dai_priv[MT8195_AFE_IO_PCM] = pcmif_priv; | ||
| return 0; | ||
| } | ||
|
|
||
| int mt8195_dai_pcm_register(struct mtk_base_afe *afe) | ||
| { | ||
| struct mtk_base_afe_dai *dai; | ||
|
|
||
| dai = devm_kzalloc(afe->dev, sizeof(*dai), GFP_KERNEL); | ||
| if (!dai) | ||
| return -ENOMEM; | ||
|
|
||
| list_add(&dai->list, &afe->sub_dais); | ||
|
|
||
| dai->dai_drivers = mtk_dai_pcm_driver; | ||
| dai->num_dai_drivers = ARRAY_SIZE(mtk_dai_pcm_driver); | ||
|
|
||
| dai->dapm_widgets = mtk_dai_pcm_widgets; | ||
| dai->num_dapm_widgets = ARRAY_SIZE(mtk_dai_pcm_widgets); | ||
| dai->dapm_routes = mtk_dai_pcm_routes; | ||
| dai->num_dapm_routes = ARRAY_SIZE(mtk_dai_pcm_routes); | ||
|
|
||
| return init_pcmif_priv_data(afe); | ||
| } |