ASoC: Dynamically manage DBVDD2 and DBVDD3 on WM5100

Allow the DBVDD2 and DBVDD3 rails to be powered down when idle, helping
fully power down connected devices when idle.

Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>

1 files changed, 81 insertions, 1 deletions

diff --git a/sound/soc/codecs/wm5100.c b/sound/soc/codecs/wm5100.c
index 576081a2de10..443d76d3d182 100644
--- a/sound/soc/codecs/wm5100.c
+++ b/sound/soc/codecs/wm5100.c
@@ -54,6 +54,8 @@ struct wm5100_priv {
 
         struct regulator_bulk_data core_supplies[WM5100_NUM_CORE_SUPPLIES];
         struct regulator *cpvdd;
+        struct regulator *dbvdd2;
+        struct regulator *dbvdd3;
 
         int rev;
 
@@ -803,6 +805,52 @@ static int wm5100_cp_ev(struct snd_soc_dapm_widget *w,
         }
 }
 
+static int wm5100_dbvdd_ev(struct snd_soc_dapm_widget *w,
+                           struct snd_kcontrol *kcontrol,
+                           int event)
+{
+        struct snd_soc_codec *codec = w->codec;
+        struct wm5100_priv *wm5100 = snd_soc_codec_get_drvdata(codec);
+        struct regulator *regulator;
+        int ret;
+
+        switch (w->shift) {
+        case 2:
+                regulator = wm5100->dbvdd2;
+                break;
+        case 3:
+                regulator = wm5100->dbvdd3;
+                break;
+        default:
+                BUG();
+                return 0;
+        }
+
+        switch (event) {
+        case SND_SOC_DAPM_PRE_PMU:
+                ret = regulator_enable(regulator);
+                if (ret != 0) {
+                        dev_err(codec->dev, "Failed to enable DBVDD%d: %d\n",
+                                w->shift, ret);
+                        return ret;
+                }
+                return ret;
+
+        case SND_SOC_DAPM_POST_PMD:
+                ret = regulator_disable(regulator);
+                if (ret != 0) {
+                        dev_err(codec->dev, "Failed to enable DBVDD%d: %d\n",
+                                w->shift, ret);
+                        return ret;
+                }
+                return ret;
+
+        default:
+                BUG();
+                return 0;
+        }
+}
+
 static void wm5100_log_status3(struct snd_soc_codec *codec, int val)
 {
         if (val & WM5100_SPK_SHUTDOWN_WARN_EINT)
@@ -880,6 +928,10 @@ SND_SOC_DAPM_SUPPLY("CP2", WM5100_MIC_CHARGE_PUMP_1, WM5100_CP2_ENA_SHIFT, 0,
 SND_SOC_DAPM_SUPPLY("CP2 Active", WM5100_MIC_CHARGE_PUMP_1,
                     WM5100_CP2_BYPASS_SHIFT, 1, wm5100_cp_ev,
                     SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
+SND_SOC_DAPM_SUPPLY("DBVDD2", SND_SOC_NOPM, 2, 0, wm5100_dbvdd_ev,
+                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
+SND_SOC_DAPM_SUPPLY("DBVDD3", SND_SOC_NOPM, 3, 0, wm5100_dbvdd_ev,
+                    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
 
 SND_SOC_DAPM_SUPPLY("MICBIAS1", WM5100_MIC_BIAS_CTRL_1, WM5100_MICB1_ENA_SHIFT,
                     0, NULL, 0),
@@ -1122,10 +1174,14 @@ static const struct snd_soc_dapm_route wm5100_dapm_routes[] = {
         { "AIF1RX8", NULL, "SYSCLK" },
 
         { "AIF2RX1", NULL, "SYSCLK" },
+        { "AIF2RX1", NULL, "DBVDD2" },
         { "AIF2RX2", NULL, "SYSCLK" },
+        { "AIF2RX2", NULL, "DBVDD2" },
 
         { "AIF3RX1", NULL, "SYSCLK" },
+        { "AIF3RX1", NULL, "DBVDD3" },
         { "AIF3RX2", NULL, "SYSCLK" },
+        { "AIF3RX2", NULL, "DBVDD3" },
 
         { "AIF1TX1", NULL, "SYSCLK" },
         { "AIF1TX2", NULL, "SYSCLK" },
@@ -1137,10 +1193,14 @@ static const struct snd_soc_dapm_route wm5100_dapm_routes[] = {
         { "AIF1TX8", NULL, "SYSCLK" },
 
         { "AIF2TX1", NULL, "SYSCLK" },
+        { "AIF2TX1", NULL, "DBVDD2" },
         { "AIF2TX2", NULL, "SYSCLK" },
+        { "AIF2TX2", NULL, "DBVDD2" },
 
         { "AIF3TX1", NULL, "SYSCLK" },
+        { "AIF3TX1", NULL, "DBVDD3" },
         { "AIF3TX2", NULL, "SYSCLK" },
+        { "AIF3TX2", NULL, "DBVDD3" },
 
         { "MICBIAS1", NULL, "CP2" },
         { "MICBIAS2", NULL, "CP2" },
@@ -2250,12 +2310,26 @@ static int wm5100_probe(struct snd_soc_codec *codec)
                 goto err_core;
         }
 
+        wm5100->dbvdd2 = regulator_get(&i2c->dev, "DBVDD2");
+        if (IS_ERR(wm5100->dbvdd2)) {
+                ret = PTR_ERR(wm5100->dbvdd2);
+                dev_err(&i2c->dev, "Failed to get DBVDD2: %d\n", ret);
+                goto err_cpvdd;
+        }
+
+        wm5100->dbvdd3 = regulator_get(&i2c->dev, "DBVDD3");
+        if (IS_ERR(wm5100->dbvdd3)) {
+                ret = PTR_ERR(wm5100->dbvdd3);
+                dev_err(&i2c->dev, "Failed to get DBVDD2: %d\n", ret);
+                goto err_dbvdd2;
+        }
+
         ret = regulator_bulk_enable(ARRAY_SIZE(wm5100->core_supplies),
                                     wm5100->core_supplies);
         if (ret != 0) {
                 dev_err(codec->dev, "Failed to enable core supplies: %d\n",
                         ret);
-                goto err_cpvdd;
+                goto err_dbvdd3;
         }
 
         if (wm5100->pdata.ldo_ena) {
@@ -2432,6 +2506,10 @@ err_ldo:
 err_enable:
         regulator_bulk_disable(ARRAY_SIZE(wm5100->core_supplies),
                                wm5100->core_supplies);
+err_dbvdd3:
+        regulator_put(wm5100->dbvdd3);
+err_dbvdd2:
+        regulator_put(wm5100->dbvdd2);
 err_cpvdd:
         regulator_put(wm5100->cpvdd);
 err_core:
@@ -2458,6 +2536,8 @@ static int wm5100_remove(struct snd_soc_codec *codec)
                 gpio_set_value_cansleep(wm5100->pdata.ldo_ena, 0);
                 gpio_free(wm5100->pdata.ldo_ena);
         }
+        regulator_put(wm5100->dbvdd3);
+        regulator_put(wm5100->dbvdd2);
         regulator_put(wm5100->cpvdd);
         regulator_bulk_free(ARRAY_SIZE(wm5100->core_supplies),
                             wm5100->core_supplies);