Signed-off-by: Daniel Mack daniel@caiaq.de Cc: Mark Brown broonie@opensource.wolfsonmicro.com Cc: Timur Tabi timur@freescale.com Cc: Liam Girdwood lrg@slimlogic.co.uk --- sound/soc/codecs/cs4270.c | 90 +++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 90 insertions(+), 0 deletions(-)
diff --git a/sound/soc/codecs/cs4270.c b/sound/soc/codecs/cs4270.c index 8069023..e79d30d 100644 --- a/sound/soc/codecs/cs4270.c +++ b/sound/soc/codecs/cs4270.c @@ -28,6 +28,7 @@ #include <sound/initval.h> #include <linux/i2c.h> #include <linux/delay.h> +#include <linux/regulator/consumer.h>
#include "cs4270.h"
@@ -114,6 +115,11 @@ struct cs4270_private { unsigned int mode; /* The mode (I2S or left-justified) */ unsigned int slave_mode; unsigned int manual_mute; + + /* power domain regulators (optional) */ + struct regulator *va_reg; + struct regulator *vd_reg; + struct regulator *vlc_reg; };
/** @@ -458,6 +464,56 @@ static int cs4270_hw_params(struct snd_pcm_substream *substream, }
/** + * cs4270_set_bias_level - catches BIAS level changes + * @dai: the SOC DAI + * @level: the new BIAS level + * + * This function controls the voltage regulators to properly + * power up/down the voltage regulator domains + */ + +static int cs4270_set_bias_level(struct snd_soc_codec *codec, + enum snd_soc_bias_level level) +{ + int ret; + struct cs4270_private *cs4270 = codec->private_data; + + switch (level) { + case SND_SOC_BIAS_ON: + ret = regulator_enable(cs4270->vd_reg); + if (ret < 0) + return ret; + + ret = regulator_enable(cs4270->vlc_reg); + if (ret < 0) + return ret; + /* fall thru */ + case SND_SOC_BIAS_PREPARE: + ret = regulator_enable(cs4270->va_reg); + if (ret < 0) + return ret; + break; + case SND_SOC_BIAS_STANDBY: + if (codec->bias_level == SND_SOC_BIAS_OFF) { + /* OFF -> STANDBY */ + ret = regulator_enable(cs4270->va_reg); + if (ret < 0) + return ret; + } else + regulator_disable(cs4270->va_reg); + break; + case SND_SOC_BIAS_OFF: + regulator_disable(cs4270->va_reg); + regulator_disable(cs4270->vd_reg); + regulator_disable(cs4270->vlc_reg); + break; + } + + codec->bias_level = level; + return 0; +} + +/** * cs4270_dai_mute - enable/disable the CS4270 external mute * @dai: the SOC DAI * @mute: 0 = disable mute, 1 = enable mute @@ -579,6 +635,7 @@ static int cs4270_probe(struct platform_device *pdev) { struct snd_soc_device *socdev = platform_get_drvdata(pdev); struct snd_soc_codec *codec = cs4270_codec; + struct cs4270_private *cs4270 = codec->private_data; int ret;
/* Connect the codec to the socdev. snd_soc_new_pcms() needs this. */ @@ -599,6 +656,20 @@ static int cs4270_probe(struct platform_device *pdev) goto error_free_pcms; }
+ /* get the power supply regulators */ + cs4270->va_reg = regulator_get(&pdev->dev, "va"); + cs4270->vd_reg = regulator_get(&pdev->dev, "vd"); + cs4270->vlc_reg = regulator_get(&pdev->dev, "vlc"); + + if (IS_ERR(cs4270->va_reg) || + IS_ERR(cs4270->vd_reg) || + IS_ERR(cs4270->vlc_reg)) { + dev_err(codec->dev, "failed to get supplies %s\n", dev_name(codec->dev)); + goto error_free_pcms; + } + + cs4270_set_bias_level(codec, SND_SOC_BIAS_STANDBY); + /* And finally, register the socdev */ ret = snd_soc_init_card(socdev); if (ret < 0) { @@ -609,6 +680,10 @@ static int cs4270_probe(struct platform_device *pdev) return 0;
error_free_pcms: + regulator_put(cs4270->va_reg); + regulator_put(cs4270->vd_reg); + regulator_put(cs4270->vlc_reg); + snd_soc_free_pcms(socdev);
return ret; @@ -623,9 +698,15 @@ error_free_pcms: static int cs4270_remove(struct platform_device *pdev) { struct snd_soc_device *socdev = platform_get_drvdata(pdev); + struct snd_soc_codec *codec = cs4270_codec; + struct cs4270_private *cs4270 = codec->private_data;
snd_soc_free_pcms(socdev);
+ regulator_put(cs4270->va_reg); + regulator_put(cs4270->vd_reg); + regulator_put(cs4270->vlc_reg); + return 0; };
@@ -699,6 +780,8 @@ static int cs4270_i2c_probe(struct i2c_client *i2c_client, codec->write = cs4270_i2c_write; codec->reg_cache = cs4270->reg_cache; codec->reg_cache_size = CS4270_NUMREGS; + codec->bias_level = SND_SOC_BIAS_OFF; + codec->set_bias_level = cs4270_set_bias_level;
/* The I2C interface is set up, so pre-fill our register cache */
@@ -824,6 +907,8 @@ static int cs4270_soc_suspend(struct platform_device *pdev, pm_message_t mesg) struct snd_soc_codec *codec = cs4270_codec; int reg = snd_soc_read(codec, CS4270_PWRCTL) | CS4270_PWRCTL_PDN_ALL;
+ cs4270_set_bias_level(codec, SND_SOC_BIAS_OFF); + return snd_soc_write(codec, CS4270_PWRCTL, reg); }
@@ -833,6 +918,11 @@ static int cs4270_soc_resume(struct platform_device *pdev) struct i2c_client *i2c_client = codec->control_data; int reg;
+ cs4270_set_bias_level(codec, SND_SOC_BIAS_STANDBY); + + if (codec->suspend_bias_level == SND_SOC_BIAS_ON) + cs4270_set_bias_level(codec, SND_SOC_BIAS_ON); + /* In case the device was put to hard reset during sleep, we need to * wait 500ns here before any I2C communication. */ ndelay(500);