Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit 7aefb086 authored by Mark Brown's avatar Mark Brown
Browse files

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: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent ab6cf139

sound/soc/codecs/wm5100.c

+81 −1
Original line number Diff line number Diff line
@@ -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 @@ static int wm5100_probe(struct snd_soc_codec *codec) 
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);