| // SPDX-License-Identifier: GPL-2.0 |
| // |
| // MediaTek ALSA SoC Audio DAI ADDA Control |
| // |
| // Copyright (c) 2020 MediaTek Inc. |
| // Author: Shane Chien <shane.chien@mediatek.com> |
| // |
| |
| #include <linux/delay.h> |
| #include <linux/regmap.h> |
| |
| #include "mt8192-afe-clk.h" |
| #include "mt8192-afe-common.h" |
| #include "mt8192-afe-gpio.h" |
| #include "mt8192-interconnection.h" |
| #include "../common/mtk-dai-adda-common.h" |
| |
| enum { |
| UL_IIR_SW = 0, |
| UL_IIR_5HZ, |
| UL_IIR_10HZ, |
| UL_IIR_25HZ, |
| UL_IIR_50HZ, |
| UL_IIR_75HZ, |
| }; |
| |
| enum { |
| AUDIO_SDM_LEVEL_MUTE = 0, |
| AUDIO_SDM_LEVEL_NORMAL = 0x1d, |
| /* if you change level normal */ |
| /* you need to change formula of hp impedance and dc trim too */ |
| }; |
| |
| enum { |
| AUDIO_SDM_2ND = 0, |
| AUDIO_SDM_3RD, |
| }; |
| |
| #define SDM_AUTO_RESET_THRESHOLD 0x190000 |
| |
| /* dai component */ |
| static const struct snd_kcontrol_new mtk_adda_dl_ch1_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH1", AFE_CONN3, I_DL1_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL12_CH1", AFE_CONN3, I_DL12_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH1", AFE_CONN3, I_DL2_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH1", AFE_CONN3, I_DL3_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL4_CH1", AFE_CONN3_1, I_DL4_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL5_CH1", AFE_CONN3_1, I_DL5_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL6_CH1", AFE_CONN3_1, I_DL6_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL8_CH1", AFE_CONN3_1, I_DL8_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH3", AFE_CONN3, |
| I_ADDA_UL_CH3, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH2", AFE_CONN3, |
| I_ADDA_UL_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH1", AFE_CONN3, |
| I_ADDA_UL_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("GAIN1_OUT_CH1", AFE_CONN3, |
| I_GAIN1_OUT_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH1", AFE_CONN3, |
| I_PCM_1_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH1", AFE_CONN3, |
| I_PCM_2_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("SRC_1_OUT_CH1", AFE_CONN3_1, |
| I_SRC_1_OUT_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("SRC_2_OUT_CH1", AFE_CONN3_1, |
| I_SRC_2_OUT_CH1, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new mtk_adda_dl_ch2_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH1", AFE_CONN4, I_DL1_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH2", AFE_CONN4, I_DL1_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL12_CH2", AFE_CONN4, I_DL12_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH1", AFE_CONN4, I_DL2_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH2", AFE_CONN4, I_DL2_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH1", AFE_CONN4, I_DL3_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH2", AFE_CONN4, I_DL3_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL4_CH2", AFE_CONN4_1, I_DL4_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL5_CH2", AFE_CONN4_1, I_DL5_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL6_CH2", AFE_CONN4_1, I_DL6_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL8_CH2", AFE_CONN4_1, I_DL8_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH3", AFE_CONN4, |
| I_ADDA_UL_CH3, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH2", AFE_CONN4, |
| I_ADDA_UL_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH1", AFE_CONN4, |
| I_ADDA_UL_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("GAIN1_OUT_CH2", AFE_CONN4, |
| I_GAIN1_OUT_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH1", AFE_CONN4, |
| I_PCM_1_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH1", AFE_CONN4, |
| I_PCM_2_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH2", AFE_CONN4, |
| I_PCM_1_CAP_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH2", AFE_CONN4, |
| I_PCM_2_CAP_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("SRC_1_OUT_CH2", AFE_CONN4_1, |
| I_SRC_1_OUT_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("SRC_2_OUT_CH2", AFE_CONN4_1, |
| I_SRC_2_OUT_CH2, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new mtk_adda_dl_ch3_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH1", AFE_CONN52, I_DL1_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL12_CH1", AFE_CONN52, I_DL12_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH1", AFE_CONN52, I_DL2_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH1", AFE_CONN52, I_DL3_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL4_CH1", AFE_CONN52_1, I_DL4_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL5_CH1", AFE_CONN52_1, I_DL5_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL6_CH1", AFE_CONN52_1, I_DL6_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH3", AFE_CONN52, |
| I_ADDA_UL_CH3, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH2", AFE_CONN52, |
| I_ADDA_UL_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH1", AFE_CONN52, |
| I_ADDA_UL_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("GAIN1_OUT_CH1", AFE_CONN52, |
| I_GAIN1_OUT_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH1", AFE_CONN52, |
| I_PCM_1_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH1", AFE_CONN52, |
| I_PCM_2_CAP_CH1, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new mtk_adda_dl_ch4_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH1", AFE_CONN53, I_DL1_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL1_CH2", AFE_CONN53, I_DL1_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL12_CH2", AFE_CONN53, I_DL12_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH1", AFE_CONN53, I_DL2_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL2_CH2", AFE_CONN53, I_DL2_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH1", AFE_CONN53, I_DL3_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL3_CH2", AFE_CONN53, I_DL3_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL4_CH2", AFE_CONN53_1, I_DL4_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL5_CH2", AFE_CONN53_1, I_DL5_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("DL6_CH2", AFE_CONN53_1, I_DL6_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH3", AFE_CONN53, |
| I_ADDA_UL_CH3, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH2", AFE_CONN53, |
| I_ADDA_UL_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH1", AFE_CONN53, |
| I_ADDA_UL_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("GAIN1_OUT_CH2", AFE_CONN53, |
| I_GAIN1_OUT_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH1", AFE_CONN53, |
| I_PCM_1_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH1", AFE_CONN53, |
| I_PCM_2_CAP_CH1, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_1_CAP_CH2", AFE_CONN53, |
| I_PCM_1_CAP_CH2, 1, 0), |
| SOC_DAPM_SINGLE_AUTODISABLE("PCM_2_CAP_CH2", AFE_CONN53, |
| I_PCM_2_CAP_CH2, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new mtk_stf_ch1_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH1", AFE_CONN19, |
| I_ADDA_UL_CH1, 1, 0), |
| }; |
| |
| static const struct snd_kcontrol_new mtk_stf_ch2_mix[] = { |
| SOC_DAPM_SINGLE_AUTODISABLE("ADDA_UL_CH2", AFE_CONN20, |
| I_ADDA_UL_CH2, 1, 0), |
| }; |
| |
| enum { |
| SUPPLY_SEQ_ADDA_AFE_ON, |
| SUPPLY_SEQ_ADDA_DL_ON, |
| SUPPLY_SEQ_ADDA_AUD_PAD_TOP, |
| SUPPLY_SEQ_ADDA_MTKAIF_CFG, |
| SUPPLY_SEQ_ADDA6_MTKAIF_CFG, |
| SUPPLY_SEQ_ADDA_FIFO, |
| SUPPLY_SEQ_ADDA_AP_DMIC, |
| SUPPLY_SEQ_ADDA_UL_ON, |
| }; |
| |
| static int mtk_adda_ul_src_dmic(struct mtk_base_afe *afe, int id) |
| { |
| unsigned int reg; |
| |
| switch (id) { |
| case MT8192_DAI_ADDA: |
| case MT8192_DAI_AP_DMIC: |
| reg = AFE_ADDA_UL_SRC_CON0; |
| break; |
| case MT8192_DAI_ADDA_CH34: |
| case MT8192_DAI_AP_DMIC_CH34: |
| reg = AFE_ADDA6_UL_SRC_CON0; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| /* dmic mode, 3.25M*/ |
| regmap_update_bits(afe->regmap, reg, |
| DIGMIC_3P25M_1P625M_SEL_CTL_MASK_SFT, |
| 0x0); |
| regmap_update_bits(afe->regmap, reg, |
| DMIC_LOW_POWER_MODE_CTL_MASK_SFT, |
| 0x0); |
| |
| /* turn on dmic, ch1, ch2 */ |
| regmap_update_bits(afe->regmap, reg, |
| UL_SDM_3_LEVEL_CTL_MASK_SFT, |
| 0x1 << UL_SDM_3_LEVEL_CTL_SFT); |
| regmap_update_bits(afe->regmap, reg, |
| UL_MODE_3P25M_CH1_CTL_MASK_SFT, |
| 0x1 << UL_MODE_3P25M_CH1_CTL_SFT); |
| regmap_update_bits(afe->regmap, reg, |
| UL_MODE_3P25M_CH2_CTL_MASK_SFT, |
| 0x1 << UL_MODE_3P25M_CH2_CTL_SFT); |
| return 0; |
| } |
| |
| static int mtk_adda_ul_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int mtkaif_dmic = afe_priv->mtkaif_dmic; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| mt8192_afe_gpio_request(afe->dev, true, MT8192_DAI_ADDA, 1); |
| |
| /* update setting to dmic */ |
| if (mtkaif_dmic) { |
| /* mtkaif_rxif_data_mode = 1, dmic */ |
| regmap_update_bits(afe->regmap, AFE_ADDA_MTKAIF_RX_CFG0, |
| 0x1, 0x1); |
| |
| /* dmic mode, 3.25M*/ |
| regmap_update_bits(afe->regmap, AFE_ADDA_MTKAIF_RX_CFG0, |
| MTKAIF_RXIF_VOICE_MODE_MASK_SFT, |
| 0x0); |
| mtk_adda_ul_src_dmic(afe, MT8192_DAI_ADDA); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* should delayed 1/fs(smallest is 8k) = 125us before afe off */ |
| usleep_range(125, 135); |
| mt8192_afe_gpio_request(afe->dev, false, MT8192_DAI_ADDA, 1); |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_adda_ch34_ul_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int mtkaif_dmic = afe_priv->mtkaif_dmic_ch34; |
| int mtkaif_adda6_only = afe_priv->mtkaif_adda6_only; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| mt8192_afe_gpio_request(afe->dev, true, MT8192_DAI_ADDA_CH34, |
| 1); |
| |
| /* update setting to dmic */ |
| if (mtkaif_dmic) { |
| /* mtkaif_rxif_data_mode = 1, dmic */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_MTKAIF_RX_CFG0, |
| 0x1, 0x1); |
| |
| /* dmic mode, 3.25M*/ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_MTKAIF_RX_CFG0, |
| MTKAIF_RXIF_VOICE_MODE_MASK_SFT, |
| 0x0); |
| mtk_adda_ul_src_dmic(afe, MT8192_DAI_ADDA_CH34); |
| } |
| |
| /* when using adda6 without adda enabled, |
| * RG_ADDA6_MTKAIF_RX_SYNC_WORD2_DISABLE_SFT need to be set or |
| * data cannot be received. |
| */ |
| if (mtkaif_adda6_only) { |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_MTKAIF_SYNCWORD_CFG, |
| 0x1 << 23, 0x1 << 23); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* should delayed 1/fs(smallest is 8k) = 125us before afe off */ |
| usleep_range(125, 135); |
| mt8192_afe_gpio_request(afe->dev, false, MT8192_DAI_ADDA_CH34, |
| 1); |
| |
| /* reset dmic */ |
| afe_priv->mtkaif_dmic_ch34 = 0; |
| |
| if (mtkaif_adda6_only) { |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_MTKAIF_SYNCWORD_CFG, |
| 0x1 << 23, 0x0 << 23); |
| } |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_adda_pad_top_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (afe_priv->mtkaif_protocol == MTKAIF_PROTOCOL_2_CLK_P2) |
| regmap_write(afe->regmap, AFE_AUD_PAD_TOP, 0x38); |
| else |
| regmap_write(afe->regmap, AFE_AUD_PAD_TOP, 0x30); |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_adda_mtkaif_cfg_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int delay_data; |
| int delay_cycle; |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| if (afe_priv->mtkaif_protocol == MTKAIF_PROTOCOL_2_CLK_P2) { |
| /* set protocol 2 */ |
| regmap_write(afe->regmap, AFE_ADDA_MTKAIF_CFG0, |
| 0x00010000); |
| regmap_write(afe->regmap, AFE_ADDA6_MTKAIF_CFG0, |
| 0x00010000); |
| |
| if (snd_soc_dapm_widget_name_cmp(w, "ADDA_MTKAIF_CFG") == 0 && |
| (afe_priv->mtkaif_chosen_phase[0] < 0 || |
| afe_priv->mtkaif_chosen_phase[1] < 0)) { |
| dev_warn(afe->dev, |
| "%s(), mtkaif_chosen_phase[0/1]:%d/%d\n", |
| __func__, |
| afe_priv->mtkaif_chosen_phase[0], |
| afe_priv->mtkaif_chosen_phase[1]); |
| break; |
| } else if (snd_soc_dapm_widget_name_cmp(w, "ADDA6_MTKAIF_CFG") == 0 && |
| afe_priv->mtkaif_chosen_phase[2] < 0) { |
| dev_warn(afe->dev, |
| "%s(), mtkaif_chosen_phase[2]:%d\n", |
| __func__, |
| afe_priv->mtkaif_chosen_phase[2]); |
| break; |
| } |
| |
| /* mtkaif_rxif_clkinv_adc inverse for calibration */ |
| regmap_update_bits(afe->regmap, AFE_ADDA_MTKAIF_CFG0, |
| MTKAIF_RXIF_CLKINV_ADC_MASK_SFT, |
| 0x1 << MTKAIF_RXIF_CLKINV_ADC_SFT); |
| regmap_update_bits(afe->regmap, AFE_ADDA6_MTKAIF_CFG0, |
| MTKAIF_RXIF_CLKINV_ADC_MASK_SFT, |
| 0x1 << MTKAIF_RXIF_CLKINV_ADC_SFT); |
| |
| /* set delay for ch12 */ |
| if (afe_priv->mtkaif_phase_cycle[0] >= |
| afe_priv->mtkaif_phase_cycle[1]) { |
| delay_data = DELAY_DATA_MISO1; |
| delay_cycle = afe_priv->mtkaif_phase_cycle[0] - |
| afe_priv->mtkaif_phase_cycle[1]; |
| } else { |
| delay_data = DELAY_DATA_MISO2; |
| delay_cycle = afe_priv->mtkaif_phase_cycle[1] - |
| afe_priv->mtkaif_phase_cycle[0]; |
| } |
| |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_MTKAIF_RX_CFG2, |
| MTKAIF_RXIF_DELAY_DATA_MASK_SFT, |
| delay_data << |
| MTKAIF_RXIF_DELAY_DATA_SFT); |
| |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_MTKAIF_RX_CFG2, |
| MTKAIF_RXIF_DELAY_CYCLE_MASK_SFT, |
| delay_cycle << |
| MTKAIF_RXIF_DELAY_CYCLE_SFT); |
| |
| /* set delay between ch3 and ch2 */ |
| if (afe_priv->mtkaif_phase_cycle[2] >= |
| afe_priv->mtkaif_phase_cycle[1]) { |
| delay_data = DELAY_DATA_MISO1; /* ch3 */ |
| delay_cycle = afe_priv->mtkaif_phase_cycle[2] - |
| afe_priv->mtkaif_phase_cycle[1]; |
| } else { |
| delay_data = DELAY_DATA_MISO2; /* ch2 */ |
| delay_cycle = afe_priv->mtkaif_phase_cycle[1] - |
| afe_priv->mtkaif_phase_cycle[2]; |
| } |
| |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_MTKAIF_RX_CFG2, |
| MTKAIF_RXIF_DELAY_DATA_MASK_SFT, |
| delay_data << |
| MTKAIF_RXIF_DELAY_DATA_SFT); |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_MTKAIF_RX_CFG2, |
| MTKAIF_RXIF_DELAY_CYCLE_MASK_SFT, |
| delay_cycle << |
| MTKAIF_RXIF_DELAY_CYCLE_SFT); |
| } else if (afe_priv->mtkaif_protocol == MTKAIF_PROTOCOL_2) { |
| regmap_write(afe->regmap, AFE_ADDA_MTKAIF_CFG0, |
| 0x00010000); |
| regmap_write(afe->regmap, AFE_ADDA6_MTKAIF_CFG0, |
| 0x00010000); |
| } else { |
| regmap_write(afe->regmap, AFE_ADDA_MTKAIF_CFG0, 0x0); |
| regmap_write(afe->regmap, AFE_ADDA6_MTKAIF_CFG0, 0x0); |
| } |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_adda_dl_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| mt8192_afe_gpio_request(afe->dev, true, MT8192_DAI_ADDA, 0); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* should delayed 1/fs(smallest is 8k) = 125us before afe off */ |
| usleep_range(125, 135); |
| mt8192_afe_gpio_request(afe->dev, false, MT8192_DAI_ADDA, 0); |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| static int mtk_adda_ch34_dl_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| mt8192_afe_gpio_request(afe->dev, true, MT8192_DAI_ADDA_CH34, |
| 0); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* should delayed 1/fs(smallest is 8k) = 125us before afe off */ |
| usleep_range(125, 135); |
| mt8192_afe_gpio_request(afe->dev, false, MT8192_DAI_ADDA_CH34, |
| 0); |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| /* stf */ |
| static int stf_positive_gain_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| |
| ucontrol->value.integer.value[0] = afe_priv->stf_positive_gain_db; |
| return 0; |
| } |
| |
| static int stf_positive_gain_set(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int gain_db = ucontrol->value.integer.value[0]; |
| bool change = false; |
| |
| afe_priv->stf_positive_gain_db = gain_db; |
| |
| if (gain_db >= 0 && gain_db <= 24) { |
| regmap_update_bits_check(afe->regmap, |
| AFE_SIDETONE_GAIN, |
| POSITIVE_GAIN_MASK_SFT, |
| (gain_db / 6) << POSITIVE_GAIN_SFT, |
| &change); |
| } else { |
| return -EINVAL; |
| } |
| |
| return change; |
| } |
| |
| static int mt8192_adda_dmic_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| |
| ucontrol->value.integer.value[0] = afe_priv->mtkaif_dmic; |
| return 0; |
| } |
| |
| static int mt8192_adda_dmic_set(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int dmic_on; |
| bool change; |
| |
| dmic_on = ucontrol->value.integer.value[0]; |
| |
| change = (afe_priv->mtkaif_dmic != dmic_on) || |
| (afe_priv->mtkaif_dmic_ch34 != dmic_on); |
| |
| afe_priv->mtkaif_dmic = dmic_on; |
| afe_priv->mtkaif_dmic_ch34 = dmic_on; |
| |
| return change; |
| } |
| |
| static int mt8192_adda6_only_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| |
| ucontrol->value.integer.value[0] = afe_priv->mtkaif_adda6_only; |
| return 0; |
| } |
| |
| static int mt8192_adda6_only_set(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_kcontrol_component(kcontrol); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| int mtkaif_adda6_only; |
| bool change; |
| |
| mtkaif_adda6_only = ucontrol->value.integer.value[0]; |
| |
| change = afe_priv->mtkaif_adda6_only != mtkaif_adda6_only; |
| afe_priv->mtkaif_adda6_only = mtkaif_adda6_only; |
| |
| return change; |
| } |
| |
| static const struct snd_kcontrol_new mtk_adda_controls[] = { |
| SOC_SINGLE("Sidetone_Gain", AFE_SIDETONE_GAIN, |
| SIDE_TONE_GAIN_SFT, SIDE_TONE_GAIN_MASK, 0), |
| SOC_SINGLE_EXT("Sidetone_Positive_Gain_dB", SND_SOC_NOPM, 0, 24, 0, |
| stf_positive_gain_get, stf_positive_gain_set), |
| SOC_SINGLE("ADDA_DL_GAIN", AFE_ADDA_DL_SRC2_CON1, |
| DL_2_GAIN_CTL_PRE_SFT, DL_2_GAIN_CTL_PRE_MASK, 0), |
| SOC_SINGLE_BOOL_EXT("MTKAIF_DMIC Switch", 0, |
| mt8192_adda_dmic_get, mt8192_adda_dmic_set), |
| SOC_SINGLE_BOOL_EXT("MTKAIF_ADDA6_ONLY Switch", 0, |
| mt8192_adda6_only_get, mt8192_adda6_only_set), |
| }; |
| |
| static const struct snd_kcontrol_new stf_ctl = |
| SOC_DAPM_SINGLE("Switch", SND_SOC_NOPM, 0, 1, 0); |
| |
| static const u16 stf_coeff_table_16k[] = { |
| 0x049C, 0x09E8, 0x09E0, 0x089C, |
| 0xFF54, 0xF488, 0xEAFC, 0xEBAC, |
| 0xfA40, 0x17AC, 0x3D1C, 0x6028, |
| 0x7538 |
| }; |
| |
| static const u16 stf_coeff_table_32k[] = { |
| 0xFE52, 0x0042, 0x00C5, 0x0194, |
| 0x029A, 0x03B7, 0x04BF, 0x057D, |
| 0x05BE, 0x0555, 0x0426, 0x0230, |
| 0xFF92, 0xFC89, 0xF973, 0xF6C6, |
| 0xF500, 0xF49D, 0xF603, 0xF970, |
| 0xFEF3, 0x065F, 0x0F4F, 0x1928, |
| 0x2329, 0x2C80, 0x345E, 0x3A0D, |
| 0x3D08 |
| }; |
| |
| static const u16 stf_coeff_table_48k[] = { |
| 0x0401, 0xFFB0, 0xFF5A, 0xFECE, |
| 0xFE10, 0xFD28, 0xFC21, 0xFB08, |
| 0xF9EF, 0xF8E8, 0xF80A, 0xF76C, |
| 0xF724, 0xF746, 0xF7E6, 0xF90F, |
| 0xFACC, 0xFD1E, 0xFFFF, 0x0364, |
| 0x0737, 0x0B62, 0x0FC1, 0x1431, |
| 0x188A, 0x1CA4, 0x2056, 0x237D, |
| 0x25F9, 0x27B0, 0x2890 |
| }; |
| |
| static int mtk_stf_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, |
| int event) |
| { |
| struct snd_soc_component *cmpnt = snd_soc_dapm_to_component(w->dapm); |
| struct mtk_base_afe *afe = snd_soc_component_get_drvdata(cmpnt); |
| |
| size_t half_tap_num; |
| const u16 *stf_coeff_table; |
| unsigned int ul_rate, reg_value; |
| size_t coef_addr; |
| |
| regmap_read(afe->regmap, AFE_ADDA_UL_SRC_CON0, &ul_rate); |
| ul_rate = ul_rate >> UL_VOICE_MODE_CH1_CH2_CTL_SFT; |
| ul_rate = ul_rate & UL_VOICE_MODE_CH1_CH2_CTL_MASK; |
| |
| if (ul_rate == MTK_AFE_ADDA_UL_RATE_48K) { |
| half_tap_num = ARRAY_SIZE(stf_coeff_table_48k); |
| stf_coeff_table = stf_coeff_table_48k; |
| } else if (ul_rate == MTK_AFE_ADDA_UL_RATE_32K) { |
| half_tap_num = ARRAY_SIZE(stf_coeff_table_32k); |
| stf_coeff_table = stf_coeff_table_32k; |
| } else { |
| half_tap_num = ARRAY_SIZE(stf_coeff_table_16k); |
| stf_coeff_table = stf_coeff_table_16k; |
| } |
| |
| regmap_read(afe->regmap, AFE_SIDETONE_CON1, ®_value); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| /* set side tone gain = 0 */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_GAIN, |
| SIDE_TONE_GAIN_MASK_SFT, |
| 0); |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_GAIN, |
| POSITIVE_GAIN_MASK_SFT, |
| 0); |
| /* don't bypass stf */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_CON1, |
| 0x1f << 27, |
| 0x0); |
| /* set stf half tap num */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_CON1, |
| SIDE_TONE_HALF_TAP_NUM_MASK_SFT, |
| half_tap_num << SIDE_TONE_HALF_TAP_NUM_SFT); |
| |
| /* set side tone coefficient */ |
| regmap_read(afe->regmap, AFE_SIDETONE_CON0, ®_value); |
| for (coef_addr = 0; coef_addr < half_tap_num; coef_addr++) { |
| bool old_w_ready = (reg_value >> W_RDY_SFT) & 0x1; |
| bool new_w_ready = 0; |
| int try_cnt = 0; |
| |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_CON0, |
| 0x39FFFFF, |
| (1 << R_W_EN_SFT) | |
| (1 << R_W_SEL_SFT) | |
| (0 << SEL_CH2_SFT) | |
| (coef_addr << |
| SIDE_TONE_COEFFICIENT_ADDR_SFT) | |
| stf_coeff_table[coef_addr]); |
| |
| /* wait until flag write_ready changed */ |
| for (try_cnt = 0; try_cnt < 10; try_cnt++) { |
| regmap_read(afe->regmap, |
| AFE_SIDETONE_CON0, ®_value); |
| new_w_ready = (reg_value >> W_RDY_SFT) & 0x1; |
| |
| /* flip => ok */ |
| if (new_w_ready == old_w_ready) { |
| udelay(3); |
| if (try_cnt == 9) { |
| dev_warn(afe->dev, |
| "%s(), write coeff not ready", |
| __func__); |
| } |
| } else { |
| break; |
| } |
| } |
| /* need write -> read -> write to write next coeff */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_CON0, |
| R_W_SEL_MASK_SFT, |
| 0x0); |
| } |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| /* bypass stf */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_CON1, |
| 0x1f << 27, |
| 0x1f << 27); |
| |
| /* set side tone gain = 0 */ |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_GAIN, |
| SIDE_TONE_GAIN_MASK_SFT, |
| 0); |
| regmap_update_bits(afe->regmap, |
| AFE_SIDETONE_GAIN, |
| POSITIVE_GAIN_MASK_SFT, |
| 0); |
| break; |
| default: |
| break; |
| } |
| |
| return 0; |
| } |
| |
| /* stf mux */ |
| enum { |
| STF_SRC_ADDA_ADDA6 = 0, |
| STF_SRC_O19O20, |
| }; |
| |
| static const char *const stf_o19o20_mux_map[] = { |
| "ADDA_ADDA6", |
| "O19O20", |
| }; |
| |
| static int stf_o19o20_mux_map_value[] = { |
| STF_SRC_ADDA_ADDA6, |
| STF_SRC_O19O20, |
| }; |
| |
| static SOC_VALUE_ENUM_SINGLE_DECL(stf_o19o20_mux_map_enum, |
| AFE_SIDETONE_CON1, |
| STF_SOURCE_FROM_O19O20_SFT, |
| STF_SOURCE_FROM_O19O20_MASK, |
| stf_o19o20_mux_map, |
| stf_o19o20_mux_map_value); |
| |
| static const struct snd_kcontrol_new stf_o19O20_mux_control = |
| SOC_DAPM_ENUM("STF_O19O20_MUX", stf_o19o20_mux_map_enum); |
| |
| enum { |
| STF_SRC_ADDA = 0, |
| STF_SRC_ADDA6, |
| }; |
| |
| static const char *const stf_adda_mux_map[] = { |
| "ADDA", |
| "ADDA6", |
| }; |
| |
| static int stf_adda_mux_map_value[] = { |
| STF_SRC_ADDA, |
| STF_SRC_ADDA6, |
| }; |
| |
| static SOC_VALUE_ENUM_SINGLE_DECL(stf_adda_mux_map_enum, |
| AFE_SIDETONE_CON1, |
| STF_O19O20_OUT_EN_SEL_SFT, |
| STF_O19O20_OUT_EN_SEL_MASK, |
| stf_adda_mux_map, |
| stf_adda_mux_map_value); |
| |
| static const struct snd_kcontrol_new stf_adda_mux_control = |
| SOC_DAPM_ENUM("STF_ADDA_MUX", stf_adda_mux_map_enum); |
| |
| /* ADDA UL MUX */ |
| enum { |
| ADDA_UL_MUX_MTKAIF = 0, |
| ADDA_UL_MUX_AP_DMIC, |
| ADDA_UL_MUX_MASK = 0x1, |
| }; |
| |
| static const char * const adda_ul_mux_map[] = { |
| "MTKAIF", "AP_DMIC" |
| }; |
| |
| static int adda_ul_map_value[] = { |
| ADDA_UL_MUX_MTKAIF, |
| ADDA_UL_MUX_AP_DMIC, |
| }; |
| |
| static SOC_VALUE_ENUM_SINGLE_DECL(adda_ul_mux_map_enum, |
| SND_SOC_NOPM, |
| 0, |
| ADDA_UL_MUX_MASK, |
| adda_ul_mux_map, |
| adda_ul_map_value); |
| |
| static const struct snd_kcontrol_new adda_ul_mux_control = |
| SOC_DAPM_ENUM("ADDA_UL_MUX Select", adda_ul_mux_map_enum); |
| |
| static const struct snd_kcontrol_new adda_ch34_ul_mux_control = |
| SOC_DAPM_ENUM("ADDA_CH34_UL_MUX Select", adda_ul_mux_map_enum); |
| |
| static const struct snd_soc_dapm_widget mtk_dai_adda_widgets[] = { |
| /* inter-connections */ |
| SND_SOC_DAPM_MIXER("ADDA_DL_CH1", SND_SOC_NOPM, 0, 0, |
| mtk_adda_dl_ch1_mix, |
| ARRAY_SIZE(mtk_adda_dl_ch1_mix)), |
| SND_SOC_DAPM_MIXER("ADDA_DL_CH2", SND_SOC_NOPM, 0, 0, |
| mtk_adda_dl_ch2_mix, |
| ARRAY_SIZE(mtk_adda_dl_ch2_mix)), |
| |
| SND_SOC_DAPM_MIXER("ADDA_DL_CH3", SND_SOC_NOPM, 0, 0, |
| mtk_adda_dl_ch3_mix, |
| ARRAY_SIZE(mtk_adda_dl_ch3_mix)), |
| SND_SOC_DAPM_MIXER("ADDA_DL_CH4", SND_SOC_NOPM, 0, 0, |
| mtk_adda_dl_ch4_mix, |
| ARRAY_SIZE(mtk_adda_dl_ch4_mix)), |
| |
| SND_SOC_DAPM_SUPPLY_S("ADDA Enable", SUPPLY_SEQ_ADDA_AFE_ON, |
| AFE_ADDA_UL_DL_CON0, ADDA_AFE_ON_SFT, 0, |
| NULL, 0), |
| |
| SND_SOC_DAPM_SUPPLY_S("ADDA Playback Enable", SUPPLY_SEQ_ADDA_DL_ON, |
| AFE_ADDA_DL_SRC2_CON0, |
| DL_2_SRC_ON_TMP_CTL_PRE_SFT, 0, |
| mtk_adda_dl_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_SUPPLY_S("ADDA CH34 Playback Enable", |
| SUPPLY_SEQ_ADDA_DL_ON, |
| AFE_ADDA_3RD_DAC_DL_SRC2_CON0, |
| DL_2_SRC_ON_TMP_CTL_PRE_SFT, 0, |
| mtk_adda_ch34_dl_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY_S("ADDA Capture Enable", SUPPLY_SEQ_ADDA_UL_ON, |
| AFE_ADDA_UL_SRC_CON0, |
| UL_SRC_ON_TMP_CTL_SFT, 0, |
| mtk_adda_ul_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_SUPPLY_S("ADDA CH34 Capture Enable", SUPPLY_SEQ_ADDA_UL_ON, |
| AFE_ADDA6_UL_SRC_CON0, |
| UL_SRC_ON_TMP_CTL_SFT, 0, |
| mtk_adda_ch34_ul_event, |
| SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), |
| |
| SND_SOC_DAPM_SUPPLY_S("AUD_PAD_TOP", SUPPLY_SEQ_ADDA_AUD_PAD_TOP, |
| AFE_AUD_PAD_TOP, |
| RG_RX_FIFO_ON_SFT, 0, |
| mtk_adda_pad_top_event, |
| SND_SOC_DAPM_PRE_PMU), |
| SND_SOC_DAPM_SUPPLY_S("ADDA_MTKAIF_CFG", SUPPLY_SEQ_ADDA_MTKAIF_CFG, |
| SND_SOC_NOPM, 0, 0, |
| mtk_adda_mtkaif_cfg_event, |
| SND_SOC_DAPM_PRE_PMU), |
| SND_SOC_DAPM_SUPPLY_S("ADDA6_MTKAIF_CFG", SUPPLY_SEQ_ADDA6_MTKAIF_CFG, |
| SND_SOC_NOPM, 0, 0, |
| mtk_adda_mtkaif_cfg_event, |
| SND_SOC_DAPM_PRE_PMU), |
| |
| SND_SOC_DAPM_SUPPLY_S("AP_DMIC_EN", SUPPLY_SEQ_ADDA_AP_DMIC, |
| AFE_ADDA_UL_SRC_CON0, |
| UL_AP_DMIC_ON_SFT, 0, |
| NULL, 0), |
| SND_SOC_DAPM_SUPPLY_S("AP_DMIC_CH34_EN", SUPPLY_SEQ_ADDA_AP_DMIC, |
| AFE_ADDA6_UL_SRC_CON0, |
| UL_AP_DMIC_ON_SFT, 0, |
| NULL, 0), |
| |
| SND_SOC_DAPM_SUPPLY_S("ADDA_FIFO", SUPPLY_SEQ_ADDA_FIFO, |
| AFE_ADDA_UL_DL_CON0, |
| AFE_ADDA_FIFO_AUTO_RST_SFT, 1, |
| NULL, 0), |
| SND_SOC_DAPM_SUPPLY_S("ADDA_CH34_FIFO", SUPPLY_SEQ_ADDA_FIFO, |
| AFE_ADDA_UL_DL_CON0, |
| AFE_ADDA6_FIFO_AUTO_RST_SFT, 1, |
| NULL, 0), |
| |
| SND_SOC_DAPM_MUX("ADDA_UL_Mux", SND_SOC_NOPM, 0, 0, |
| &adda_ul_mux_control), |
| SND_SOC_DAPM_MUX("ADDA_CH34_UL_Mux", SND_SOC_NOPM, 0, 0, |
| &adda_ch34_ul_mux_control), |
| |
| SND_SOC_DAPM_INPUT("AP_DMIC_INPUT"), |
| SND_SOC_DAPM_INPUT("AP_DMIC_CH34_INPUT"), |
| |
| /* stf */ |
| SND_SOC_DAPM_SWITCH_E("Sidetone Filter", |
| AFE_SIDETONE_CON1, SIDE_TONE_ON_SFT, 0, |
| &stf_ctl, |
| mtk_stf_event, |
| SND_SOC_DAPM_PRE_PMU | |
| SND_SOC_DAPM_POST_PMD), |
| SND_SOC_DAPM_MUX("STF_O19O20_MUX", SND_SOC_NOPM, 0, 0, |
| &stf_o19O20_mux_control), |
| SND_SOC_DAPM_MUX("STF_ADDA_MUX", SND_SOC_NOPM, 0, 0, |
| &stf_adda_mux_control), |
| SND_SOC_DAPM_MIXER("STF_CH1", SND_SOC_NOPM, 0, 0, |
| mtk_stf_ch1_mix, |
| ARRAY_SIZE(mtk_stf_ch1_mix)), |
| SND_SOC_DAPM_MIXER("STF_CH2", SND_SOC_NOPM, 0, 0, |
| mtk_stf_ch2_mix, |
| ARRAY_SIZE(mtk_stf_ch2_mix)), |
| SND_SOC_DAPM_OUTPUT("STF_OUTPUT"), |
| |
| /* clock */ |
| SND_SOC_DAPM_CLOCK_SUPPLY("top_mux_audio_h"), |
| |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_dac_clk"), |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_dac_predis_clk"), |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_3rd_dac_clk"), |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_3rd_dac_predis_clk"), |
| |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_adc_clk"), |
| SND_SOC_DAPM_CLOCK_SUPPLY("aud_adda6_adc_clk"), |
| }; |
| |
| static const struct snd_soc_dapm_route mtk_dai_adda_routes[] = { |
| /* playback */ |
| {"ADDA_DL_CH1", "DL1_CH1", "DL1"}, |
| {"ADDA_DL_CH2", "DL1_CH1", "DL1"}, |
| {"ADDA_DL_CH2", "DL1_CH2", "DL1"}, |
| |
| {"ADDA_DL_CH1", "DL12_CH1", "DL12"}, |
| {"ADDA_DL_CH2", "DL12_CH2", "DL12"}, |
| |
| {"ADDA_DL_CH1", "DL6_CH1", "DL6"}, |
| {"ADDA_DL_CH2", "DL6_CH2", "DL6"}, |
| |
| {"ADDA_DL_CH1", "DL8_CH1", "DL8"}, |
| {"ADDA_DL_CH2", "DL8_CH2", "DL8"}, |
| |
| {"ADDA_DL_CH1", "DL2_CH1", "DL2"}, |
| {"ADDA_DL_CH2", "DL2_CH1", "DL2"}, |
| {"ADDA_DL_CH2", "DL2_CH2", "DL2"}, |
| |
| {"ADDA_DL_CH1", "DL3_CH1", "DL3"}, |
| {"ADDA_DL_CH2", "DL3_CH1", "DL3"}, |
| {"ADDA_DL_CH2", "DL3_CH2", "DL3"}, |
| |
| {"ADDA_DL_CH1", "DL4_CH1", "DL4"}, |
| {"ADDA_DL_CH2", "DL4_CH2", "DL4"}, |
| |
| {"ADDA_DL_CH1", "DL5_CH1", "DL5"}, |
| {"ADDA_DL_CH2", "DL5_CH2", "DL5"}, |
| |
| {"ADDA Playback", NULL, "ADDA_DL_CH1"}, |
| {"ADDA Playback", NULL, "ADDA_DL_CH2"}, |
| |
| {"ADDA Playback", NULL, "ADDA Enable"}, |
| {"ADDA Playback", NULL, "ADDA Playback Enable"}, |
| |
| {"ADDA_DL_CH3", "DL1_CH1", "DL1"}, |
| {"ADDA_DL_CH4", "DL1_CH1", "DL1"}, |
| {"ADDA_DL_CH4", "DL1_CH2", "DL1"}, |
| |
| {"ADDA_DL_CH3", "DL12_CH1", "DL12"}, |
| {"ADDA_DL_CH4", "DL12_CH2", "DL12"}, |
| |
| {"ADDA_DL_CH3", "DL6_CH1", "DL6"}, |
| {"ADDA_DL_CH4", "DL6_CH2", "DL6"}, |
| |
| {"ADDA_DL_CH3", "DL2_CH1", "DL2"}, |
| {"ADDA_DL_CH4", "DL2_CH1", "DL2"}, |
| {"ADDA_DL_CH4", "DL2_CH2", "DL2"}, |
| |
| {"ADDA_DL_CH3", "DL3_CH1", "DL3"}, |
| {"ADDA_DL_CH4", "DL3_CH1", "DL3"}, |
| {"ADDA_DL_CH4", "DL3_CH2", "DL3"}, |
| |
| {"ADDA_DL_CH3", "DL4_CH1", "DL4"}, |
| {"ADDA_DL_CH4", "DL4_CH2", "DL4"}, |
| |
| {"ADDA_DL_CH3", "DL5_CH1", "DL5"}, |
| {"ADDA_DL_CH4", "DL5_CH2", "DL5"}, |
| |
| {"ADDA CH34 Playback", NULL, "ADDA_DL_CH3"}, |
| {"ADDA CH34 Playback", NULL, "ADDA_DL_CH4"}, |
| |
| {"ADDA CH34 Playback", NULL, "ADDA Enable"}, |
| {"ADDA CH34 Playback", NULL, "ADDA CH34 Playback Enable"}, |
| |
| /* capture */ |
| {"ADDA_UL_Mux", "MTKAIF", "ADDA Capture"}, |
| {"ADDA_UL_Mux", "AP_DMIC", "AP DMIC Capture"}, |
| |
| {"ADDA_CH34_UL_Mux", "MTKAIF", "ADDA CH34 Capture"}, |
| {"ADDA_CH34_UL_Mux", "AP_DMIC", "AP DMIC CH34 Capture"}, |
| |
| {"ADDA Capture", NULL, "ADDA Enable"}, |
| {"ADDA Capture", NULL, "ADDA Capture Enable"}, |
| {"ADDA Capture", NULL, "AUD_PAD_TOP"}, |
| {"ADDA Capture", NULL, "ADDA_MTKAIF_CFG"}, |
| |
| {"AP DMIC Capture", NULL, "ADDA Enable"}, |
| {"AP DMIC Capture", NULL, "ADDA Capture Enable"}, |
| {"AP DMIC Capture", NULL, "ADDA_FIFO"}, |
| {"AP DMIC Capture", NULL, "AP_DMIC_EN"}, |
| |
| {"ADDA CH34 Capture", NULL, "ADDA Enable"}, |
| {"ADDA CH34 Capture", NULL, "ADDA CH34 Capture Enable"}, |
| {"ADDA CH34 Capture", NULL, "AUD_PAD_TOP"}, |
| {"ADDA CH34 Capture", NULL, "ADDA6_MTKAIF_CFG"}, |
| |
| {"AP DMIC CH34 Capture", NULL, "ADDA Enable"}, |
| {"AP DMIC CH34 Capture", NULL, "ADDA CH34 Capture Enable"}, |
| {"AP DMIC CH34 Capture", NULL, "ADDA_CH34_FIFO"}, |
| {"AP DMIC CH34 Capture", NULL, "AP_DMIC_CH34_EN"}, |
| |
| {"AP DMIC Capture", NULL, "AP_DMIC_INPUT"}, |
| {"AP DMIC CH34 Capture", NULL, "AP_DMIC_CH34_INPUT"}, |
| |
| /* sidetone filter */ |
| {"STF_ADDA_MUX", "ADDA", "ADDA_UL_Mux"}, |
| {"STF_ADDA_MUX", "ADDA6", "ADDA_CH34_UL_Mux"}, |
| |
| {"STF_O19O20_MUX", "ADDA_ADDA6", "STF_ADDA_MUX"}, |
| {"STF_O19O20_MUX", "O19O20", "STF_CH1"}, |
| {"STF_O19O20_MUX", "O19O20", "STF_CH2"}, |
| |
| {"Sidetone Filter", "Switch", "STF_O19O20_MUX"}, |
| {"STF_OUTPUT", NULL, "Sidetone Filter"}, |
| {"ADDA Playback", NULL, "Sidetone Filter"}, |
| {"ADDA CH34 Playback", NULL, "Sidetone Filter"}, |
| |
| /* clk */ |
| {"ADDA Playback", NULL, "aud_dac_clk"}, |
| {"ADDA Playback", NULL, "aud_dac_predis_clk"}, |
| |
| {"ADDA CH34 Playback", NULL, "aud_3rd_dac_clk"}, |
| {"ADDA CH34 Playback", NULL, "aud_3rd_dac_predis_clk"}, |
| |
| {"ADDA Capture Enable", NULL, "aud_adc_clk"}, |
| {"ADDA CH34 Capture Enable", NULL, "aud_adda6_adc_clk"}, |
| }; |
| |
| /* dai ops */ |
| static int mtk_dai_adda_hw_params(struct snd_pcm_substream *substream, |
| struct snd_pcm_hw_params *params, |
| struct snd_soc_dai *dai) |
| { |
| struct mtk_base_afe *afe = snd_soc_dai_get_drvdata(dai); |
| unsigned int rate = params_rate(params); |
| int id = dai->id; |
| |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| unsigned int dl_src2_con0 = 0; |
| unsigned int dl_src2_con1 = 0; |
| |
| /* set sampling rate */ |
| dl_src2_con0 = mtk_adda_dl_rate_transform(afe, rate) << |
| DL_2_INPUT_MODE_CTL_SFT; |
| |
| /* set output mode, UP_SAMPLING_RATE_X8 */ |
| dl_src2_con0 |= (0x3 << DL_2_OUTPUT_SEL_CTL_SFT); |
| |
| /* turn off mute function */ |
| dl_src2_con0 |= (0x01 << DL_2_MUTE_CH2_OFF_CTL_PRE_SFT); |
| dl_src2_con0 |= (0x01 << DL_2_MUTE_CH1_OFF_CTL_PRE_SFT); |
| |
| /* set voice input data if input sample rate is 8k or 16k */ |
| if (rate == 8000 || rate == 16000) |
| dl_src2_con0 |= 0x01 << DL_2_VOICE_MODE_CTL_PRE_SFT; |
| |
| /* SA suggest apply -0.3db to audio/speech path */ |
| dl_src2_con1 = MTK_AFE_ADDA_DL_GAIN_NORMAL << |
| DL_2_GAIN_CTL_PRE_SFT; |
| |
| /* turn on down-link gain */ |
| dl_src2_con0 |= (0x01 << DL_2_GAIN_ON_CTL_PRE_SFT); |
| |
| if (id == MT8192_DAI_ADDA) { |
| /* clean predistortion */ |
| regmap_write(afe->regmap, AFE_ADDA_PREDIS_CON0, 0); |
| regmap_write(afe->regmap, AFE_ADDA_PREDIS_CON1, 0); |
| |
| regmap_write(afe->regmap, |
| AFE_ADDA_DL_SRC2_CON0, dl_src2_con0); |
| regmap_write(afe->regmap, |
| AFE_ADDA_DL_SRC2_CON1, dl_src2_con1); |
| |
| /* set sdm gain */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_DL_SDM_DCCOMP_CON, |
| ATTGAIN_CTL_MASK_SFT, |
| AUDIO_SDM_LEVEL_NORMAL << |
| ATTGAIN_CTL_SFT); |
| |
| /* 2nd sdm */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_DL_SDM_DCCOMP_CON, |
| USE_3RD_SDM_MASK_SFT, |
| AUDIO_SDM_2ND << USE_3RD_SDM_SFT); |
| |
| /* sdm auto reset */ |
| regmap_write(afe->regmap, |
| AFE_ADDA_DL_SDM_AUTO_RESET_CON, |
| SDM_AUTO_RESET_THRESHOLD); |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_DL_SDM_AUTO_RESET_CON, |
| ADDA_SDM_AUTO_RESET_ONOFF_MASK_SFT, |
| 0x1 << ADDA_SDM_AUTO_RESET_ONOFF_SFT); |
| } else { |
| /* clean predistortion */ |
| regmap_write(afe->regmap, |
| AFE_ADDA_3RD_DAC_PREDIS_CON0, 0); |
| regmap_write(afe->regmap, |
| AFE_ADDA_3RD_DAC_PREDIS_CON1, 0); |
| |
| regmap_write(afe->regmap, AFE_ADDA_3RD_DAC_DL_SRC2_CON0, |
| dl_src2_con0); |
| regmap_write(afe->regmap, AFE_ADDA_3RD_DAC_DL_SRC2_CON1, |
| dl_src2_con1); |
| |
| /* set sdm gain */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_3RD_DAC_DL_SDM_DCCOMP_CON, |
| ATTGAIN_CTL_MASK_SFT, |
| AUDIO_SDM_LEVEL_NORMAL << |
| ATTGAIN_CTL_SFT); |
| |
| /* 2nd sdm */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_3RD_DAC_DL_SDM_DCCOMP_CON, |
| USE_3RD_SDM_MASK_SFT, |
| AUDIO_SDM_2ND << USE_3RD_SDM_SFT); |
| |
| /* sdm auto reset */ |
| regmap_write(afe->regmap, |
| AFE_ADDA_3RD_DAC_DL_SDM_AUTO_RESET_CON, |
| SDM_AUTO_RESET_THRESHOLD); |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_3RD_DAC_DL_SDM_AUTO_RESET_CON, |
| ADDA_3RD_DAC_SDM_AUTO_RESET_ONOFF_MASK_SFT, |
| 0x1 << ADDA_3RD_DAC_SDM_AUTO_RESET_ONOFF_SFT); |
| } |
| } else { |
| unsigned int voice_mode = 0; |
| unsigned int ul_src_con0 = 0; /* default value */ |
| |
| voice_mode = mtk_adda_ul_rate_transform(afe, rate); |
| |
| ul_src_con0 |= (voice_mode << 17) & (0x7 << 17); |
| |
| /* enable iir */ |
| ul_src_con0 |= (1 << UL_IIR_ON_TMP_CTL_SFT) & |
| UL_IIR_ON_TMP_CTL_MASK_SFT; |
| ul_src_con0 |= (UL_IIR_SW << UL_IIRMODE_CTL_SFT) & |
| UL_IIRMODE_CTL_MASK_SFT; |
| |
| switch (id) { |
| case MT8192_DAI_ADDA: |
| case MT8192_DAI_AP_DMIC: |
| /* 35Hz @ 48k */ |
| regmap_write(afe->regmap, |
| AFE_ADDA_IIR_COEF_02_01, 0x00000000); |
| regmap_write(afe->regmap, |
| AFE_ADDA_IIR_COEF_04_03, 0x00003FB8); |
| regmap_write(afe->regmap, |
| AFE_ADDA_IIR_COEF_06_05, 0x3FB80000); |
| regmap_write(afe->regmap, |
| AFE_ADDA_IIR_COEF_08_07, 0x3FB80000); |
| regmap_write(afe->regmap, |
| AFE_ADDA_IIR_COEF_10_09, 0x0000C048); |
| |
| regmap_write(afe->regmap, |
| AFE_ADDA_UL_SRC_CON0, ul_src_con0); |
| |
| /* Using Internal ADC */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_TOP_CON0, |
| 0x1 << 0, |
| 0x0 << 0); |
| |
| /* mtkaif_rxif_data_mode = 0, amic */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA_MTKAIF_RX_CFG0, |
| 0x1 << 0, |
| 0x0 << 0); |
| break; |
| case MT8192_DAI_ADDA_CH34: |
| case MT8192_DAI_AP_DMIC_CH34: |
| /* 35Hz @ 48k */ |
| regmap_write(afe->regmap, |
| AFE_ADDA6_IIR_COEF_02_01, 0x00000000); |
| regmap_write(afe->regmap, |
| AFE_ADDA6_IIR_COEF_04_03, 0x00003FB8); |
| regmap_write(afe->regmap, |
| AFE_ADDA6_IIR_COEF_06_05, 0x3FB80000); |
| regmap_write(afe->regmap, |
| AFE_ADDA6_IIR_COEF_08_07, 0x3FB80000); |
| regmap_write(afe->regmap, |
| AFE_ADDA6_IIR_COEF_10_09, 0x0000C048); |
| |
| regmap_write(afe->regmap, |
| AFE_ADDA6_UL_SRC_CON0, ul_src_con0); |
| |
| /* Using Internal ADC */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_TOP_CON0, |
| 0x1 << 0, |
| 0x0 << 0); |
| |
| /* mtkaif_rxif_data_mode = 0, amic */ |
| regmap_update_bits(afe->regmap, |
| AFE_ADDA6_MTKAIF_RX_CFG0, |
| 0x1 << 0, |
| 0x0 << 0); |
| break; |
| default: |
| break; |
| } |
| |
| /* ap dmic */ |
| switch (id) { |
| case MT8192_DAI_AP_DMIC: |
| case MT8192_DAI_AP_DMIC_CH34: |
| mtk_adda_ul_src_dmic(afe, id); |
| break; |
| default: |
| break; |
| } |
| } |
| |
| return 0; |
| } |
| |
| static const struct snd_soc_dai_ops mtk_dai_adda_ops = { |
| .hw_params = mtk_dai_adda_hw_params, |
| }; |
| |
| /* dai driver */ |
| #define MTK_ADDA_PLAYBACK_RATES (SNDRV_PCM_RATE_8000_48000 |\ |
| SNDRV_PCM_RATE_96000 |\ |
| SNDRV_PCM_RATE_192000) |
| |
| #define MTK_ADDA_CAPTURE_RATES (SNDRV_PCM_RATE_8000 |\ |
| SNDRV_PCM_RATE_16000 |\ |
| SNDRV_PCM_RATE_32000 |\ |
| SNDRV_PCM_RATE_48000 |\ |
| SNDRV_PCM_RATE_96000 |\ |
| SNDRV_PCM_RATE_192000) |
| |
| #define MTK_ADDA_FORMATS (SNDRV_PCM_FMTBIT_S16_LE |\ |
| SNDRV_PCM_FMTBIT_S24_LE |\ |
| SNDRV_PCM_FMTBIT_S32_LE) |
| |
| static struct snd_soc_dai_driver mtk_dai_adda_driver[] = { |
| { |
| .name = "ADDA", |
| .id = MT8192_DAI_ADDA, |
| .playback = { |
| .stream_name = "ADDA Playback", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_PLAYBACK_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .capture = { |
| .stream_name = "ADDA Capture", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_CAPTURE_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .ops = &mtk_dai_adda_ops, |
| }, |
| { |
| .name = "ADDA_CH34", |
| .id = MT8192_DAI_ADDA_CH34, |
| .playback = { |
| .stream_name = "ADDA CH34 Playback", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_PLAYBACK_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .capture = { |
| .stream_name = "ADDA CH34 Capture", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_CAPTURE_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .ops = &mtk_dai_adda_ops, |
| }, |
| { |
| .name = "AP_DMIC", |
| .id = MT8192_DAI_AP_DMIC, |
| .capture = { |
| .stream_name = "AP DMIC Capture", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_CAPTURE_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .ops = &mtk_dai_adda_ops, |
| }, |
| { |
| .name = "AP_DMIC_CH34", |
| .id = MT8192_DAI_AP_DMIC_CH34, |
| .capture = { |
| .stream_name = "AP DMIC CH34 Capture", |
| .channels_min = 1, |
| .channels_max = 2, |
| .rates = MTK_ADDA_CAPTURE_RATES, |
| .formats = MTK_ADDA_FORMATS, |
| }, |
| .ops = &mtk_dai_adda_ops, |
| }, |
| }; |
| |
| int mt8192_dai_adda_register(struct mtk_base_afe *afe) |
| { |
| struct mtk_base_afe_dai *dai; |
| struct mt8192_afe_private *afe_priv = afe->platform_priv; |
| |
| 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_adda_driver; |
| dai->num_dai_drivers = ARRAY_SIZE(mtk_dai_adda_driver); |
| |
| dai->controls = mtk_adda_controls; |
| dai->num_controls = ARRAY_SIZE(mtk_adda_controls); |
| dai->dapm_widgets = mtk_dai_adda_widgets; |
| dai->num_dapm_widgets = ARRAY_SIZE(mtk_dai_adda_widgets); |
| dai->dapm_routes = mtk_dai_adda_routes; |
| dai->num_dapm_routes = ARRAY_SIZE(mtk_dai_adda_routes); |
| |
| /* ap dmic priv share with adda */ |
| afe_priv->dai_priv[MT8192_DAI_AP_DMIC] = |
| afe_priv->dai_priv[MT8192_DAI_ADDA]; |
| afe_priv->dai_priv[MT8192_DAI_AP_DMIC_CH34] = |
| afe_priv->dai_priv[MT8192_DAI_ADDA_CH34]; |
| |
| return 0; |
| } |