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 const struct snd_soc_component_driver soc_component_dev_wm8731 = { 573 .set_bias_level = wm8731_set_bias_level, 574 .controls = wm8731_snd_controls, 575 .num_controls = ARRAY_SIZE(wm8731_snd_controls), 576 .dapm_widgets = wm8731_dapm_widgets, 577 .num_dapm_widgets = ARRAY_SIZE(wm8731_dapm_widgets), 578 .dapm_routes = wm8731_intercon, 579 .num_dapm_routes = ARRAY_SIZE(wm8731_intercon), 580 .suspend_bias_off = 1, 581 .idle_bias_on = 1, 582 .use_pmdown_time = 1, 583 .endianness = 1, 584 .non_legacy_dai_naming = 1, 585 }; 586 587 static int wm8731_init(struct device *dev, struct wm8731_priv *wm8731) 588 { 589 int ret = 0, i; 590 591 wm8731->mclk = devm_clk_get(dev, "mclk"); 592 if (IS_ERR(wm8731->mclk)) { 593 ret = PTR_ERR(wm8731->mclk); 594 if (ret == -ENOENT) { 595 wm8731->mclk = NULL; 596 dev_warn(dev, "Assuming static MCLK\n"); 597 } else { 598 dev_err(dev, "Failed to get MCLK: %d\n", ret); 599 return ret; 600 } 601 } 602 603 mutex_init(&wm8731->lock); 604 605 for (i = 0; i < ARRAY_SIZE(wm8731->supplies); i++) 606 wm8731->supplies[i].supply = wm8731_supply_names[i]; 607 608 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(wm8731->supplies), 609 wm8731->supplies); 610 if (ret != 0) { 611 dev_err(dev, "Failed to request supplies: %d\n", ret); 612 return ret; 613 } 614 615 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies), 616 wm8731->supplies); 617 if (ret != 0) { 618 dev_err(dev, "Failed to enable supplies: %d\n", ret); 619 return ret; 620 } 621 622 ret = wm8731_reset(wm8731->regmap); 623 if (ret < 0) { 624 dev_err(dev, "Failed to issue reset: %d\n", ret); 625 goto err_regulator_enable; 626 } 627 628 /* Clear POWEROFF, keep everything else disabled */ 629 regmap_write(wm8731->regmap, WM8731_PWR, 0x7f); 630 631 /* Latch the update bits */ 632 regmap_update_bits(wm8731->regmap, WM8731_LOUT1V, 0x100, 0); 633 regmap_update_bits(wm8731->regmap, WM8731_ROUT1V, 0x100, 0); 634 regmap_update_bits(wm8731->regmap, WM8731_LINVOL, 0x100, 0); 635 regmap_update_bits(wm8731->regmap, WM8731_RINVOL, 0x100, 0); 636 637 /* Disable bypass path by default */ 638 regmap_update_bits(wm8731->regmap, WM8731_APANA, 0x8, 0); 639 640 regcache_mark_dirty(wm8731->regmap); 641 642 ret = devm_snd_soc_register_component(dev, 643 &soc_component_dev_wm8731, &wm8731_dai, 1); 644 if (ret != 0) { 645 dev_err(dev, "Failed to register CODEC: %d\n", ret); 646 goto err_regulator_enable; 647 } 648 649 return 0; 650 651 err_regulator_enable: 652 /* Regulators will be enabled by bias management */ 653 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies); 654 655 return ret; 656 } 657 658 static const struct of_device_id wm8731_of_match[] = { 659 { .compatible = "wlf,wm8731", }, 660 { } 661 }; 662 663 MODULE_DEVICE_TABLE(of, wm8731_of_match); 664 665 static const struct regmap_config wm8731_regmap = { 666 .reg_bits = 7, 667 .val_bits = 9, 668 669 .max_register = WM8731_RESET, 670 .volatile_reg = wm8731_volatile, 671 672 .cache_type = REGCACHE_RBTREE, 673 .reg_defaults = wm8731_reg_defaults, 674 .num_reg_defaults = ARRAY_SIZE(wm8731_reg_defaults), 675 }; 676 677 #if defined(CONFIG_SPI_MASTER) 678 static int wm8731_spi_probe(struct spi_device *spi) 679 { 680 struct wm8731_priv *wm8731; 681 int ret; 682 683 wm8731 = devm_kzalloc(&spi->dev, sizeof(*wm8731), GFP_KERNEL); 684 if (wm8731 == NULL) 685 return -ENOMEM; 686 687 spi_set_drvdata(spi, wm8731); 688 689 wm8731->regmap = devm_regmap_init_spi(spi, &wm8731_regmap); 690 if (IS_ERR(wm8731->regmap)) { 691 ret = PTR_ERR(wm8731->regmap); 692 dev_err(&spi->dev, "Failed to allocate register map: %d\n", 693 ret); 694 return ret; 695 } 696 697 return wm8731_init(&spi->dev, wm8731); 698 } 699 700 static struct spi_driver wm8731_spi_driver = { 701 .driver = { 702 .name = "wm8731", 703 .of_match_table = wm8731_of_match, 704 }, 705 .probe = wm8731_spi_probe, 706 }; 707 #endif /* CONFIG_SPI_MASTER */ 708 709 #if IS_ENABLED(CONFIG_I2C) 710 static int wm8731_i2c_probe(struct i2c_client *i2c, 711 const struct i2c_device_id *id) 712 { 713 struct wm8731_priv *wm8731; 714 int ret; 715 716 wm8731 = devm_kzalloc(&i2c->dev, sizeof(struct wm8731_priv), 717 GFP_KERNEL); 718 if (wm8731 == NULL) 719 return -ENOMEM; 720 721 i2c_set_clientdata(i2c, wm8731); 722 723 wm8731->regmap = devm_regmap_init_i2c(i2c, &wm8731_regmap); 724 if (IS_ERR(wm8731->regmap)) { 725 ret = PTR_ERR(wm8731->regmap); 726 dev_err(&i2c->dev, "Failed to allocate register map: %d\n", 727 ret); 728 return ret; 729 } 730 731 return wm8731_init(&i2c->dev, wm8731); 732 } 733 734 static const struct i2c_device_id wm8731_i2c_id[] = { 735 { "wm8731", 0 }, 736 { } 737 }; 738 MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id); 739 740 static struct i2c_driver wm8731_i2c_driver = { 741 .driver = { 742 .name = "wm8731", 743 .of_match_table = wm8731_of_match, 744 }, 745 .probe = wm8731_i2c_probe, 746 .id_table = wm8731_i2c_id, 747 }; 748 #endif 749 750 static int __init wm8731_modinit(void) 751 { 752 int ret = 0; 753 #if IS_ENABLED(CONFIG_I2C) 754 ret = i2c_add_driver(&wm8731_i2c_driver); 755 if (ret != 0) { 756 printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n", 757 ret); 758 } 759 #endif 760 #if defined(CONFIG_SPI_MASTER) 761 ret = spi_register_driver(&wm8731_spi_driver); 762 if (ret != 0) { 763 printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n", 764 ret); 765 } 766 #endif 767 return ret; 768 } 769 module_init(wm8731_modinit); 770 771 static void __exit wm8731_exit(void) 772 { 773 #if IS_ENABLED(CONFIG_I2C) 774 i2c_del_driver(&wm8731_i2c_driver); 775 #endif 776 #if defined(CONFIG_SPI_MASTER) 777 spi_unregister_driver(&wm8731_spi_driver); 778 #endif 779 } 780 module_exit(wm8731_exit); 781 782 MODULE_DESCRIPTION("ASoC WM8731 driver"); 783 MODULE_AUTHOR("Richard Purdie"); 784 MODULE_LICENSE("GPL"); 785