Commit 891271c2 authored by Mark Brown's avatar Mark Brown

ASoC: Convert wm8804 to direct regmap API usage

The register map for this device is actually fairly sparse so the rbtree
should be beneficial.
Signed-off-by: default avatarMark Brown <broonie@opensource.wolfsonmicro.com>
parent f649f1a8
...@@ -18,6 +18,7 @@ ...@@ -18,6 +18,7 @@
#include <linux/i2c.h> #include <linux/i2c.h>
#include <linux/of_device.h> #include <linux/of_device.h>
#include <linux/spi/spi.h> #include <linux/spi/spi.h>
#include <linux/regmap.h>
#include <linux/regulator/consumer.h> #include <linux/regulator/consumer.h>
#include <linux/slab.h> #include <linux/slab.h>
#include <sound/core.h> #include <sound/core.h>
...@@ -35,45 +36,33 @@ static const char *wm8804_supply_names[WM8804_NUM_SUPPLIES] = { ...@@ -35,45 +36,33 @@ static const char *wm8804_supply_names[WM8804_NUM_SUPPLIES] = {
"DVDD" "DVDD"
}; };
static const u8 wm8804_reg_defs[] = { static const struct reg_default wm8804_reg_defaults[] = {
0x05, /* R0 - RST/DEVID1 */ { 3, 0x21 }, /* R3 - PLL1 */
0x88, /* R1 - DEVID2 */ { 4, 0xFD }, /* R4 - PLL2 */
0x04, /* R2 - DEVREV */ { 5, 0x36 }, /* R5 - PLL3 */
0x21, /* R3 - PLL1 */ { 6, 0x07 }, /* R6 - PLL4 */
0xFD, /* R4 - PLL2 */ { 7, 0x16 }, /* R7 - PLL5 */
0x36, /* R5 - PLL3 */ { 8, 0x18 }, /* R8 - PLL6 */
0x07, /* R6 - PLL4 */ { 9, 0xFF }, /* R9 - SPDMODE */
0x16, /* R7 - PLL5 */ { 10, 0x00 }, /* R10 - INTMASK */
0x18, /* R8 - PLL6 */ { 18, 0x00 }, /* R18 - SPDTX1 */
0xFF, /* R9 - SPDMODE */ { 19, 0x00 }, /* R19 - SPDTX2 */
0x00, /* R10 - INTMASK */ { 20, 0x00 }, /* R20 - SPDTX3 */
0x00, /* R11 - INTSTAT */ { 21, 0x71 }, /* R21 - SPDTX4 */
0x00, /* R12 - SPDSTAT */ { 22, 0x0B }, /* R22 - SPDTX5 */
0x00, /* R13 - RXCHAN1 */ { 23, 0x70 }, /* R23 - GPO0 */
0x00, /* R14 - RXCHAN2 */ { 24, 0x57 }, /* R24 - GPO1 */
0x00, /* R15 - RXCHAN3 */ { 26, 0x42 }, /* R26 - GPO2 */
0x00, /* R16 - RXCHAN4 */ { 27, 0x06 }, /* R27 - AIFTX */
0x00, /* R17 - RXCHAN5 */ { 28, 0x06 }, /* R28 - AIFRX */
0x00, /* R18 - SPDTX1 */ { 29, 0x80 }, /* R29 - SPDRX1 */
0x00, /* R19 - SPDTX2 */ { 30, 0x07 }, /* R30 - PWRDN */
0x00, /* R20 - SPDTX3 */
0x71, /* R21 - SPDTX4 */
0x0B, /* R22 - SPDTX5 */
0x70, /* R23 - GPO0 */
0x57, /* R24 - GPO1 */
0x00, /* R25 */
0x42, /* R26 - GPO2 */
0x06, /* R27 - AIFTX */
0x06, /* R28 - AIFRX */
0x80, /* R29 - SPDRX1 */
0x07, /* R30 - PWRDN */
}; };
struct wm8804_priv { struct wm8804_priv {
enum snd_soc_control_type control_type; 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];
struct snd_soc_codec *codec;
}; };
static int txsrc_get(struct snd_kcontrol *kcontrol, static int txsrc_get(struct snd_kcontrol *kcontrol,
...@@ -94,7 +83,7 @@ static int wm8804_regulator_event_##n(struct notifier_block *nb, \ ...@@ -94,7 +83,7 @@ static int wm8804_regulator_event_##n(struct notifier_block *nb, \
struct wm8804_priv *wm8804 = container_of(nb, struct wm8804_priv, \ struct wm8804_priv *wm8804 = container_of(nb, struct wm8804_priv, \
disable_nb[n]); \ disable_nb[n]); \
if (event & REGULATOR_EVENT_DISABLE) { \ if (event & REGULATOR_EVENT_DISABLE) { \
wm8804->codec->cache_sync = 1; \ regcache_mark_dirty(wm8804->regmap); \
} \ } \
return 0; \ return 0; \
} }
...@@ -176,7 +165,7 @@ static int txsrc_put(struct snd_kcontrol *kcontrol, ...@@ -176,7 +165,7 @@ static int txsrc_put(struct snd_kcontrol *kcontrol,
return 0; return 0;
} }
static int wm8804_volatile(struct snd_soc_codec *codec, unsigned int reg) static bool wm8804_volatile(struct device *dev, unsigned int reg)
{ {
switch (reg) { switch (reg) {
case WM8804_RST_DEVID1: case WM8804_RST_DEVID1:
...@@ -189,12 +178,10 @@ static int wm8804_volatile(struct snd_soc_codec *codec, unsigned int reg) ...@@ -189,12 +178,10 @@ static int wm8804_volatile(struct snd_soc_codec *codec, unsigned int reg)
case WM8804_RXCHAN3: case WM8804_RXCHAN3:
case WM8804_RXCHAN4: case WM8804_RXCHAN4:
case WM8804_RXCHAN5: case WM8804_RXCHAN5:
return 1; return true;
default: default:
break; return false;
} }
return 0;
} }
static int wm8804_reset(struct snd_soc_codec *codec) static int wm8804_reset(struct snd_soc_codec *codec)
...@@ -506,7 +493,7 @@ static int wm8804_set_bias_level(struct snd_soc_codec *codec, ...@@ -506,7 +493,7 @@ static int wm8804_set_bias_level(struct snd_soc_codec *codec,
ret); ret);
return ret; return ret;
} }
snd_soc_cache_sync(codec); regcache_sync(wm8804->regmap);
} }
/* power down the OSC and the PLL */ /* power down the OSC and the PLL */
snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9); snd_soc_update_bits(codec, WM8804_PWRDN, 0x9, 0x9);
...@@ -561,11 +548,11 @@ static int wm8804_probe(struct snd_soc_codec *codec) ...@@ -561,11 +548,11 @@ static int wm8804_probe(struct snd_soc_codec *codec)
int i, id1, id2, ret; int i, id1, id2, ret;
wm8804 = snd_soc_codec_get_drvdata(codec); wm8804 = snd_soc_codec_get_drvdata(codec);
wm8804->codec = codec;
codec->dapm.idle_bias_off = 1; codec->dapm.idle_bias_off = 1;
codec->control_data = wm8804->regmap;
ret = snd_soc_codec_set_cache_io(codec, 8, 8, wm8804->control_type); ret = snd_soc_codec_set_cache_io(codec, 8, 8, SND_SOC_REGMAP);
if (ret < 0) { if (ret < 0) {
dev_err(codec->dev, "Failed to set cache i/o: %d\n", ret); dev_err(codec->dev, "Failed to set cache i/o: %d\n", ret);
return ret; return ret;
...@@ -618,8 +605,7 @@ static int wm8804_probe(struct snd_soc_codec *codec) ...@@ -618,8 +605,7 @@ static int wm8804_probe(struct snd_soc_codec *codec)
id2 = (id2 << 8) | id1; id2 = (id2 << 8) | id1;
if (id2 != ((wm8804_reg_defs[WM8804_DEVID2] << 8) if (id2 != 0x8805) {
| wm8804_reg_defs[WM8804_RST_DEVID1])) {
dev_err(codec->dev, "Invalid device ID: %#x\n", id2); dev_err(codec->dev, "Invalid device ID: %#x\n", id2);
ret = -EINVAL; ret = -EINVAL;
goto err_reg_enable; goto err_reg_enable;
...@@ -692,10 +678,6 @@ static struct snd_soc_codec_driver soc_codec_dev_wm8804 = { ...@@ -692,10 +678,6 @@ static struct snd_soc_codec_driver soc_codec_dev_wm8804 = {
.suspend = wm8804_suspend, .suspend = wm8804_suspend,
.resume = wm8804_resume, .resume = wm8804_resume,
.set_bias_level = wm8804_set_bias_level, .set_bias_level = wm8804_set_bias_level,
.reg_cache_size = ARRAY_SIZE(wm8804_reg_defs),
.reg_word_size = sizeof(u8),
.reg_cache_default = wm8804_reg_defs,
.volatile_register = wm8804_volatile,
.controls = wm8804_snd_controls, .controls = wm8804_snd_controls,
.num_controls = ARRAY_SIZE(wm8804_snd_controls), .num_controls = ARRAY_SIZE(wm8804_snd_controls),
...@@ -707,6 +689,18 @@ static const struct of_device_id wm8804_of_match[] = { ...@@ -707,6 +689,18 @@ static const struct of_device_id wm8804_of_match[] = {
}; };
MODULE_DEVICE_TABLE(of, wm8804_of_match); MODULE_DEVICE_TABLE(of, wm8804_of_match);
static struct regmap_config wm8804_regmap_config = {
.reg_bits = 8,
.val_bits = 8,
.max_register = WM8804_MAX_REGISTER,
.volatile_reg = wm8804_volatile,
.cache_type = REGCACHE_RBTREE,
.reg_defaults = wm8804_reg_defaults,
.num_reg_defaults = ARRAY_SIZE(wm8804_reg_defaults),
};
#if defined(CONFIG_SPI_MASTER) #if defined(CONFIG_SPI_MASTER)
static int __devinit wm8804_spi_probe(struct spi_device *spi) static int __devinit wm8804_spi_probe(struct spi_device *spi)
{ {
...@@ -717,7 +711,12 @@ static int __devinit wm8804_spi_probe(struct spi_device *spi) ...@@ -717,7 +711,12 @@ static int __devinit wm8804_spi_probe(struct spi_device *spi)
if (!wm8804) if (!wm8804)
return -ENOMEM; return -ENOMEM;
wm8804->control_type = SND_SOC_SPI; wm8804->regmap = regmap_init_spi(spi, &wm8804_regmap_config);
if (IS_ERR(wm8804->regmap)) {
ret = PTR_ERR(wm8804->regmap);
return ret;
}
spi_set_drvdata(spi, wm8804); spi_set_drvdata(spi, wm8804);
ret = snd_soc_register_codec(&spi->dev, ret = snd_soc_register_codec(&spi->dev,
...@@ -728,7 +727,9 @@ static int __devinit wm8804_spi_probe(struct spi_device *spi) ...@@ -728,7 +727,9 @@ static int __devinit wm8804_spi_probe(struct spi_device *spi)
static int __devexit wm8804_spi_remove(struct spi_device *spi) static int __devexit wm8804_spi_remove(struct spi_device *spi)
{ {
struct wm8804_priv *wm8804 = spi_get_drvdata(spi);
snd_soc_unregister_codec(&spi->dev); snd_soc_unregister_codec(&spi->dev);
regmap_exit(wm8804->regmap);
return 0; return 0;
} }
...@@ -754,18 +755,26 @@ static __devinit int wm8804_i2c_probe(struct i2c_client *i2c, ...@@ -754,18 +755,26 @@ static __devinit int wm8804_i2c_probe(struct i2c_client *i2c,
if (!wm8804) if (!wm8804)
return -ENOMEM; return -ENOMEM;
wm8804->control_type = SND_SOC_I2C;
i2c_set_clientdata(i2c, wm8804); i2c_set_clientdata(i2c, wm8804);
ret = snd_soc_register_codec(&i2c->dev, ret = snd_soc_register_codec(&i2c->dev,
&soc_codec_dev_wm8804, &wm8804_dai, 1); &soc_codec_dev_wm8804, &wm8804_dai, 1);
if (ret != 0)
goto err;
return 0;
err:
regmap_exit(wm8804->regmap);
return ret; return ret;
} }
static __devexit int wm8804_i2c_remove(struct i2c_client *client) static __devexit int wm8804_i2c_remove(struct i2c_client *i2c)
{ {
snd_soc_unregister_codec(&client->dev); struct wm8804_priv *wm8804 = i2c_get_clientdata(i2c);
snd_soc_unregister_codec(&i2c->dev);
regmap_exit(wm8804->regmap);
return 0; return 0;
} }
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment