1 files changed, 70 insertions, 48 deletions

diff --git a/sound/soc/codecs/tlv320aic3x.c b/sound/soc/codecs/tlv320aic3x.c
index 4a6d56c3fed9..71a69908ccf6 100644
--- a/sound/soc/codecs/tlv320aic3x.c
+++ b/sound/soc/codecs/tlv320aic3x.c
@@ -38,6 +38,8 @@
 #include <linux/delay.h>
 #include <linux/pm.h>
 #include <linux/i2c.h>
+#include <linux/gpio.h>
+#include <linux/regulator/consumer.h>
 #include <linux/platform_device.h>
 #include <linux/slab.h>
 #include <sound/core.h>
@@ -47,16 +49,25 @@
 #include <sound/soc-dapm.h>
 #include <sound/initval.h>
 #include <sound/tlv.h>
+#include <sound/tlv320aic3x.h>
 
 #include "tlv320aic3x.h"
 
-#define AIC3X_VERSION "0.2"
+#define AIC3X_NUM_SUPPLIES      4
+static const char *aic3x_supply_names[AIC3X_NUM_SUPPLIES] = {
+        "IOVDD",        /* I/O Voltage */
+        "DVDD",         /* Digital Core Voltage */
+        "AVDD",         /* Analog DAC Voltage */
+        "DRVDD",        /* ADC Analog and Output Driver Voltage */
+};
 
 /* codec private data */
 struct aic3x_priv {
         struct snd_soc_codec codec;
+        struct regulator_bulk_data supplies[AIC3X_NUM_SUPPLIES];
         unsigned int sysclk;
         int master;
+        int gpio_reset;
 };
 
 /*
@@ -764,7 +775,7 @@ static int aic3x_hw_params(struct snd_pcm_substream *substream,
         struct snd_soc_pcm_runtime *rtd = substream->private_data;
         struct snd_soc_device *socdev = rtd->socdev;
         struct snd_soc_codec *codec = socdev->card->codec;
-        struct aic3x_priv *aic3x = codec->private_data;
+        struct aic3x_priv *aic3x = snd_soc_codec_get_drvdata(codec);
         int codec_clk = 0, bypass_pll = 0, fsref, last_clk = 0;
         u8 data, j, r, p, pll_q, pll_p = 1, pll_r = 1, pll_j = 1;
         u16 d, pll_d = 1;
@@ -931,7 +942,7 @@ static int aic3x_set_dai_sysclk(struct snd_soc_dai *codec_dai,
                                 int clk_id, unsigned int freq, int dir)
 {
         struct snd_soc_codec *codec = codec_dai->codec;
-        struct aic3x_priv *aic3x = codec->private_data;
+        struct aic3x_priv *aic3x = snd_soc_codec_get_drvdata(codec);
 
         aic3x->sysclk = freq;
         return 0;
@@ -941,7 +952,7 @@ static int aic3x_set_dai_fmt(struct snd_soc_dai *codec_dai,
                              unsigned int fmt)
 {
         struct snd_soc_codec *codec = codec_dai->codec;
-        struct aic3x_priv *aic3x = codec->private_data;
+        struct aic3x_priv *aic3x = snd_soc_codec_get_drvdata(codec);
         u8 iface_areg, iface_breg;
         int delay = 0;
 
@@ -995,12 +1006,13 @@ static int aic3x_set_dai_fmt(struct snd_soc_dai *codec_dai,
 static int aic3x_set_bias_level(struct snd_soc_codec *codec,
                                 enum snd_soc_bias_level level)
 {
-        struct aic3x_priv *aic3x = codec->private_data;
+        struct aic3x_priv *aic3x = snd_soc_codec_get_drvdata(codec);
         u8 reg;
 
         switch (level) {
         case SND_SOC_BIAS_ON:
-                /* all power is driven by DAPM system */
+                break;
+        case SND_SOC_BIAS_PREPARE:
                 if (aic3x->master) {
                         /* enable pll */
                         reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
@@ -1008,48 +1020,9 @@ static int aic3x_set_bias_level(struct snd_soc_codec *codec,
                                     reg | PLL_ENABLE);
                 }
                 break;
-        case SND_SOC_BIAS_PREPARE:
-                break;
         case SND_SOC_BIAS_STANDBY:
-                /*
-                 * all power is driven by DAPM system,
-                 * so output power is safe if bypass was set
-                 */
-                if (aic3x->master) {
-                        /* disable pll */
-                        reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
-                        aic3x_write(codec, AIC3X_PLL_PROGA_REG,
-                                    reg & ~PLL_ENABLE);
-                }
-                break;
+                /* fall through and disable pll */
         case SND_SOC_BIAS_OFF:
