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