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: Mark Brown <broonie@opensource.wolfsonmicro.com>
This commit is contained in:
		
					parent
					
						
							
								f649f1a8aa
							
						
					
				
			
			
				commit
				
					
						891271c28f
					
				
			
		
					 1 changed files with 62 additions and 53 deletions
				
			
		|  | @ -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] = { | ||||||
| 	"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, \ | ||||||
| 	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, | ||||||
| 	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) | ||||||
| 	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, | ||||||
| 					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) | ||||||
| 	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) | ||||||
| 
 | 
 | ||||||
| 	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 = { | ||||||
| 	.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[] = { | ||||||
| }; | }; | ||||||
| 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) | ||||||
| 	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) | ||||||
| 
 | 
 | ||||||
| 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, | ||||||
| 	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; | ||||||
| } | } | ||||||
|  |  | ||||||
		Loading…
	
	Add table
		Add a link
		
	
		Reference in a new issue
	
	 Mark Brown
				Mark Brown