-                /* force all power off */
-                reg = aic3x_read_reg_cache(codec, LINE1L_2_LADC_CTRL);
-                aic3x_write(codec, LINE1L_2_LADC_CTRL, reg & ~LADC_PWR_ON);
-                reg = aic3x_read_reg_cache(codec, LINE1R_2_RADC_CTRL);
-                aic3x_write(codec, LINE1R_2_RADC_CTRL, reg & ~RADC_PWR_ON);
-
-                reg = aic3x_read_reg_cache(codec, DAC_PWR);
-                aic3x_write(codec, DAC_PWR, reg & ~(LDAC_PWR_ON | RDAC_PWR_ON));
-
-                reg = aic3x_read_reg_cache(codec, HPLOUT_CTRL);
-                aic3x_write(codec, HPLOUT_CTRL, reg & ~HPLOUT_PWR_ON);
-                reg = aic3x_read_reg_cache(codec, HPROUT_CTRL);
-                aic3x_write(codec, HPROUT_CTRL, reg & ~HPROUT_PWR_ON);
-
-                reg = aic3x_read_reg_cache(codec, HPLCOM_CTRL);
-                aic3x_write(codec, HPLCOM_CTRL, reg & ~HPLCOM_PWR_ON);
-                reg = aic3x_read_reg_cache(codec, HPRCOM_CTRL);
-                aic3x_write(codec, HPRCOM_CTRL, reg & ~HPRCOM_PWR_ON);
-
-                reg = aic3x_read_reg_cache(codec, MONOLOPM_CTRL);
-                aic3x_write(codec, MONOLOPM_CTRL, reg & ~MONOLOPM_PWR_ON);
-
-                reg = aic3x_read_reg_cache(codec, LLOPM_CTRL);
-                aic3x_write(codec, LLOPM_CTRL, reg & ~LLOPM_PWR_ON);
-                reg = aic3x_read_reg_cache(codec, RLOPM_CTRL);
-                aic3x_write(codec, RLOPM_CTRL, reg & ~RLOPM_PWR_ON);
-
                 if (aic3x->master) {
                         /* disable pll */
                         reg = aic3x_read_reg_cache(codec, AIC3X_PLL_PROGA_REG);
@@ -1171,7 +1144,7 @@ static int aic3x_resume(struct platform_device *pdev)
                 codec->hw_write(codec->control_data, data, 2);
         }
 
-        aic3x_set_bias_level(codec, codec->suspend_bias_level);
+        aic3x_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 
         return 0;
 }
@@ -1309,6 +1282,13 @@ static int aic3x_unregister(struct aic3x_priv *aic3x)
         snd_soc_unregister_dai(&aic3x_dai);
         snd_soc_unregister_codec(&aic3x->codec);
 
+        if (aic3x->gpio_reset >= 0) {
+                gpio_set_value(aic3x->gpio_reset, 0);
+                gpio_free(aic3x->gpio_reset);
+        }
+        regulator_bulk_disable(ARRAY_SIZE(aic3x->supplies), aic3x->supplies);
+        regulator_bulk_free(ARRAY_SIZE(aic3x->supplies), aic3x->supplies);
+
         kfree(aic3x);
         aic3x_codec = NULL;
 
@@ -1330,6 +1310,8 @@ static int aic3x_i2c_probe(struct i2c_client *i2c,
 {
         struct snd_soc_codec *codec;
         struct aic3x_priv *aic3x;
+        struct aic3x_pdata *pdata = i2c->dev.platform_data;
+        int ret, i;
 
         aic3x = kzalloc(sizeof(struct aic3x_priv), GFP_KERNEL);
         if (aic3x == NULL) {
@@ -1339,13 +1321,53 @@ static int aic3x_i2c_probe(struct i2c_client *i2c,
 
         codec = &aic3x->codec;
         codec->dev = &i2c->dev;
-        codec->private_data = aic3x;
+        snd_soc_codec_set_drvdata(codec, aic3x);
         codec->control_data = i2c;
         codec->hw_write = (hw_write_t) i2c_master_send;
 
         i2c_set_clientdata(i2c, aic3x);
 
+        aic3x->gpio_reset = -1;
+        if (pdata && pdata->gpio_reset >= 0) {
+                ret = gpio_request(pdata->gpio_reset, "tlv320aic3x reset");
+                if (ret != 0)
+                        goto err_gpio;
+                aic3x->gpio_reset = pdata->gpio_reset;
+                gpio_direction_output(aic3x->gpio_reset, 0);
+        }
+
+        for (i = 0; i < ARRAY_SIZE(aic3x->supplies); i++)
+                aic3x->supplies[i].supply = aic3x_supply_names[i];
+
+        ret = regulator_bulk_get(codec->dev, ARRAY_SIZE(aic3x->supplies),
+                                 aic3x->supplies);
+        if (ret != 0) {
+                dev_err(codec->dev, "Failed to request supplies: %d\n", ret);
+                goto err_get;
+        }
+
+        ret = regulator_bulk_enable(ARRAY_SIZE(aic3x->supplies),
+                                    aic3x->supplies);
+        if (ret != 0) {
+                dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
+                goto err_enable;
+        }
+
+        if (aic3x->gpio_reset >= 0) {
+                udelay(1);
+                gpio_set_value(aic3x->gpio_reset, 1);
+        }
+
         return aic3x_register(codec);
+
+err_enable:
+        regulator_bulk_free(ARRAY_SIZE(aic3x->supplies), aic3x->supplies);
+err_get:
+        if (aic3x->gpio_reset >= 0)
+                gpio_free(aic3x->gpio_reset);
+err_gpio:
+        kfree(aic3x);
+        return ret;
 }
 
 static int aic3x_i2c_remove(struct i2c_client *client)