ASoC: tegra-alt: Enable DCR and DMIC Boost Gain

 - DCR filter enabled
 - Mixer control "Boost Gain" provided (with 100x factor); gain
   is applied in LP filter configured for passthrough

Bug 200108603

Change-Id: If1e3cfa8cc0b5a3a186ebd6ecdeba9a5a3cc2ef3
Signed-off-by: Viswanath L <viswanathl@nvidia.com>
(cherry picked from commit fa3e8e9a95544f47dfb92d71321068ed30dd97ec)
Reviewed-on: http://git-master/r/802864
Reviewed-by: Ravindra Lokhande <rlokhande@nvidia.com>
Tested-by: Ravindra Lokhande <rlokhande@nvidia.com>

diff --git a/sound/soc/tegra-alt/tegra210_dmic_alt.c b/sound/soc/tegra-alt/tegra210_dmic_alt.c
index b1b22ec593f3a562dbb29c0e2be7668efe31b4fa..886fd02a71d27a652683dbc34efbe503919cd3a7 100644 (file)
--- a/sound/soc/tegra-alt/tegra210_dmic_alt.c
+++ b/sound/soc/tegra-alt/tegra210_dmic_alt.c
@@ -125,6 +125,7 @@ static int tegra210_dmic_hw_params(struct snd_pcm_substream *substream,
        struct tegra210_dmic *dmic = snd_soc_dai_get_drvdata(dai);
        int channels, srate, dmic_clk, osr = TEGRA210_DMIC_OSR_64, ret;
        struct tegra210_xbar_cif_conf cif_conf;
+       unsigned long long boost_gain;
 
        memset(&cif_conf, 0, sizeof(struct tegra210_xbar_cif_conf));
 
@@ -153,12 +154,60 @@ static int tegra210_dmic_hw_params(struct snd_pcm_substream *substream,
                                TEGRA210_DMIC_DBG_CTRL_SC_ENABLE,
                                TEGRA210_DMIC_DBG_CTRL_SC_ENABLE);
 
+       regmap_update_bits(dmic->regmap,
+                               TEGRA210_DMIC_DBG_CTRL,
+                               TEGRA210_DMIC_DBG_CTRL_DCR_ENABLE,
+                               TEGRA210_DMIC_DBG_CTRL_DCR_ENABLE);
+
        regmap_update_bits(dmic->regmap,
                                TEGRA210_DMIC_CTRL,
                                TEGRA210_DMIC_CTRL_CHANNEL_SELECT_MASK,
                                ((1 << channels) - 1) <<
                                   TEGRA210_DMIC_CTRL_CHANNEL_SELECT_SHIFT);
 
+       /* Configure LPF for passthrough and use */
+       /* its gain register for applying boost; */
+       /* Boost Gain control has 100x factor    */
+       boost_gain = 0x00800000;
+       if (dmic->boost_gain > 0) {
+               boost_gain = ((boost_gain * dmic->boost_gain) / 100);
+               if (boost_gain > 0x7FFFFFFF) {
+                       dev_warn(dev, "Boost Gain overflow\n");
+                       boost_gain = 0x7FFFFFFF;
+               }
+       }
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_FILTER_GAIN,
+                               (unsigned int)boost_gain);
+
+       regmap_update_bits(dmic->regmap,
+                               TEGRA210_DMIC_DBG_CTRL,
+                               TEGRA210_DMIC_DBG_CTRL_LP_ENABLE,
+                               TEGRA210_DMIC_DBG_CTRL_LP_ENABLE);
+
+       /* Configure the two biquads for passthrough, */
+       /* i.e. b0=1, b1=0, b2=0, a1=0, a2=0          */
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_0_COEF_0, 0x00800000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_0_COEF_1, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_0_COEF_2, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_0_COEF_3, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_0_COEF_4, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_1_COEF_0, 0x00800000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_1_COEF_1, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_1_COEF_2, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_1_COEF_3, 0x00000000);
+       regmap_write(dmic->regmap,
+                               TEGRA210_DMIC_LP_BIQUAD_1_COEF_4, 0x00000000);
+
        cif_conf.audio_channels = channels;
        cif_conf.client_channels = channels;
 
@@ -182,6 +231,28 @@ static int tegra210_dmic_hw_params(struct snd_pcm_substream *substream,
        return 0;
 }
 
+static int tegra210_dmic_get_boost_gain(struct snd_kcontrol *kcontrol,
+       struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+       struct tegra210_dmic *dmic = snd_soc_codec_get_drvdata(codec);
+
+       ucontrol->value.integer.value[0] = dmic->boost_gain;
+
+       return 0;
+}
+
+static int tegra210_dmic_put_boost_gain(struct snd_kcontrol *kcontrol,
+       struct snd_ctl_elem_value *ucontrol)
+{
+       struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
+       struct tegra210_dmic *dmic = snd_soc_codec_get_drvdata(codec);
+
+       dmic->boost_gain = ucontrol->value.integer.value[0];
+
+       return 0;
+}
+
 static int tegra210_dmic_codec_probe(struct snd_soc_codec *codec)
 {
        struct tegra210_dmic *dmic = snd_soc_codec_get_drvdata(codec);
@@ -235,12 +306,19 @@ static const struct snd_soc_dapm_route tegra210_dmic_routes[] = {
        { "DMIC Transmit", NULL, "DMIC TX" },
 };
 
+static const struct snd_kcontrol_new tegra210_dmic_controls[] = {
+       SOC_SINGLE_EXT("Boost Gain", 0, 0, 25600, 0,
+               tegra210_dmic_get_boost_gain, tegra210_dmic_put_boost_gain),
+};
+
 static struct snd_soc_codec_driver tegra210_dmic_codec = {
        .probe = tegra210_dmic_codec_probe,
        .dapm_widgets = tegra210_dmic_widgets,
        .num_dapm_widgets = ARRAY_SIZE(tegra210_dmic_widgets),
        .dapm_routes = tegra210_dmic_routes,
        .num_dapm_routes = ARRAY_SIZE(tegra210_dmic_routes),
+       .controls = tegra210_dmic_controls,
+       .num_controls = ARRAY_SIZE(tegra210_dmic_controls),
        .idle_bias_off = 1,
 };
 

diff --git a/sound/soc/tegra-alt/tegra210_dmic_alt.h b/sound/soc/tegra-alt/tegra210_dmic_alt.h
index d04c99e39202d462c938076241eee21103790901..3ba479c1ce0557b946f89a13bc5ca45f5501e975 100644 (file)
--- a/sound/soc/tegra-alt/tegra210_dmic_alt.h
+++ b/sound/soc/tegra-alt/tegra210_dmic_alt.h
@@ -119,6 +119,7 @@ struct tegra210_dmic {
        struct clk *clk_pll_a_out0;
        struct regmap *regmap;
        const struct tegra210_dmic_soc_data *soc_data;
+       int boost_gain; /* with 100x factor */
 };
 
 #endif