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

Commit 1a60667f authored by Charles Keepax's avatar Charles Keepax Committed by Mark Brown
Browse files

ASoC: wm8804: Enable runtime PM



Currently both the oscillator and the PLL are powered up in
set_bias_level. This can be problematic when using output clocks from
the wm8804 for other devices. The snd_soc_codec_set_pll API defines that
a clock should be available once the call returns, however, with all the
clocking controlled in set_bias_level this is not currently the case.

This patch enables pm_runtime for the wm8804, enabling both the
regulators and the oscillator when the chip resumes, and enabling the
PLL in the snd_soc_codec_set_pll call. Naturally the enabling the PLL
will also cause the chip to resume.

Signed-off-by: default avatarCharles Keepax <ckeepax@opensource.wolfsonmicro.com>
Signed-off-by: default avatarMark Brown <broonie@kernel.org>
parent 5631f187
Loading
Loading
Loading
Loading
+1 −0
Original line number Original line Diff line number Diff line
@@ -50,6 +50,7 @@ static struct i2c_driver wm8804_i2c_driver = {
	.driver = {
	.driver = {
		.name = "wm8804",
		.name = "wm8804",
		.owner = THIS_MODULE,
		.owner = THIS_MODULE,
		.pm = &wm8804_pm,
		.of_match_table = wm8804_of_match,
		.of_match_table = wm8804_of_match,
	},
	},
	.probe = wm8804_i2c_probe,
	.probe = wm8804_i2c_probe,
+1 −0
Original line number Original line Diff line number Diff line
@@ -43,6 +43,7 @@ static struct spi_driver wm8804_spi_driver = {
	.driver = {
	.driver = {
		.name = "wm8804",
		.name = "wm8804",
		.owner = THIS_MODULE,
		.owner = THIS_MODULE,
		.pm = &wm8804_pm,
		.of_match_table = wm8804_of_match,
		.of_match_table = wm8804_of_match,
	},
	},
	.probe = wm8804_spi_probe,
	.probe = wm8804_spi_probe,
+59 −50
Original line number Original line Diff line number Diff line
@@ -16,6 +16,7 @@
#include <linux/gpio/consumer.h>
#include <linux/gpio/consumer.h>
#include <linux/delay.h>
#include <linux/delay.h>
#include <linux/pm.h>
#include <linux/pm.h>
#include <linux/pm_runtime.h>
#include <linux/of_device.h>
#include <linux/of_device.h>
#include <linux/regulator/consumer.h>
#include <linux/regulator/consumer.h>
#include <linux/slab.h>
#include <linux/slab.h>
@@ -59,6 +60,7 @@ static const struct reg_default wm8804_reg_defaults[] = {
};
};


struct wm8804_priv {
struct wm8804_priv {
	struct device *dev;
	struct regmap *regmap;
	struct regmap *regmap;
	struct regulator_bulk_data supplies[WM8804_NUM_SUPPLIES];
	struct regulator_bulk_data supplies[WM8804_NUM_SUPPLIES];
	struct notifier_block disable_nb[WM8804_NUM_SUPPLIES];
	struct notifier_block disable_nb[WM8804_NUM_SUPPLIES];
@@ -403,19 +405,19 @@ static int wm8804_set_pll(struct snd_soc_dai *dai, int pll_id,
			  int source, unsigned int freq_in,
			  int source, unsigned int freq_in,
			  unsigned int freq_out)
			  unsigned int freq_out)
{
{
	struct snd_soc_codec *codec;
	struct snd_soc_codec *codec = dai->codec;
	struct wm8804_priv *wm8804 = snd_soc_codec_get_drvdata(codec);
	bool change;


	codec = dai->codec;
	if (!freq_in || !freq_out) {
	if (!freq_in || !freq_out) {
		/* disable the PLL */
		/* disable the PLL */
		snd_soc_update_bits(codec, WM8804_PWRDN, 0x1, 0x1);
		regmap_update_bits_check(wm8804->regmap, WM8804_PWRDN,
		return 0;
					 0x1, 0x1, &change);
		if (change)
			pm_runtime_put(wm8804->dev);
	} else {
	} else {
		int ret;
		int ret;
		struct pll_div pll_div;
		struct pll_div pll_div;
		struct wm8804_priv *wm8804;

		wm8804 = snd_soc_codec_get_drvdata(codec);


		ret = pll_factors(&pll_div, freq_out, freq_in,
		ret = pll_factors(&pll_div, freq_out, freq_in,
				  wm8804->mclk_div);
				  wm8804->mclk_div);
@@ -423,7 +425,10 @@ static int wm8804_set_pll(struct snd_soc_dai *dai, int pll_id,
			return ret;
			return ret;


		/* power down the PLL before reprogramming it */
		/* power down the PLL before reprogramming it */
		snd_soc_update_bits(codec, WM8804_PWRDN, 0x1, 0x1);
		regmap_update_bits_check(wm8804->regmap, WM8804_PWRDN,
					 0x1, 0x1, &change);
		if (!change)
			pm_runtime_get_sync(wm8804->dev);


		/* set PLLN and PRESCALE */
		/* set PLLN and PRESCALE */
		snd_soc_update_bits(codec, WM8804_PLL4, 0xf | 0x10,
		snd_soc_update_bits(codec, WM8804_PLL4, 0xf | 0x10,
@@ -501,47 +506,6 @@ static int wm8804_set_clkdiv(struct snd_soc_dai *dai,
	return 0;
	return 0;
}
}


static int wm8804_set_bias_level(struct snd_soc_codec *codec,
				 enum snd_soc_bias_level level)
{
	int ret;
	struct wm8804_priv *wm8804;

	wm8804 = snd_soc_codec_get_drvdata(codec);
	switch (level) {
	case SND_SOC_BIAS_ON:
		break;
	case SND_SOC_BIAS_PREPARE:
		/* power up the OSC and the PLL */
		snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0);
		break;
	case SND_SOC_BIAS_STANDBY:
		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
			ret = regulator_bulk_enable(ARRAY_SIZE(wm8804->supplies),
						    wm8804->supplies);
			if (ret) {
				dev_err(codec->dev,
					"Failed to enable supplies: %d\n",
					ret);
				return ret;
			}
			regcache_sync(wm8804->regmap);
		}
		/* power down the OSC and the PLL */
		snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9);
		break;
	case SND_SOC_BIAS_OFF:
		/* power down the OSC and the PLL */
		snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9);
		regulator_bulk_disable(ARRAY_SIZE(wm8804->supplies),
				       wm8804->supplies);
		break;
	}

	codec->dapm.bias_level = level;
	return 0;
}

static const struct snd_soc_dai_ops wm8804_dai_ops = {
static const struct snd_soc_dai_ops wm8804_dai_ops = {
	.hw_params = wm8804_hw_params,
	.hw_params = wm8804_hw_params,
	.set_fmt = wm8804_set_fmt,
	.set_fmt = wm8804_set_fmt,
@@ -579,7 +543,6 @@ static struct snd_soc_dai_driver wm8804_dai = {
};
};


static const struct snd_soc_codec_driver soc_codec_dev_wm8804 = {
static const struct snd_soc_codec_driver soc_codec_dev_wm8804 = {
	.set_bias_level = wm8804_set_bias_level,
	.idle_bias_off = true,
	.idle_bias_off = true,


	.dapm_widgets = wm8804_dapm_widgets,
	.dapm_widgets = wm8804_dapm_widgets,
@@ -613,6 +576,7 @@ int wm8804_probe(struct device *dev, struct regmap *regmap)


	dev_set_drvdata(dev, wm8804);
	dev_set_drvdata(dev, wm8804);


	wm8804->dev = dev;
	wm8804->regmap = regmap;
	wm8804->regmap = regmap;


	wm8804->reset = devm_gpiod_get_optional(dev, "wlf,reset",
	wm8804->reset = devm_gpiod_get_optional(dev, "wlf,reset",
@@ -703,6 +667,10 @@ int wm8804_probe(struct device *dev, struct regmap *regmap)
		goto err_reg_enable;
		goto err_reg_enable;
	}
	}


	pm_runtime_set_active(dev);
	pm_runtime_enable(dev);
	pm_runtime_idle(dev);

	return 0;
	return 0;


err_reg_enable:
err_reg_enable:
@@ -713,10 +681,51 @@ EXPORT_SYMBOL_GPL(wm8804_probe);


void wm8804_remove(struct device *dev)
void wm8804_remove(struct device *dev)
{
{
	pm_runtime_disable(dev);
	snd_soc_unregister_codec(dev);
	snd_soc_unregister_codec(dev);
}
}
EXPORT_SYMBOL_GPL(wm8804_remove);
EXPORT_SYMBOL_GPL(wm8804_remove);


#if IS_ENABLED(CONFIG_PM)
static int wm8804_runtime_resume(struct device *dev)
{
	struct wm8804_priv *wm8804 = dev_get_drvdata(dev);
	int ret;

	ret = regulator_bulk_enable(ARRAY_SIZE(wm8804->supplies),
				    wm8804->supplies);
	if (ret) {
		dev_err(wm8804->dev, "Failed to enable supplies: %d\n", ret);
		return ret;
	}

	regcache_sync(wm8804->regmap);

	/* Power up OSCCLK */
	regmap_update_bits(wm8804->regmap, WM8804_PWRDN, 0x8, 0x0);

	return 0;
}

static int wm8804_runtime_suspend(struct device *dev)
{
	struct wm8804_priv *wm8804 = dev_get_drvdata(dev);

	/* Power down OSCCLK */
	regmap_update_bits(wm8804->regmap, WM8804_PWRDN, 0x8, 0x8);

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

	return 0;
}
#endif

const struct dev_pm_ops wm8804_pm = {
	SET_RUNTIME_PM_OPS(wm8804_runtime_suspend, wm8804_runtime_resume, NULL)
};
EXPORT_SYMBOL_GPL(wm8804_pm);

MODULE_DESCRIPTION("ASoC WM8804 driver");
MODULE_DESCRIPTION("ASoC WM8804 driver");
MODULE_AUTHOR("Dimitris Papastamos <dp@opensource.wolfsonmicro.com>");
MODULE_AUTHOR("Dimitris Papastamos <dp@opensource.wolfsonmicro.com>");
MODULE_LICENSE("GPL");
MODULE_LICENSE("GPL");
+1 −0
Original line number Original line Diff line number Diff line
@@ -65,6 +65,7 @@
#define WM8804_MCLKDIV_128FS			1
#define WM8804_MCLKDIV_128FS			1


extern const struct regmap_config wm8804_regmap_config;
extern const struct regmap_config wm8804_regmap_config;
extern const struct dev_pm_ops wm8804_pm;


int wm8804_probe(struct device *dev, struct regmap *regmap);
int wm8804_probe(struct device *dev, struct regmap *regmap);
void wm8804_remove(struct device *dev);
void wm8804_remove(struct device *dev);