1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * wm8731.c -- WM8731 ALSA SoC Audio driver 4 * 5 * Copyright 2005 Openedhand Ltd. 6 * Copyright 2006-12 Wolfson Microelectronics, plc 7 * 8 * Author: Richard Purdie <richard@openedhand.com> 9 * 10 * Based on wm8753.c by Liam Girdwood 11 */ 12 13 #include <linux/module.h> 14 #include <linux/moduleparam.h> 15 #include <linux/init.h> 16 #include <linux/delay.h> 17 #include <linux/pm.h> 18 #include <linux/i2c.h> 19 #include <linux/slab.h> 20 #include <linux/regmap.h> 21 #include <linux/regulator/consumer.h> 22 #include <linux/spi/spi.h> 23 #include <linux/of_device.h> 24 #include <linux/mutex.h> 25 #include <linux/clk.h> 26 #include <sound/core.h> 27 #include <sound/pcm.h> 28 #include <sound/pcm_params.h> 29 #include <sound/soc.h> 30 #include <sound/initval.h> 31 #include <sound/tlv.h> 32 33 #include "wm8731.h" 34 35 #define WM8731_NUM_SUPPLIES 4 36 static const char *wm8731_supply_names[WM8731_NUM_SUPPLIES] = { 37 "AVDD", 38 "HPVDD", 39 "DCVDD", 40 "DBVDD", 41 }; 42 43 /* codec private data */ 44 struct wm8731_priv { 45 struct regmap *regmap; 46 struct clk *mclk; 47 struct regulator_bulk_data supplies[WM8731_NUM_SUPPLIES]; 48 const struct snd_pcm_hw_constraint_list *constraints; 49 unsigned int sysclk; 50 int sysclk_type; 51 int playback_fs; 52 bool deemph; 53 54 struct mutex lock; 55 }; 56 57 58 /* 59 * wm8731 register cache 60 */ 61 static const struct reg_default wm8731_reg_defaults[] = { 62 { 0, 0x0097 }, 63 { 1, 0x0097 }, 64 { 2, 0x0079 }, 65 { 3, 0x0079 }, 66 { 4, 0x000a }, 67 { 5, 0x0008 }, 68 { 6, 0x009f }, 69 { 7, 0x000a }, 70 { 8, 0x0000 }, 71 { 9, 0x0000 }, 72 }; 73 74 static bool wm8731_volatile(struct device *dev, unsigned int reg) 75 { 76 return reg == WM8731_RESET; 77 } 78 79 #define wm8731_reset(m) regmap_write(m, WM8731_RESET, 0) 80 81 static const char *wm8731_input_select[] = {"Line In", "Mic"}; 82 83 static SOC_ENUM_SINGLE_DECL(wm8731_insel_enum, 84 WM8731_APANA, 2, wm8731_input_select); 85 86 static int wm8731_deemph[] = { 0, 32000, 44100, 48000 }; 87 88 static int wm8731_set_deemph(struct snd_soc_component *component) 89 { 90 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 91 int val, i, best; 92 93 /* If we're using deemphasis select the nearest available sample 94 * rate. 95 */ 96 if (wm8731->deemph) { 97 best = 1; 98 for (i = 2; i < ARRAY_SIZE(wm8731_deemph); i++) { 99 if (abs(wm8731_deemph[i] - wm8731->playback_fs) < 100 abs(wm8731_deemph[best] - wm8731->playback_fs)) 101 best = i; 102 } 103 104 val = best << 1; 105 } else { 106 best = 0; 107 val = 0; 108 } 109 110 dev_dbg(component->dev, "Set deemphasis %d (%dHz)\n", 111 best, wm8731_deemph[best]); 112 113 return snd_soc_component_update_bits(component, WM8731_APDIGI, 0x6, val); 114 } 115 116 static int wm8731_get_deemph(struct snd_kcontrol *kcontrol, 117 struct snd_ctl_elem_value *ucontrol) 118 { 119 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 120 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 121 122 ucontrol->value.integer.value[0] = wm8731->deemph; 123 124 return 0; 125 } 126 127 static int wm8731_put_deemph(struct snd_kcontrol *kcontrol, 128 struct snd_ctl_elem_value *ucontrol) 129 { 130 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol); 131 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 132 unsigned int deemph = ucontrol->value.integer.value[0]; 133 int ret = 0; 134 135 if (deemph > 1) 136 return -EINVAL; 137 138 mutex_lock(&wm8731->lock); 139 if (wm8731->deemph != deemph) { 140 wm8731->deemph = deemph; 141 142 wm8731_set_deemph(component); 143 144 ret = 1; 145 } 146 mutex_unlock(&wm8731->lock); 147 148 return ret; 149 } 150 151 static const DECLARE_TLV_DB_SCALE(in_tlv, -3450, 150, 0); 152 static const DECLARE_TLV_DB_SCALE(sidetone_tlv, -1500, 300, 0); 153 static const DECLARE_TLV_DB_SCALE(out_tlv, -12100, 100, 1); 154 static const DECLARE_TLV_DB_SCALE(mic_tlv, 0, 2000, 0); 155 156 static const struct snd_kcontrol_new wm8731_snd_controls[] = { 157 158 SOC_DOUBLE_R_TLV("Master Playback Volume", WM8731_LOUT1V, WM8731_ROUT1V, 159 0, 127, 0, out_tlv), 160 SOC_DOUBLE_R("Master Playback ZC Switch", WM8731_LOUT1V, WM8731_ROUT1V, 161 7, 1, 0), 162 163 SOC_DOUBLE_R_TLV("Capture Volume", WM8731_LINVOL, WM8731_RINVOL, 0, 31, 0, 164 in_tlv), 165 SOC_DOUBLE_R("Line Capture Switch", WM8731_LINVOL, WM8731_RINVOL, 7, 1, 1), 166 167 SOC_SINGLE_TLV("Mic Boost Volume", WM8731_APANA, 0, 1, 0, mic_tlv), 168 SOC_SINGLE("Mic Capture Switch", WM8731_APANA, 1, 1, 1), 169 170 SOC_SINGLE_TLV("Sidetone Playback Volume", WM8731_APANA, 6, 3, 1, 171 sidetone_tlv), 172 173 SOC_SINGLE("ADC High Pass Filter Switch", WM8731_APDIGI, 0, 1, 1), 174 SOC_SINGLE("Store DC Offset Switch", WM8731_APDIGI, 4, 1, 0), 175 176 SOC_SINGLE_BOOL_EXT("Playback Deemphasis Switch", 0, 177 wm8731_get_deemph, wm8731_put_deemph), 178 }; 179 180 /* Output Mixer */ 181 static const struct snd_kcontrol_new wm8731_output_mixer_controls[] = { 182 SOC_DAPM_SINGLE("Line Bypass Switch", WM8731_APANA, 3, 1, 0), 183 SOC_DAPM_SINGLE("Mic Sidetone Switch", WM8731_APANA, 5, 1, 0), 184 SOC_DAPM_SINGLE("HiFi Playback Switch", WM8731_APANA, 4, 1, 0), 185 }; 186 187 /* Input mux */ 188 static const struct snd_kcontrol_new wm8731_input_mux_controls = 189 SOC_DAPM_ENUM("Input Select", wm8731_insel_enum); 190 191 static const struct snd_soc_dapm_widget wm8731_dapm_widgets[] = { 192 SND_SOC_DAPM_SUPPLY("ACTIVE",WM8731_ACTIVE, 0, 0, NULL, 0), 193 SND_SOC_DAPM_SUPPLY("OSC", WM8731_PWR, 5, 1, NULL, 0), 194 SND_SOC_DAPM_MIXER("Output Mixer", WM8731_PWR, 4, 1, 195 &wm8731_output_mixer_controls[0], 196 ARRAY_SIZE(wm8731_output_mixer_controls)), 197 SND_SOC_DAPM_DAC("DAC", "HiFi Playback", WM8731_PWR, 3, 1), 198 SND_SOC_DAPM_OUTPUT("LOUT"), 199 SND_SOC_DAPM_OUTPUT("LHPOUT"), 200 SND_SOC_DAPM_OUTPUT("ROUT"), 201 SND_SOC_DAPM_OUTPUT("RHPOUT"), 202 SND_SOC_DAPM_ADC("ADC", "HiFi Capture", WM8731_PWR, 2, 1), 203 SND_SOC_DAPM_MUX("Input Mux", SND_SOC_NOPM, 0, 0, &wm8731_input_mux_controls), 204 SND_SOC_DAPM_PGA("Line Input", WM8731_PWR, 0, 1, NULL, 0), 205 SND_SOC_DAPM_MICBIAS("Mic Bias", WM8731_PWR, 1, 1), 206 SND_SOC_DAPM_INPUT("MICIN"), 207 SND_SOC_DAPM_INPUT("RLINEIN"), 208 SND_SOC_DAPM_INPUT("LLINEIN"), 209 }; 210 211 static int wm8731_check_osc(struct snd_soc_dapm_widget *source, 212 struct snd_soc_dapm_widget *sink) 213 { 214 struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm); 215 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 216 217 return wm8731->sysclk_type == WM8731_SYSCLK_XTAL; 218 } 219 220 static const struct snd_soc_dapm_route wm8731_intercon[] = { 221 {"DAC", NULL, "OSC", wm8731_check_osc}, 222 {"ADC", NULL, "OSC", wm8731_check_osc}, 223 {"DAC", NULL, "ACTIVE"}, 224 {"ADC", NULL, "ACTIVE"}, 225 226 /* output mixer */ 227 {"Output Mixer", "Line Bypass Switch", "Line Input"}, 228 {"Output Mixer", "HiFi Playback Switch", "DAC"}, 229 {"Output Mixer", "Mic Sidetone Switch", "Mic Bias"}, 230 231 /* outputs */ 232 {"RHPOUT", NULL, "Output Mixer"}, 233 {"ROUT", NULL, "Output Mixer"}, 234 {"LHPOUT", NULL, "Output Mixer"}, 235 {"LOUT", NULL, "Output Mixer"}, 236 237 /* input mux */ 238 {"Input Mux", "Line In", "Line Input"}, 239 {"Input Mux", "Mic", "Mic Bias"}, 240 {"ADC", NULL, "Input Mux"}, 241 242 /* inputs */ 243 {"Line Input", NULL, "LLINEIN"}, 244 {"Line Input", NULL, "RLINEIN"}, 245 {"Mic Bias", NULL, "MICIN"}, 246 }; 247 248 struct _coeff_div { 249 u32 mclk; 250 u32 rate; 251 u16 fs; 252 u8 sr:4; 253 u8 bosr:1; 254 u8 usb:1; 255 }; 256 257 /* codec mclk clock divider coefficients */ 258 static const struct _coeff_div coeff_div[] = { 259 /* 48k */ 260 {12288000, 48000, 256, 0x0, 0x0, 0x0}, 261 {18432000, 48000, 384, 0x0, 0x1, 0x0}, 262 {12000000, 48000, 250, 0x0, 0x0, 0x1}, 263 264 /* 32k */ 265 {12288000, 32000, 384, 0x6, 0x0, 0x0}, 266 {18432000, 32000, 576, 0x6, 0x1, 0x0}, 267 {12000000, 32000, 375, 0x6, 0x0, 0x1}, 268 269 /* 8k */ 270 {12288000, 8000, 1536, 0x3, 0x0, 0x0}, 271 {18432000, 8000, 2304, 0x3, 0x1, 0x0}, 272 {11289600, 8000, 1408, 0xb, 0x0, 0x0}, 273 {16934400, 8000, 2112, 0xb, 0x1, 0x0}, 274 {12000000, 8000, 1500, 0x3, 0x0, 0x1}, 275 276 /* 96k */ 277 {12288000, 96000, 128, 0x7, 0x0, 0x0}, 278 {18432000, 96000, 192, 0x7, 0x1, 0x0}, 279 {12000000, 96000, 125, 0x7, 0x0, 0x1}, 280 281 /* 44.1k */ 282 {11289600, 44100, 256, 0x8, 0x0, 0x0}, 283 {16934400, 44100, 384, 0x8, 0x1, 0x0}, 284 {12000000, 44100, 272, 0x8, 0x1, 0x1}, 285 286 /* 88.2k */ 287 {11289600, 88200, 128, 0xf, 0x0, 0x0}, 288 {16934400, 88200, 192, 0xf, 0x1, 0x0}, 289 {12000000, 88200, 136, 0xf, 0x1, 0x1}, 290 }; 291 292 /* rates constraints */ 293 static const unsigned int wm8731_rates_12000000[] = { 294 8000, 32000, 44100, 48000, 96000, 88200, 295 }; 296 297 static const unsigned int wm8731_rates_12288000_18432000[] = { 298 8000, 32000, 48000, 96000, 299 }; 300 301 static const unsigned int wm8731_rates_11289600_16934400[] = { 302 8000, 44100, 88200, 303 }; 304 305 static const struct snd_pcm_hw_constraint_list wm8731_constraints_12000000 = { 306 .list = wm8731_rates_12000000, 307 .count = ARRAY_SIZE(wm8731_rates_12000000), 308 }; 309 310 static const 311 struct snd_pcm_hw_constraint_list wm8731_constraints_12288000_18432000 = { 312 .list = wm8731_rates_12288000_18432000, 313 .count = ARRAY_SIZE(wm8731_rates_12288000_18432000), 314 }; 315 316 static const 317 struct snd_pcm_hw_constraint_list wm8731_constraints_11289600_16934400 = { 318 .list = wm8731_rates_11289600_16934400, 319 .count = ARRAY_SIZE(wm8731_rates_11289600_16934400), 320 }; 321 322 static inline int get_coeff(int mclk, int rate) 323 { 324 int i; 325 326 for (i = 0; i < ARRAY_SIZE(coeff_div); i++) { 327 if (coeff_div[i].rate == rate && coeff_div[i].mclk == mclk) 328 return i; 329 } 330 return 0; 331 } 332 333 static int wm8731_hw_params(struct snd_pcm_substream *substream, 334 struct snd_pcm_hw_params *params, 335 struct snd_soc_dai *dai) 336 { 337 struct snd_soc_component *component = dai->component; 338 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 339 u16 iface = snd_soc_component_read(component, WM8731_IFACE) & 0xfff3; 340 int i = get_coeff(wm8731->sysclk, params_rate(params)); 341 u16 srate = (coeff_div[i].sr << 2) | 342 (coeff_div[i].bosr << 1) | coeff_div[i].usb; 343 344 wm8731->playback_fs = params_rate(params); 345 346 snd_soc_component_write(component, WM8731_SRATE, srate); 347 348 /* bit size */ 349 switch (params_width(params)) { 350 case 16: 351 break; 352 case 20: 353 iface |= 0x0004; 354 break; 355 case 24: 356 iface |= 0x0008; 357 break; 358 case 32: 359 iface |= 0x000c; 360 break; 361 } 362 363 wm8731_set_deemph(component); 364 365 snd_soc_component_write(component, WM8731_IFACE, iface); 366 return 0; 367 } 368 369 static int wm8731_mute(struct snd_soc_dai *dai, int mute, int direction) 370 { 371 struct snd_soc_component *component = dai->component; 372 u16 mute_reg = snd_soc_component_read(component, WM8731_APDIGI) & 0xfff7; 373 374 if (mute) 375 snd_soc_component_write(component, WM8731_APDIGI, mute_reg | 0x8); 376 else 377 snd_soc_component_write(component, WM8731_APDIGI, mute_reg); 378 return 0; 379 } 380 381 static int wm8731_set_dai_sysclk(struct snd_soc_dai *codec_dai, 382 int clk_id, unsigned int freq, int dir) 383 { 384 struct snd_soc_component *component = codec_dai->component; 385 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component); 386 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 387 388 switch (clk_id) { 389 case WM8731_SYSCLK_XTAL: 390 case WM8731_SYSCLK_MCLK: 391 if (wm8731->mclk && clk_set_rate(wm8731->mclk, freq)) 392 return -EINVAL; 393 wm8731->sysclk_type = clk_id; 394 break; 395 default: 396 return -EINVAL; 397 } 398 399 switch (freq) { 400 case 0: 401 wm8731->constraints = NULL; 402 break; 403 case 12000000: 404 wm8731->constraints = &wm8731_constraints_12000000; 405 break; 406 case 12288000: 407 case 18432000: 408 wm8731->constraints = &wm8731_constraints_12288000_18432000; 409 break; 410 case 16934400: 411 case 11289600: 412 wm8731->constraints = &wm8731_constraints_11289600_16934400; 413 break; 414 default: 415 return -EINVAL; 416 } 417 418 wm8731->sysclk = freq; 419 420 snd_soc_dapm_sync(dapm); 421 422 return 0; 423 } 424 425 426 static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai, 427 unsigned int fmt) 428 { 429 struct snd_soc_component *component = codec_dai->component; 430 u16 iface = 0; 431 432 switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) { 433 case SND_SOC_DAIFMT_CBP_CFP: 434 iface |= 0x0040; 435 break; 436 case SND_SOC_DAIFMT_CBC_CFC: 437 break; 438 default: 439 return -EINVAL; 440 } 441 442 /* interface format */ 443 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 444 case SND_SOC_DAIFMT_I2S: 445 iface |= 0x0002; 446 break; 447 case SND_SOC_DAIFMT_RIGHT_J: 448 break; 449 case SND_SOC_DAIFMT_LEFT_J: 450 iface |= 0x0001; 451 break; 452 case SND_SOC_DAIFMT_DSP_A: 453 iface |= 0x0013; 454 break; 455 case SND_SOC_DAIFMT_DSP_B: 456 iface |= 0x0003; 457 break; 458 default: 459 return -EINVAL; 460 } 461 462 /* clock inversion */ 463 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 464 case SND_SOC_DAIFMT_NB_NF: 465 break; 466 case SND_SOC_DAIFMT_IB_IF: 467 iface |= 0x0090; 468 break; 469 case SND_SOC_DAIFMT_IB_NF: 470 iface |= 0x0080; 471 break; 472 case SND_SOC_DAIFMT_NB_IF: 473 iface |= 0x0010; 474 break; 475 default: 476 return -EINVAL; 477 } 478 479 /* set iface */ 480 snd_soc_component_write(component, WM8731_IFACE, iface); 481 return 0; 482 } 483 484 static int wm8731_set_bias_level(struct snd_soc_component *component, 485 enum snd_soc_bias_level level) 486 { 487 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(component); 488 int ret; 489 u16 reg; 490 491 switch (level) { 492 case SND_SOC_BIAS_ON: 493 if (wm8731->mclk) { 494 ret = clk_prepare_enable(wm8731->mclk); 495 if (ret) 496 return ret; 497 } 498 break; 499 case SND_SOC_BIAS_PREPARE: 500 break; 501 case SND_SOC_BIAS_STANDBY: 502 if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) { 503 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies), 504 wm8731->supplies); 505 if (ret != 0) 506 return ret; 507 508 regcache_sync(wm8731->regmap); 509 } 510 511 /* Clear PWROFF, gate CLKOUT, everything else as-is */ 512 reg = snd_soc_component_read(component, WM8731_PWR) & 0xff7f; 513 snd_soc_component_write(component, WM8731_PWR, reg | 0x0040); 514 break; 515 case SND_SOC_BIAS_OFF: 516 if (wm8731->mclk) 517 clk_disable_unprepare(wm8731->mclk); 518 snd_soc_component_write(component, WM8731_PWR, 0xffff); 519 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), 520 wm8731->supplies); 521 regcache_mark_dirty(wm8731->regmap); 522 break; 523 } 524 return 0; 525 } 526 527 static int wm8731_startup(struct snd_pcm_substream *substream, 528 struct snd_soc_dai *dai) 529 { 530 struct wm8731_priv *wm8731 = snd_soc_component_get_drvdata(dai->component); 531 532 if (wm8731->constraints) 533 snd_pcm_hw_constraint_list(substream->runtime, 0, 534 SNDRV_PCM_HW_PARAM_RATE, 535 wm8731->constraints); 536 537 return 0; 538 } 539 540 #define WM8731_RATES SNDRV_PCM_RATE_8000_96000 541 542 #define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 543 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 544 545 static const struct snd_soc_dai_ops wm8731_dai_ops = { 546 .startup = wm8731_startup, 547 .hw_params = wm8731_hw_params, 548 .mute_stream = wm8731_mute, 549 .set_sysclk = wm8731_set_dai_sysclk, 550 .set_fmt = wm8731_set_dai_fmt, 551 .no_capture_mute = 1, 552 }; 553 554 static struct snd_soc_dai_driver wm8731_dai = { 555 .name = "wm8731-hifi", 556 .playback = { 557 .stream_name = "Playback", 558 .channels_min = 1, 559 .channels_max = 2, 560 .rates = WM8731_RATES, 561 .formats = WM8731_FORMATS,}, 562 .capture = { 563 .stream_name = "Capture", 564 .channels_min = 1, 565 .channels_max = 2, 566 .rates = WM8731_RATES, 567 .formats = WM8731_FORMATS,}, 568 .ops = &wm8731_dai_ops, 569 .symmetric_rate = 1, 570 }; 571 572 static int wm8731_request_supplies(struct device *dev, 573 struct wm8731_priv *wm8731) 574 { 575 int ret = 0, i; 576 577 for (i = 0; i < ARRAY_SIZE(wm8731->supplies); i++) 578 wm8731->supplies[i].supply = wm8731_supply_names[i]; 579 580 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(wm8731->supplies), 581 wm8731->supplies); 582 if (ret != 0) { 583 dev_err(dev, "Failed to request supplies: %d\n", ret); 584 return ret; 585 } 586 587 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies), 588 wm8731->supplies); 589 if (ret != 0) { 590 dev_err(dev, "Failed to enable supplies: %d\n", ret); 591 return ret; 592 } 593 594 return 0; 595 } 596 597 static const struct snd_soc_component_driver soc_component_dev_wm8731 = { 598 .set_bias_level = wm8731_set_bias_level, 599 .controls = wm8731_snd_controls, 600 .num_controls = ARRAY_SIZE(wm8731_snd_controls), 601 .dapm_widgets = wm8731_dapm_widgets, 602 .num_dapm_widgets = ARRAY_SIZE(wm8731_dapm_widgets), 603 .dapm_routes = wm8731_intercon, 604 .num_dapm_routes = ARRAY_SIZE(wm8731_intercon), 605 .suspend_bias_off = 1, 606 .idle_bias_on = 1, 607 .use_pmdown_time = 1, 608 .endianness = 1, 609 .non_legacy_dai_naming = 1, 610 }; 611 612 static int wm8731_init(struct device *dev, struct wm8731_priv *wm8731) 613 { 614 int ret = 0; 615 616 ret = wm8731_reset(wm8731->regmap); 617 if (ret < 0) { 618 dev_err(dev, "Failed to issue reset: %d\n", ret); 619 goto err_regulator_enable; 620 } 621 622 /* Clear POWEROFF, keep everything else disabled */ 623 regmap_write(wm8731->regmap, WM8731_PWR, 0x7f); 624 625 /* Latch the update bits */ 626 regmap_update_bits(wm8731->regmap, WM8731_LOUT1V, 0x100, 0); 627 regmap_update_bits(wm8731->regmap, WM8731_ROUT1V, 0x100, 0); 628 regmap_update_bits(wm8731->regmap, WM8731_LINVOL, 0x100, 0); 629 regmap_update_bits(wm8731->regmap, WM8731_RINVOL, 0x100, 0); 630 631 /* Disable bypass path by default */ 632 regmap_update_bits(wm8731->regmap, WM8731_APANA, 0x8, 0); 633 634 regcache_mark_dirty(wm8731->regmap); 635 636 ret = devm_snd_soc_register_component(dev, 637 &soc_component_dev_wm8731, &wm8731_dai, 1); 638 if (ret != 0) { 639 dev_err(dev, "Failed to register CODEC: %d\n", ret); 640 goto err_regulator_enable; 641 } 642 643 return 0; 644 645 err_regulator_enable: 646 /* Regulators will be enabled by bias management */ 647 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies); 648 649 return ret; 650 } 651 652 static const struct of_device_id wm8731_of_match[] = { 653 { .compatible = "wlf,wm8731", }, 654 { } 655 }; 656 657 MODULE_DEVICE_TABLE(of, wm8731_of_match); 658 659 static const struct regmap_config wm8731_regmap = { 660 .reg_bits = 7, 661 .val_bits = 9, 662 663 .max_register = WM8731_RESET, 664 .volatile_reg = wm8731_volatile, 665 666 .cache_type = REGCACHE_RBTREE, 667 .reg_defaults = wm8731_reg_defaults, 668 .num_reg_defaults = ARRAY_SIZE(wm8731_reg_defaults), 669 }; 670 671 #if defined(CONFIG_SPI_MASTER) 672 static int wm8731_spi_probe(struct spi_device *spi) 673 { 674 struct wm8731_priv *wm8731; 675 int ret; 676 677 wm8731 = devm_kzalloc(&spi->dev, sizeof(*wm8731), GFP_KERNEL); 678 if (wm8731 == NULL) 679 return -ENOMEM; 680 681 wm8731->mclk = devm_clk_get(&spi->dev, "mclk"); 682 if (IS_ERR(wm8731->mclk)) { 683 ret = PTR_ERR(wm8731->mclk); 684 if (ret == -ENOENT) { 685 wm8731->mclk = NULL; 686 dev_warn(&spi->dev, "Assuming static MCLK\n"); 687 } else { 688 dev_err(&spi->dev, "Failed to get MCLK: %d\n", 689 ret); 690 return ret; 691 } 692 } 693 694 mutex_init(&wm8731->lock); 695 696 spi_set_drvdata(spi, wm8731); 697 698 ret = wm8731_request_supplies(&spi->dev, wm8731); 699 if (ret != 0) 700 return ret; 701 702 wm8731->regmap = devm_regmap_init_spi(spi, &wm8731_regmap); 703 if (IS_ERR(wm8731->regmap)) { 704 ret = PTR_ERR(wm8731->regmap); 705 dev_err(&spi->dev, "Failed to allocate register map: %d\n", 706 ret); 707 return ret; 708 } 709 710 return wm8731_init(&spi->dev, wm8731); 711 } 712 713 static struct spi_driver wm8731_spi_driver = { 714 .driver = { 715 .name = "wm8731", 716 .of_match_table = wm8731_of_match, 717 }, 718 .probe = wm8731_spi_probe, 719 }; 720 #endif /* CONFIG_SPI_MASTER */ 721 722 #if IS_ENABLED(CONFIG_I2C) 723 static int wm8731_i2c_probe(struct i2c_client *i2c, 724 const struct i2c_device_id *id) 725 { 726 struct wm8731_priv *wm8731; 727 int ret; 728 729 wm8731 = devm_kzalloc(&i2c->dev, sizeof(struct wm8731_priv), 730 GFP_KERNEL); 731 if (wm8731 == NULL) 732 return -ENOMEM; 733 734 wm8731->mclk = devm_clk_get(&i2c->dev, "mclk"); 735 if (IS_ERR(wm8731->mclk)) { 736 ret = PTR_ERR(wm8731->mclk); 737 if (ret == -ENOENT) { 738 wm8731->mclk = NULL; 739 dev_warn(&i2c->dev, "Assuming static MCLK\n"); 740 } else { 741 dev_err(&i2c->dev, "Failed to get MCLK: %d\n", 742 ret); 743 return ret; 744 } 745 } 746 747 mutex_init(&wm8731->lock); 748 749 i2c_set_clientdata(i2c, wm8731); 750 751 ret = wm8731_request_supplies(&i2c->dev, wm8731); 752 if (ret != 0) 753 return ret; 754 755 wm8731->regmap = devm_regmap_init_i2c(i2c, &wm8731_regmap); 756 if (IS_ERR(wm8731->regmap)) { 757 ret = PTR_ERR(wm8731->regmap); 758 dev_err(&i2c->dev, "Failed to allocate register map: %d\n", 759 ret); 760 return ret; 761 } 762 763 return wm8731_init(&i2c->dev, wm8731); 764 } 765 766 static const struct i2c_device_id wm8731_i2c_id[] = { 767 { "wm8731", 0 }, 768 { } 769 }; 770 MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id); 771 772 static struct i2c_driver wm8731_i2c_driver = { 773 .driver = { 774 .name = "wm8731", 775 .of_match_table = wm8731_of_match, 776 }, 777 .probe = wm8731_i2c_probe, 778 .id_table = wm8731_i2c_id, 779 }; 780 #endif 781 782 static int __init wm8731_modinit(void) 783 { 784 int ret = 0; 785 #if IS_ENABLED(CONFIG_I2C) 786 ret = i2c_add_driver(&wm8731_i2c_driver); 787 if (ret != 0) { 788 printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n", 789 ret); 790 } 791 #endif 792 #if defined(CONFIG_SPI_MASTER) 793 ret = spi_register_driver(&wm8731_spi_driver); 794 if (ret != 0) { 795 printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n", 796 ret); 797 } 798 #endif 799 return ret; 800 } 801 module_init(wm8731_modinit); 802 803 static void __exit wm8731_exit(void) 804 { 805 #if IS_ENABLED(CONFIG_I2C) 806 i2c_del_driver(&wm8731_i2c_driver); 807 #endif 808 #if defined(CONFIG_SPI_MASTER) 809 spi_unregister_driver(&wm8731_spi_driver); 810 #endif 811 } 812 module_exit(wm8731_exit); 813 814 MODULE_DESCRIPTION("ASoC WM8731 driver"); 815 MODULE_AUTHOR("Richard Purdie"); 816 MODULE_LICENSE("GPL"); 817