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

Commit 06ae9988 authored by Mark Brown's avatar Mark Brown
Browse files

ASoC: Refactor WM8731 regulator management into bias management 



This allows more flexible integration with subsystem features.

Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
Acked-by: default avatarLiam Girdwood <lrg@slimlogic.co.uk>
parent 3efab7dc

sound/soc/codecs/wm8731.c

+28 −23
Original line number Diff line number Diff line
@@ -368,6 +368,10 @@ static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai, 
static int wm8731_set_bias_level(struct snd_soc_codec *codec,

				 enum snd_soc_bias_level level)

{

	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);

	int i, ret;

	u8 data[2];

	u16 *cache = codec->reg_cache;

	u16 reg;



	switch (level) {
@@ -376,6 +380,24 @@ static int wm8731_set_bias_level(struct snd_soc_codec *codec, 
	case SND_SOC_BIAS_PREPARE:

		break;

	case SND_SOC_BIAS_STANDBY:

		if (codec->bias_level == SND_SOC_BIAS_OFF) {

			ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),

						    wm8731->supplies);

			if (ret != 0)

				return ret;



			/* Sync reg_cache with the hardware */

			for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {

				if (cache[i] == wm8731_reg[i])

					continue;



				data[0] = (i << 1) | ((cache[i] >> 8)

						      & 0x0001);

				data[1] = cache[i] & 0x00ff;

				codec->hw_write(codec->control_data, data, 2);

			}

		}



		/* Clear PWROFF, gate CLKOUT, everything else as-is */

		reg = snd_soc_read(codec, WM8731_PWR) & 0xff7f;

		snd_soc_write(codec, WM8731_PWR, reg | 0x0040);
@@ -383,6 +405,8 @@ static int wm8731_set_bias_level(struct snd_soc_codec *codec, 
	case SND_SOC_BIAS_OFF:

		snd_soc_write(codec, WM8731_ACTIVE, 0x0);

		snd_soc_write(codec, WM8731_PWR, 0xffff);

		regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies),

				       wm8731->supplies);

		break;

	}

	codec->bias_level = level;
@@ -427,12 +451,9 @@ static int wm8731_suspend(struct platform_device *pdev, pm_message_t state) 
{

	struct snd_soc_device *socdev = platform_get_drvdata(pdev);

	struct snd_soc_codec *codec = socdev->card->codec;

	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);



	snd_soc_write(codec, WM8731_ACTIVE, 0x0);

	wm8731_set_bias_level(codec, SND_SOC_BIAS_OFF);

	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies),

			       wm8731->supplies);



	return 0;

}
@@ -440,25 +461,7 @@ static int wm8731_resume(struct platform_device *pdev) 
{

	struct snd_soc_device *socdev = platform_get_drvdata(pdev);

	struct snd_soc_codec *codec = socdev->card->codec;

	struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec);

	int i, ret;

	u8 data[2];

	u16 *cache = codec->reg_cache;



	ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies),

				    wm8731->supplies);

	if (ret != 0)

		return ret;



	/* Sync reg_cache with the hardware */

	for (i = 0; i < ARRAY_SIZE(wm8731_reg); i++) {

		if (cache[i] == wm8731_reg[i])

			continue;



		data[0] = (i << 1) | ((cache[i] >> 8) & 0x0001);

		data[1] = cache[i] & 0x00ff;

		codec->hw_write(codec->control_data, data, 2);

	}

	wm8731_set_bias_level(codec, SND_SOC_BIAS_STANDBY);



	return 0;
@@ -603,6 +606,9 @@ static int wm8731_register(struct wm8731_priv *wm8731, 
		goto err_codec;

	}



	/* Regulators will have been enabled by bias management */

	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);



	return 0;



err_codec:
@@ -621,7 +627,6 @@ static void wm8731_unregister(struct wm8731_priv *wm8731) 
	wm8731_set_bias_level(&wm8731->codec, SND_SOC_BIAS_OFF);

	snd_soc_unregister_dai(&wm8731_dai);

	snd_soc_unregister_codec(&wm8731->codec);

	regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);

	regulator_bulk_free(ARRAY_SIZE(wm8731->supplies), wm8731->supplies);

	kfree(wm8731);

	wm8731_codec = NULL;