ASoC: rt5645: Add ASRC support

This patch add ASRC support for rt5645 codec.

Signed-off-by: Bard Liao <bardliao@realtek.com>
Signed-off-by: Mark Brown <broonie@kernel.org>

diff --git a/sound/soc/codecs/rt5645.c b/sound/soc/codecs/rt5645.c
index 286438d6916bf622a34787695254feaefc085881..1dbbebc83d41ad22c5f8bed18a33bcac2873247f 100644 (file)
--- a/sound/soc/codecs/rt5645.c
+++ b/sound/soc/codecs/rt5645.c
@@ -441,6 +441,65 @@ static SOC_ENUM_SINGLE_DECL(rt5645_tdm_adc_sel_enum,
                                RT5645_TDM_CTRL_1, 8,
                                rt5645_tdm_adc_data_select);
 
+static int rt5645_clk_sel_put(struct snd_kcontrol *kcontrol,
+               struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol);
+       unsigned int u_bit = 0, p_bit = 0;
+       struct soc_enum *em =
+               (struct soc_enum *)kcontrol->private_value;
+
+       switch (em->reg) {
+       case RT5645_ASRC_2:
+               switch (em->shift_l) {
+               case 0:
+                       u_bit = 0x8;
+                       p_bit = RT5645_PWR_ADC_S1F;
+                       break;
+               case 4:
+                       u_bit = 0x100;
+                       p_bit = RT5645_PWR_DAC_MF_R;
+                       break;
+               case 8:
+                       u_bit = 0x200;
+                       p_bit = RT5645_PWR_DAC_MF_L;
+                       break;
+               case 12:
+                       u_bit = 0x400;
+                       p_bit = RT5645_PWR_DAC_S1F;
+                       break;
+               }
+               break;
+       case RT5645_ASRC_3:
+               switch (em->shift_l) {
+               case 0:
+                       u_bit = 0x1;
+                       p_bit = RT5645_PWR_ADC_MF_R;
+                       break;
+               case 4:
+                       u_bit = 0x2;
+                       p_bit = RT5645_PWR_ADC_MF_L;
+                       break;
+               }
+               break;
+       }
+
+       if (u_bit || p_bit) {
+               switch (ucontrol->value.integer.value[0]) {
+               case 1 ... 4: /*enable*/
+                       if (snd_soc_read(codec, RT5645_PWR_DIG2) & p_bit)
+                               snd_soc_update_bits(codec,
+                                       RT5645_ASRC_1, u_bit, u_bit);
+                       break;
+               default: /*disable*/
+                       snd_soc_update_bits(codec, RT5645_ASRC_1, u_bit, 0);
+                       break;
+               }
+       }
+
+       return snd_soc_put_enum_double(kcontrol, ucontrol);
+}
+
 static const struct snd_kcontrol_new rt5645_snd_controls[] = {
        /* Speaker Output Volume */
        SOC_DOUBLE("Speaker Channel Switch", RT5645_SPK_VOL,
@@ -552,6 +611,53 @@ static int is_sys_clk_from_pll(struct snd_soc_dapm_widget *source,
                return 0;
 }
 
+static int is_using_asrc(struct snd_soc_dapm_widget *source,
+                        struct snd_soc_dapm_widget *sink)
+{
+       unsigned int reg, shift, val;
+
+       switch (source->shift) {
+       case 0:
+               reg = RT5645_ASRC_3;
+               shift = 0;
+               break;
+       case 1:
+               reg = RT5645_ASRC_3;
+               shift = 4;
+               break;
+       case 3:
+               reg = RT5645_ASRC_2;
+               shift = 0;
+               break;
+       case 8:
+               reg = RT5645_ASRC_2;
+               shift = 4;
+               break;
+       case 9:
+               reg = RT5645_ASRC_2;
+               shift = 8;
+               break;
+       case 10:
+               reg = RT5645_ASRC_2;
+               shift = 12;
+               break;
+       default:
+               return 0;
+       }
+
+       val = (snd_soc_read(source->codec, reg) >> shift) & 0xf;
+       switch (val) {
+       case 1:
+       case 2:
+       case 3:
+       case 4:
+               return 1;
+       default:
+               return 0;
+       }
+
+}
+
 /* Digital Mixer */
 static const struct snd_kcontrol_new rt5645_sto1_adc_l_mix[] = {
        SOC_DAPM_SINGLE("ADC1 Switch", RT5645_STO1_ADC_MIXER,
@@ -1244,6 +1350,30 @@ static const struct snd_soc_dapm_widget rt5645_dapm_widgets[] = {
        SND_SOC_DAPM_SUPPLY("Mic Det Power", RT5645_PWR_VOL,
                RT5645_PWR_MIC_DET_BIT, 0, NULL, 0),
 
+       /* ASRC */
+       SND_SOC_DAPM_SUPPLY_S("I2S1 ASRC", 1, RT5645_ASRC_1,
+                             11, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("I2S2 ASRC", 1, RT5645_ASRC_1,
+                             12, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DAC STO ASRC", 1, RT5645_ASRC_1,
+                             10, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DAC MONO L ASRC", 1, RT5645_ASRC_1,
+                             9, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DAC MONO R ASRC", 1, RT5645_ASRC_1,
+                             8, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DMIC STO1 ASRC", 1, RT5645_ASRC_1,
+                             7, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DMIC MONO L ASRC", 1, RT5645_ASRC_1,
+                             5, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("DMIC MONO R ASRC", 1, RT5645_ASRC_1,
+                             4, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("ADC STO1 ASRC", 1, RT5645_ASRC_1,
+                             3, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("ADC MONO L ASRC", 1, RT5645_ASRC_1,
+                             1, 0, NULL, 0),
+       SND_SOC_DAPM_SUPPLY_S("ADC MONO R ASRC", 1, RT5645_ASRC_1,
+                             0, 0, NULL, 0),
+
        /* Input Side */
        /* micbias */
        SND_SOC_DAPM_MICBIAS("micbias1", RT5645_PWR_ANLG2,
@@ -1502,6 +1632,17 @@ static const struct snd_soc_dapm_widget rt5645_dapm_widgets[] = {
 };
 
 static const struct snd_soc_dapm_route rt5645_dapm_routes[] = {
+       { "adc stereo1 filter", NULL, "ADC STO1 ASRC", is_using_asrc },
+       { "adc stereo2 filter", NULL, "ADC STO2 ASRC", is_using_asrc },
+       { "adc mono left filter", NULL, "ADC MONO L ASRC", is_using_asrc },
+       { "adc mono right filter", NULL, "ADC MONO R ASRC", is_using_asrc },
+       { "dac mono left filter", NULL, "DAC MONO L ASRC", is_using_asrc },
+       { "dac mono right filter", NULL, "DAC MONO R ASRC", is_using_asrc },
+       { "dac stereo1 filter", NULL, "DAC STO ASRC", is_using_asrc },
+
+       { "I2S1", NULL, "I2S1 ASRC" },
+       { "I2S2", NULL, "I2S2 ASRC" },
+
        { "IN1P", NULL, "LDO2" },
        { "IN2P", NULL, "LDO2" },
 
@@ -1548,12 +1689,15 @@ static const struct snd_soc_dapm_route rt5645_dapm_routes[] = {
 
        { "Stereo1 DMIC Mux", "DMIC1", "DMIC1" },
        { "Stereo1 DMIC Mux", "DMIC2", "DMIC2" },
+       { "Stereo1 DMIC Mux", NULL, "DMIC STO1 ASRC" },
 
        { "Mono DMIC L Mux", "DMIC1", "DMIC L1" },
        { "Mono DMIC L Mux", "DMIC2", "DMIC L2" },
+       { "Mono DMIC L Mux", NULL, "DMIC MONO L ASRC" },
 
        { "Mono DMIC R Mux", "DMIC1", "DMIC R1" },
        { "Mono DMIC R Mux", "DMIC2", "DMIC R2" },
+       { "Mono DMIC R Mux", NULL, "DMIC MONO R ASRC" },
 
        { "Stereo1 ADC L2 Mux", "DMIC", "Stereo1 DMIC Mux" },
        { "Stereo1 ADC L2 Mux", "DAC MIX", "DAC MIXL" },