1 /* 2 * wm8523.c -- WM8523 ALSA SoC Audio driver 3 * 4 * Copyright 2009 Wolfson Microelectronics plc 5 * 6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 7 * 8 * 9 * This program is free software; you can redistribute it and/or modify 10 * it under the terms of the GNU General Public License version 2 as 11 * published by the Free Software Foundation. 12 */ 13 14 #include <linux/module.h> 15 #include <linux/moduleparam.h> 16 #include <linux/init.h> 17 #include <linux/delay.h> 18 #include <linux/pm.h> 19 #include <linux/i2c.h> 20 #include <linux/regmap.h> 21 #include <linux/regulator/consumer.h> 22 #include <linux/slab.h> 23 #include <linux/of_device.h> 24 #include <sound/core.h> 25 #include <sound/pcm.h> 26 #include <sound/pcm_params.h> 27 #include <sound/soc.h> 28 #include <sound/initval.h> 29 #include <sound/tlv.h> 30 31 #include "wm8523.h" 32 33 #define WM8523_NUM_SUPPLIES 2 34 static const char *wm8523_supply_names[WM8523_NUM_SUPPLIES] = { 35 "AVDD", 36 "LINEVDD", 37 }; 38 39 #define WM8523_NUM_RATES 7 40 41 /* codec private data */ 42 struct wm8523_priv { 43 struct regmap *regmap; 44 struct regulator_bulk_data supplies[WM8523_NUM_SUPPLIES]; 45 unsigned int sysclk; 46 unsigned int rate_constraint_list[WM8523_NUM_RATES]; 47 struct snd_pcm_hw_constraint_list rate_constraint; 48 }; 49 50 static const struct reg_default wm8523_reg_defaults[] = { 51 { 2, 0x0000 }, /* R2 - PSCTRL1 */ 52 { 3, 0x1812 }, /* R3 - AIF_CTRL1 */ 53 { 4, 0x0000 }, /* R4 - AIF_CTRL2 */ 54 { 5, 0x0001 }, /* R5 - DAC_CTRL3 */ 55 { 6, 0x0190 }, /* R6 - DAC_GAINL */ 56 { 7, 0x0190 }, /* R7 - DAC_GAINR */ 57 { 8, 0x0000 }, /* R8 - ZERO_DETECT */ 58 }; 59 60 static bool wm8523_volatile_register(struct device *dev, unsigned int reg) 61 { 62 switch (reg) { 63 case WM8523_DEVICE_ID: 64 case WM8523_REVISION: 65 return true; 66 default: 67 return false; 68 } 69 } 70 71 static const DECLARE_TLV_DB_SCALE(dac_tlv, -10000, 25, 0); 72 73 static const char *wm8523_zd_count_text[] = { 74 "1024", 75 "2048", 76 }; 77 78 static SOC_ENUM_SINGLE_DECL(wm8523_zc_count, WM8523_ZERO_DETECT, 0, 79 wm8523_zd_count_text); 80 81 static const struct snd_kcontrol_new wm8523_controls[] = { 82 SOC_DOUBLE_R_TLV("Playback Volume", WM8523_DAC_GAINL, WM8523_DAC_GAINR, 83 0, 448, 0, dac_tlv), 84 SOC_SINGLE("ZC Switch", WM8523_DAC_CTRL3, 4, 1, 0), 85 SOC_SINGLE("Playback Deemphasis Switch", WM8523_AIF_CTRL1, 8, 1, 0), 86 SOC_DOUBLE("Playback Switch", WM8523_DAC_CTRL3, 2, 3, 1, 1), 87 SOC_SINGLE("Volume Ramp Up Switch", WM8523_DAC_CTRL3, 1, 1, 0), 88 SOC_SINGLE("Volume Ramp Down Switch", WM8523_DAC_CTRL3, 0, 1, 0), 89 SOC_ENUM("Zero Detect Count", wm8523_zc_count), 90 }; 91 92 static const struct snd_soc_dapm_widget wm8523_dapm_widgets[] = { 93 SND_SOC_DAPM_DAC("DAC", "Playback", SND_SOC_NOPM, 0, 0), 94 SND_SOC_DAPM_OUTPUT("LINEVOUTL"), 95 SND_SOC_DAPM_OUTPUT("LINEVOUTR"), 96 }; 97 98 static const struct snd_soc_dapm_route wm8523_dapm_routes[] = { 99 { "LINEVOUTL", NULL, "DAC" }, 100 { "LINEVOUTR", NULL, "DAC" }, 101 }; 102 103 static struct { 104 int value; 105 int ratio; 106 } lrclk_ratios[WM8523_NUM_RATES] = { 107 { 1, 128 }, 108 { 2, 192 }, 109 { 3, 256 }, 110 { 4, 384 }, 111 { 5, 512 }, 112 { 6, 768 }, 113 { 7, 1152 }, 114 }; 115 116 static int wm8523_startup(struct snd_pcm_substream *substream, 117 struct snd_soc_dai *dai) 118 { 119 struct snd_soc_codec *codec = dai->codec; 120 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec); 121 122 /* The set of sample rates that can be supported depends on the 123 * MCLK supplied to the CODEC - enforce this. 124 */ 125 if (!wm8523->sysclk) { 126 dev_err(codec->dev, 127 "No MCLK configured, call set_sysclk() on init\n"); 128 return -EINVAL; 129 } 130 131 snd_pcm_hw_constraint_list(substream->runtime, 0, 132 SNDRV_PCM_HW_PARAM_RATE, 133 &wm8523->rate_constraint); 134 135 return 0; 136 } 137 138 static int wm8523_hw_params(struct snd_pcm_substream *substream, 139 struct snd_pcm_hw_params *params, 140 struct snd_soc_dai *dai) 141 { 142 struct snd_soc_codec *codec = dai->codec; 143 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec); 144 int i; 145 u16 aifctrl1 = snd_soc_read(codec, WM8523_AIF_CTRL1); 146 u16 aifctrl2 = snd_soc_read(codec, WM8523_AIF_CTRL2); 147 148 /* Find a supported LRCLK ratio */ 149 for (i = 0; i < ARRAY_SIZE(lrclk_ratios); i++) { 150 if (wm8523->sysclk / params_rate(params) == 151 lrclk_ratios[i].ratio) 152 break; 153 } 154 155 /* Should never happen, should be handled by constraints */ 156 if (i == ARRAY_SIZE(lrclk_ratios)) { 157 dev_err(codec->dev, "MCLK/fs ratio %d unsupported\n", 158 wm8523->sysclk / params_rate(params)); 159 return -EINVAL; 160 } 161 162 aifctrl2 &= ~WM8523_SR_MASK; 163 aifctrl2 |= lrclk_ratios[i].value; 164 165 aifctrl1 &= ~WM8523_WL_MASK; 166 switch (params_width(params)) { 167 case 16: 168 break; 169 case 20: 170 aifctrl1 |= 0x8; 171 break; 172 case 24: 173 aifctrl1 |= 0x10; 174 break; 175 case 32: 176 aifctrl1 |= 0x18; 177 break; 178 } 179 180 snd_soc_write(codec, WM8523_AIF_CTRL1, aifctrl1); 181 snd_soc_write(codec, WM8523_AIF_CTRL2, aifctrl2); 182 183 return 0; 184 } 185 186 static int wm8523_set_dai_sysclk(struct snd_soc_dai *codec_dai, 187 int clk_id, unsigned int freq, int dir) 188 { 189 struct snd_soc_codec *codec = codec_dai->codec; 190 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec); 191 unsigned int val; 192 int i; 193 194 wm8523->sysclk = freq; 195 196 wm8523->rate_constraint.count = 0; 197 for (i = 0; i < ARRAY_SIZE(lrclk_ratios); i++) { 198 val = freq / lrclk_ratios[i].ratio; 199 /* Check that it's a standard rate since core can't 200 * cope with others and having the odd rates confuses 201 * constraint matching. 202 */ 203 switch (val) { 204 case 8000: 205 case 11025: 206 case 16000: 207 case 22050: 208 case 32000: 209 case 44100: 210 case 48000: 211 case 64000: 212 case 88200: 213 case 96000: 214 case 176400: 215 case 192000: 216 dev_dbg(codec->dev, "Supported sample rate: %dHz\n", 217 val); 218 wm8523->rate_constraint_list[i] = val; 219 wm8523->rate_constraint.count++; 220 break; 221 default: 222 dev_dbg(codec->dev, "Skipping sample rate: %dHz\n", 223 val); 224 } 225 } 226 227 /* Need at least one supported rate... */ 228 if (wm8523->rate_constraint.count == 0) 229 return -EINVAL; 230 231 return 0; 232 } 233 234 235 static int wm8523_set_dai_fmt(struct snd_soc_dai *codec_dai, 236 unsigned int fmt) 237 { 238 struct snd_soc_codec *codec = codec_dai->codec; 239 u16 aifctrl1 = snd_soc_read(codec, WM8523_AIF_CTRL1); 240 241 aifctrl1 &= ~(WM8523_BCLK_INV_MASK | WM8523_LRCLK_INV_MASK | 242 WM8523_FMT_MASK | WM8523_AIF_MSTR_MASK); 243 244 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 245 case SND_SOC_DAIFMT_CBM_CFM: 246 aifctrl1 |= WM8523_AIF_MSTR; 247 break; 248 case SND_SOC_DAIFMT_CBS_CFS: 249 break; 250 default: 251 return -EINVAL; 252 } 253 254 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 255 case SND_SOC_DAIFMT_I2S: 256 aifctrl1 |= 0x0002; 257 break; 258 case SND_SOC_DAIFMT_RIGHT_J: 259 break; 260 case SND_SOC_DAIFMT_LEFT_J: 261 aifctrl1 |= 0x0001; 262 break; 263 case SND_SOC_DAIFMT_DSP_A: 264 aifctrl1 |= 0x0003; 265 break; 266 case SND_SOC_DAIFMT_DSP_B: 267 aifctrl1 |= 0x0023; 268 break; 269 default: 270 return -EINVAL; 271 } 272 273 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 274 case SND_SOC_DAIFMT_NB_NF: 275 break; 276 case SND_SOC_DAIFMT_IB_IF: 277 aifctrl1 |= WM8523_BCLK_INV | WM8523_LRCLK_INV; 278 break; 279 case SND_SOC_DAIFMT_IB_NF: 280 aifctrl1 |= WM8523_BCLK_INV; 281 break; 282 case SND_SOC_DAIFMT_NB_IF: 283 aifctrl1 |= WM8523_LRCLK_INV; 284 break; 285 default: 286 return -EINVAL; 287 } 288 289 snd_soc_write(codec, WM8523_AIF_CTRL1, aifctrl1); 290 291 return 0; 292 } 293 294 static int wm8523_set_bias_level(struct snd_soc_codec *codec, 295 enum snd_soc_bias_level level) 296 { 297 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec); 298 int ret; 299 300 switch (level) { 301 case SND_SOC_BIAS_ON: 302 break; 303 304 case SND_SOC_BIAS_PREPARE: 305 /* Full power on */ 306 snd_soc_update_bits(codec, WM8523_PSCTRL1, 307 WM8523_SYS_ENA_MASK, 3); 308 break; 309 310 case SND_SOC_BIAS_STANDBY: 311 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) { 312 ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies), 313 wm8523->supplies); 314 if (ret != 0) { 315 dev_err(codec->dev, 316 "Failed to enable supplies: %d\n", 317 ret); 318 return ret; 319 } 320 321 /* Sync back default/cached values */ 322 regcache_sync(wm8523->regmap); 323 324 /* Initial power up */ 325 snd_soc_update_bits(codec, WM8523_PSCTRL1, 326 WM8523_SYS_ENA_MASK, 1); 327 328 msleep(100); 329 } 330 331 /* Power up to mute */ 332 snd_soc_update_bits(codec, WM8523_PSCTRL1, 333 WM8523_SYS_ENA_MASK, 2); 334 335 break; 336 337 case SND_SOC_BIAS_OFF: 338 /* The chip runs through the power down sequence for us. */ 339 snd_soc_update_bits(codec, WM8523_PSCTRL1, 340 WM8523_SYS_ENA_MASK, 0); 341 msleep(100); 342 343 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), 344 wm8523->supplies); 345 break; 346 } 347 codec->dapm.bias_level = level; 348 return 0; 349 } 350 351 #define WM8523_RATES SNDRV_PCM_RATE_8000_192000 352 353 #define WM8523_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 354 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 355 356 static const struct snd_soc_dai_ops wm8523_dai_ops = { 357 .startup = wm8523_startup, 358 .hw_params = wm8523_hw_params, 359 .set_sysclk = wm8523_set_dai_sysclk, 360 .set_fmt = wm8523_set_dai_fmt, 361 }; 362 363 static struct snd_soc_dai_driver wm8523_dai = { 364 .name = "wm8523-hifi", 365 .playback = { 366 .stream_name = "Playback", 367 .channels_min = 2, /* Mono modes not yet supported */ 368 .channels_max = 2, 369 .rates = WM8523_RATES, 370 .formats = WM8523_FORMATS, 371 }, 372 .ops = &wm8523_dai_ops, 373 }; 374 375 static int wm8523_probe(struct snd_soc_codec *codec) 376 { 377 struct wm8523_priv *wm8523 = snd_soc_codec_get_drvdata(codec); 378 379 wm8523->rate_constraint.list = &wm8523->rate_constraint_list[0]; 380 wm8523->rate_constraint.count = 381 ARRAY_SIZE(wm8523->rate_constraint_list); 382 383 /* Change some default settings - latch VU and enable ZC */ 384 snd_soc_update_bits(codec, WM8523_DAC_GAINR, 385 WM8523_DACR_VU, WM8523_DACR_VU); 386 snd_soc_update_bits(codec, WM8523_DAC_CTRL3, WM8523_ZC, WM8523_ZC); 387 388 return 0; 389 } 390 391 static struct snd_soc_codec_driver soc_codec_dev_wm8523 = { 392 .probe = wm8523_probe, 393 .set_bias_level = wm8523_set_bias_level, 394 .suspend_bias_off = true, 395 396 .controls = wm8523_controls, 397 .num_controls = ARRAY_SIZE(wm8523_controls), 398 .dapm_widgets = wm8523_dapm_widgets, 399 .num_dapm_widgets = ARRAY_SIZE(wm8523_dapm_widgets), 400 .dapm_routes = wm8523_dapm_routes, 401 .num_dapm_routes = ARRAY_SIZE(wm8523_dapm_routes), 402 }; 403 404 static const struct of_device_id wm8523_of_match[] = { 405 { .compatible = "wlf,wm8523" }, 406 { }, 407 }; 408 409 static const struct regmap_config wm8523_regmap = { 410 .reg_bits = 8, 411 .val_bits = 16, 412 .max_register = WM8523_ZERO_DETECT, 413 414 .reg_defaults = wm8523_reg_defaults, 415 .num_reg_defaults = ARRAY_SIZE(wm8523_reg_defaults), 416 .cache_type = REGCACHE_RBTREE, 417 418 .volatile_reg = wm8523_volatile_register, 419 }; 420 421 #if IS_ENABLED(CONFIG_I2C) 422 static int wm8523_i2c_probe(struct i2c_client *i2c, 423 const struct i2c_device_id *id) 424 { 425 struct wm8523_priv *wm8523; 426 unsigned int val; 427 int ret, i; 428 429 wm8523 = devm_kzalloc(&i2c->dev, sizeof(struct wm8523_priv), 430 GFP_KERNEL); 431 if (wm8523 == NULL) 432 return -ENOMEM; 433 434 wm8523->regmap = devm_regmap_init_i2c(i2c, &wm8523_regmap); 435 if (IS_ERR(wm8523->regmap)) { 436 ret = PTR_ERR(wm8523->regmap); 437 dev_err(&i2c->dev, "Failed to create regmap: %d\n", ret); 438 return ret; 439 } 440 441 for (i = 0; i < ARRAY_SIZE(wm8523->supplies); i++) 442 wm8523->supplies[i].supply = wm8523_supply_names[i]; 443 444 ret = devm_regulator_bulk_get(&i2c->dev, ARRAY_SIZE(wm8523->supplies), 445 wm8523->supplies); 446 if (ret != 0) { 447 dev_err(&i2c->dev, "Failed to request supplies: %d\n", ret); 448 return ret; 449 } 450 451 ret = regulator_bulk_enable(ARRAY_SIZE(wm8523->supplies), 452 wm8523->supplies); 453 if (ret != 0) { 454 dev_err(&i2c->dev, "Failed to enable supplies: %d\n", ret); 455 return ret; 456 } 457 458 ret = regmap_read(wm8523->regmap, WM8523_DEVICE_ID, &val); 459 if (ret < 0) { 460 dev_err(&i2c->dev, "Failed to read ID register\n"); 461 goto err_enable; 462 } 463 if (val != 0x8523) { 464 dev_err(&i2c->dev, "Device is not a WM8523, ID is %x\n", ret); 465 ret = -EINVAL; 466 goto err_enable; 467 } 468 469 ret = regmap_read(wm8523->regmap, WM8523_REVISION, &val); 470 if (ret < 0) { 471 dev_err(&i2c->dev, "Failed to read revision register\n"); 472 goto err_enable; 473 } 474 dev_info(&i2c->dev, "revision %c\n", 475 (val & WM8523_CHIP_REV_MASK) + 'A'); 476 477 ret = regmap_write(wm8523->regmap, WM8523_DEVICE_ID, 0x8523); 478 if (ret != 0) { 479 dev_err(&i2c->dev, "Failed to reset device: %d\n", ret); 480 goto err_enable; 481 } 482 483 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies); 484 485 i2c_set_clientdata(i2c, wm8523); 486 487 ret = snd_soc_register_codec(&i2c->dev, 488 &soc_codec_dev_wm8523, &wm8523_dai, 1); 489 490 return ret; 491 492 err_enable: 493 regulator_bulk_disable(ARRAY_SIZE(wm8523->supplies), wm8523->supplies); 494 return ret; 495 } 496 497 static int wm8523_i2c_remove(struct i2c_client *client) 498 { 499 snd_soc_unregister_codec(&client->dev); 500 return 0; 501 } 502 503 static const struct i2c_device_id wm8523_i2c_id[] = { 504 { "wm8523", 0 }, 505 { } 506 }; 507 MODULE_DEVICE_TABLE(i2c, wm8523_i2c_id); 508 509 static struct i2c_driver wm8523_i2c_driver = { 510 .driver = { 511 .name = "wm8523", 512 .owner = THIS_MODULE, 513 .of_match_table = wm8523_of_match, 514 }, 515 .probe = wm8523_i2c_probe, 516 .remove = wm8523_i2c_remove, 517 .id_table = wm8523_i2c_id, 518 }; 519 #endif 520 521 static int __init wm8523_modinit(void) 522 { 523 int ret; 524 #if IS_ENABLED(CONFIG_I2C) 525 ret = i2c_add_driver(&wm8523_i2c_driver); 526 if (ret != 0) { 527 printk(KERN_ERR "Failed to register WM8523 I2C driver: %d\n", 528 ret); 529 } 530 #endif 531 return 0; 532 } 533 module_init(wm8523_modinit); 534 535 static void __exit wm8523_exit(void) 536 { 537 #if IS_ENABLED(CONFIG_I2C) 538 i2c_del_driver(&wm8523_i2c_driver); 539 #endif 540 } 541 module_exit(wm8523_exit); 542 543 MODULE_DESCRIPTION("ASoC WM8523 driver"); 544 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); 545 MODULE_LICENSE("GPL"); 546