ASoC: wm8523: Move device ID verification and reset to I2C probe
authorMark Brown <broonie@opensource.wolfsonmicro.com>
Mon, 10 Sep 2012 09:07:24 +0000 (17:07 +0800)
committerMark Brown <broonie@opensource.wolfsonmicro.com>
Mon, 10 Sep 2012 09:25:47 +0000 (17:25 +0800)
Ensure that we have confirmed that we've got the device in place before
we register with ASoC.

Signed-off-by: Mark Brown <broonie@opensource.wolfsonmicro.com>
sound/soc/codecs/wm8523.c

index d7d5fe6866a68cb40da8fe8d933ca642852a63b0..8d5c276735012361cebb34f24dd123f0564354a3 100644 (file)
@@ -68,11 +68,6 @@ static bool wm8523_volatile_register(struct device *dev, unsigned int reg)
        }
 }
 
-static int wm8523_reset(struct snd_soc_codec *codec)
-{
-       return snd_soc_write(codec, WM8523_DEVICE_ID, 0);
-}
-
 static const DECLARE_TLV_DB_SCALE(dac_tlv, -10000, 25, 0);
 
 static const char *wm8523_zd_count_text[] = {
@@ -409,38 +404,6 @@ static int wm8523_probe(struct snd_soc_codec *codec)
                return ret;
        }
 
-       ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies),
-                                   wm8523->supplies);
-       if (ret != 0) {
-               dev_err(codec->dev, "Failed to enable supplies: %d\n", ret);
-               goto err_get;
-       }
-
-       ret = snd_soc_read(codec, WM8523_DEVICE_ID);
-       if (ret < 0) {
-               dev_err(codec->dev, "Failed to read ID register\n");
-               goto err_enable;
-       }
-       if (ret != 0x8523) {
-               dev_err(codec->dev, "Device is not a WM8523, ID is %x\n", ret);
-               ret = -EINVAL;
-               goto err_enable;
-       }
-
-       ret = snd_soc_read(codec, WM8523_REVISION);
-       if (ret < 0) {
-               dev_err(codec->dev, "Failed to read revision register\n");
-               goto err_enable;
-       }
-       dev_info(codec->dev, "revision %c\n",
-                (ret & WM8523_CHIP_REV_MASK) + 'A');
-
-       ret = wm8523_reset(codec);
-       if (ret < 0) {
-               dev_err(codec->dev, "Failed to issue reset\n");
-               goto err_enable;
-       }
-
        /* Change some default settings - latch VU and enable ZC */
        snd_soc_update_bits(codec, WM8523_DAC_GAINR,
                            WM8523_DACR_VU, WM8523_DACR_VU);
@@ -448,16 +411,7 @@ static int wm8523_probe(struct snd_soc_codec *codec)
 
        wm8523_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
 
-       /* Bias level configuration will have done an extra enable */
-       regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
-
        return 0;
-
-err_enable:
-       regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
-err_get:
-
-       return ret;
 }
 
 static int wm8523_remove(struct snd_soc_codec *codec)
@@ -503,6 +457,7 @@ static __devinit int wm8523_i2c_probe(struct i2c_client *i2c,
                                      const struct i2c_device_id *id)
 {
        struct wm8523_priv *wm8523;
+       unsigned int val;
        int ret, i;
 
        wm8523 = devm_kzalloc(&i2c->dev, sizeof(struct wm8523_priv),
@@ -527,6 +482,40 @@ static __devinit int wm8523_i2c_probe(struct i2c_client *i2c,
                return ret;
        }
 
+       ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies),
+                                   wm8523->supplies);
+       if (ret != 0) {
+               dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret);
+               return ret;
+       }
+
+       ret = regmap_read(wm8523->regmap, WM8523_DEVICE_ID, &val);
+       if (ret < 0) {
+               dev_err(&i2c->dev, "Failed to read ID register\n");
+               goto err_enable;
+       }
+       if (val != 0x8523) {
+               dev_err(&i2c->dev, "Device is not a WM8523, ID is %x\n", ret);
+               ret = -EINVAL;
+               goto err_enable;
+       }
+
+       ret = regmap_read(wm8523->regmap, WM8523_REVISION, &val);
+       if (ret < 0) {
+               dev_err(&i2c->dev, "Failed to read revision register\n");
+               goto err_enable;
+       }
+       dev_info(&i2c->dev, "revision %c\n",
+                (val & WM8523_CHIP_REV_MASK) + 'A');
+
+       ret = regmap_write(wm8523->regmap, WM8523_DEVICE_ID, 0x8523);
+       if (ret != 0) {
+               dev_err(&i2c->dev, "Failed to reset device: %d\n", ret);
+               goto err_enable;
+       }
+
+       regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
+
        i2c_set_clientdata(i2c, wm8523);
 
        ret =  snd_soc_register_codec(&i2c->dev,
@@ -534,6 +523,9 @@ static __devinit int wm8523_i2c_probe(struct i2c_client *i2c,
 
        return ret;
 
+err_enable:
+       regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies);
+       return ret;
 }
 
 static __devexit int wm8523_i2c_remove(struct i2c_client *client)