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 case 32: 362 iface |= 0x000c; 363 break; 364 } 365 366 wm8731_set_deemph(codec); 367 368 snd_soc_write(codec, WM8731_IFACE, iface); 369 return 0; 370 } 371 372 static int wm8731_mute(struct snd_soc_dai *dai, int mute) 373 { 374 struct snd_soc_codec *codec = dai->codec; 375 u16 mute_reg = snd_soc_read(codec, WM8731_APDIGI) & 0xfff7; 376 377 if (mute) 378 snd_soc_write(codec, WM8731_APDIGI, mute_reg | 0x8); 379 else 380 snd_soc_write(codec, WM8731_APDIGI, mute_reg); 381 return 0; 382 } 383 384 static int wm8731_set_dai_sysclk(struct snd_soc_dai *codec_dai, 385 int clk_id, unsigned int freq, int dir) 386 { 387 struct snd_soc_codec *codec = codec_dai->codec; 388 struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec); 389 struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec); 390 391 switch (clk_id) { 392 case WM8731_SYSCLK_XTAL: 393 case WM8731_SYSCLK_MCLK: 394 if (wm8731->mclk && clk_set_rate(wm8731->mclk, freq)) 395 return -EINVAL; 396 wm8731->sysclk_type = clk_id; 397 break; 398 default: 399 return -EINVAL; 400 } 401 402 switch (freq) { 403 case 0: 404 wm8731->constraints = NULL; 405 break; 406 case 12000000: 407 wm8731->constraints = &wm8731_constraints_12000000; 408 break; 409 case 12288000: 410 case 18432000: 411 wm8731->constraints = &wm8731_constraints_12288000_18432000; 412 break; 413 case 16934400: 414 case 11289600: 415 wm8731->constraints = &wm8731_constraints_11289600_16934400; 416 break; 417 default: 418 return -EINVAL; 419 } 420 421 wm8731->sysclk = freq; 422 423 snd_soc_dapm_sync(dapm); 424 425 return 0; 426 } 427 428 429 static int wm8731_set_dai_fmt(struct snd_soc_dai *codec_dai, 430 unsigned int fmt) 431 { 432 struct snd_soc_codec *codec = codec_dai->codec; 433 u16 iface = 0; 434 435 /* set master/slave audio interface */ 436 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) { 437 case SND_SOC_DAIFMT_CBM_CFM: 438 iface |= 0x0040; 439 break; 440 case SND_SOC_DAIFMT_CBS_CFS: 441 break; 442 default: 443 return -EINVAL; 444 } 445 446 /* interface format */ 447 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { 448 case SND_SOC_DAIFMT_I2S: 449 iface |= 0x0002; 450 break; 451 case SND_SOC_DAIFMT_RIGHT_J: 452 break; 453 case SND_SOC_DAIFMT_LEFT_J: 454 iface |= 0x0001; 455 break; 456 case SND_SOC_DAIFMT_DSP_A: 457 iface |= 0x0013; 458 break; 459 case SND_SOC_DAIFMT_DSP_B: 460 iface |= 0x0003; 461 break; 462 default: 463 return -EINVAL; 464 } 465 466 /* clock inversion */ 467 switch (fmt & SND_SOC_DAIFMT_INV_MASK) { 468 case SND_SOC_DAIFMT_NB_NF: 469 break; 470 case SND_SOC_DAIFMT_IB_IF: 471 iface |= 0x0090; 472 break; 473 case SND_SOC_DAIFMT_IB_NF: 474 iface |= 0x0080; 475 break; 476 case SND_SOC_DAIFMT_NB_IF: 477 iface |= 0x0010; 478 break; 479 default: 480 return -EINVAL; 481 } 482 483 /* set iface */ 484 snd_soc_write(codec, WM8731_IFACE, iface); 485 return 0; 486 } 487 488 static int wm8731_set_bias_level(struct snd_soc_codec *codec, 489 enum snd_soc_bias_level level) 490 { 491 struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(codec); 492 int ret; 493 u16 reg; 494 495 switch (level) { 496 case SND_SOC_BIAS_ON: 497 if (wm8731->mclk) { 498 ret = clk_prepare_enable(wm8731->mclk); 499 if (ret) 500 return ret; 501 } 502 break; 503 case SND_SOC_BIAS_PREPARE: 504 break; 505 case SND_SOC_BIAS_STANDBY: 506 if (snd_soc_codec_get_bias_level(codec) == SND_SOC_BIAS_OFF) { 507 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies), 508 wm8731->supplies); 509 if (ret != 0) 510 return ret; 511 512 regcache_sync(wm8731->regmap); 513 } 514 515 /* Clear PWROFF, gate CLKOUT, everything else as-is */ 516 reg = snd_soc_read(codec, WM8731_PWR) & 0xff7f; 517 snd_soc_write(codec, WM8731_PWR, reg | 0x0040); 518 break; 519 case SND_SOC_BIAS_OFF: 520 if (wm8731->mclk) 521 clk_disable_unprepare(wm8731->mclk); 522 snd_soc_write(codec, WM8731_PWR, 0xffff); 523 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), 524 wm8731->supplies); 525 regcache_mark_dirty(wm8731->regmap); 526 break; 527 } 528 return 0; 529 } 530 531 static int wm8731_startup(struct snd_pcm_substream *substream, 532 struct snd_soc_dai *dai) 533 { 534 struct wm8731_priv *wm8731 = snd_soc_codec_get_drvdata(dai->codec); 535 536 if (wm8731->constraints) 537 snd_pcm_hw_constraint_list(substream->runtime, 0, 538 SNDRV_PCM_HW_PARAM_RATE, 539 wm8731->constraints); 540 541 return 0; 542 } 543 544 #define WM8731_RATES SNDRV_PCM_RATE_8000_96000 545 546 #define WM8731_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\ 547 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE) 548 549 static const struct snd_soc_dai_ops wm8731_dai_ops = { 550 .startup = wm8731_startup, 551 .hw_params = wm8731_hw_params, 552 .digital_mute = wm8731_mute, 553 .set_sysclk = wm8731_set_dai_sysclk, 554 .set_fmt = wm8731_set_dai_fmt, 555 }; 556 557 static struct snd_soc_dai_driver wm8731_dai = { 558 .name = "wm8731-hifi", 559 .playback = { 560 .stream_name = "Playback", 561 .channels_min = 1, 562 .channels_max = 2, 563 .rates = WM8731_RATES, 564 .formats = WM8731_FORMATS,}, 565 .capture = { 566 .stream_name = "Capture", 567 .channels_min = 1, 568 .channels_max = 2, 569 .rates = WM8731_RATES, 570 .formats = WM8731_FORMATS,}, 571 .ops = &wm8731_dai_ops, 572 .symmetric_rates = 1, 573 }; 574 575 static int wm8731_request_supplies(struct device *dev, 576 struct wm8731_priv *wm8731) 577 { 578 int ret = 0, i; 579 580 for (i = 0; i < ARRAY_SIZE(wm8731->supplies); i++) 581 wm8731->supplies[i].supply = wm8731_supply_names[i]; 582 583 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(wm8731->supplies), 584 wm8731->supplies); 585 if (ret != 0) { 586 dev_err(dev, "Failed to request supplies: %d\n", ret); 587 return ret; 588 } 589 590 ret = regulator_bulk_enable(ARRAY_SIZE(wm8731->supplies), 591 wm8731->supplies); 592 if (ret != 0) { 593 dev_err(dev, "Failed to enable supplies: %d\n", ret); 594 return ret; 595 } 596 597 return 0; 598 } 599 600 static int wm8731_hw_init(struct device *dev, struct wm8731_priv *wm8731) 601 { 602 int ret = 0; 603 604 ret = wm8731_reset(wm8731->regmap); 605 if (ret < 0) { 606 dev_err(dev, "Failed to issue reset: %d\n", ret); 607 goto err_regulator_enable; 608 } 609 610 /* Clear POWEROFF, keep everything else disabled */ 611 regmap_write(wm8731->regmap, WM8731_PWR, 0x7f); 612 613 /* Latch the update bits */ 614 regmap_update_bits(wm8731->regmap, WM8731_LOUT1V, 0x100, 0); 615 regmap_update_bits(wm8731->regmap, WM8731_ROUT1V, 0x100, 0); 616 regmap_update_bits(wm8731->regmap, WM8731_LINVOL, 0x100, 0); 617 regmap_update_bits(wm8731->regmap, WM8731_RINVOL, 0x100, 0); 618 619 /* Disable bypass path by default */ 620 regmap_update_bits(wm8731->regmap, WM8731_APANA, 0x8, 0); 621 622 regcache_mark_dirty(wm8731->regmap); 623 624 err_regulator_enable: 625 /* Regulators will be enabled by bias management */ 626 regulator_bulk_disable(ARRAY_SIZE(wm8731->supplies), wm8731->supplies); 627 628 return ret; 629 } 630 631 static struct snd_soc_codec_driver soc_codec_dev_wm8731 = { 632 .set_bias_level = wm8731_set_bias_level, 633 .suspend_bias_off = true, 634 635 .dapm_widgets = wm8731_dapm_widgets, 636 .num_dapm_widgets = ARRAY_SIZE(wm8731_dapm_widgets), 637 .dapm_routes = wm8731_intercon, 638 .num_dapm_routes = ARRAY_SIZE(wm8731_intercon), 639 .controls = wm8731_snd_controls, 640 .num_controls = ARRAY_SIZE(wm8731_snd_controls), 641 }; 642 643 static const struct of_device_id wm8731_of_match[] = { 644 { .compatible = "wlf,wm8731", }, 645 { } 646 }; 647 648 MODULE_DEVICE_TABLE(of, wm8731_of_match); 649 650 static const struct regmap_config wm8731_regmap = { 651 .reg_bits = 7, 652 .val_bits = 9, 653 654 .max_register = WM8731_RESET, 655 .volatile_reg = wm8731_volatile, 656 657 .cache_type = REGCACHE_RBTREE, 658 .reg_defaults = wm8731_reg_defaults, 659 .num_reg_defaults = ARRAY_SIZE(wm8731_reg_defaults), 660 }; 661 662 #if defined(CONFIG_SPI_MASTER) 663 static int wm8731_spi_probe(struct spi_device *spi) 664 { 665 struct wm8731_priv *wm8731; 666 int ret; 667 668 wm8731 = devm_kzalloc(&spi->dev, sizeof(*wm8731), GFP_KERNEL); 669 if (wm8731 == NULL) 670 return -ENOMEM; 671 672 wm8731->mclk = devm_clk_get(&spi->dev, "mclk"); 673 if (IS_ERR(wm8731->mclk)) { 674 ret = PTR_ERR(wm8731->mclk); 675 if (ret == -ENOENT) { 676 wm8731->mclk = NULL; 677 dev_warn(&spi->dev, "Assuming static MCLK\n"); 678 } else { 679 dev_err(&spi->dev, "Failed to get MCLK: %d\n", 680 ret); 681 return ret; 682 } 683 } 684 685 mutex_init(&wm8731->lock); 686 687 spi_set_drvdata(spi, wm8731); 688 689 ret = wm8731_request_supplies(&spi->dev, wm8731); 690 if (ret != 0) 691 return ret; 692 693 wm8731->regmap = devm_regmap_init_spi(spi, &wm8731_regmap); 694 if (IS_ERR(wm8731->regmap)) { 695 ret = PTR_ERR(wm8731->regmap); 696 dev_err(&spi->dev, "Failed to allocate register map: %d\n", 697 ret); 698 return ret; 699 } 700 701 ret = wm8731_hw_init(&spi->dev, wm8731); 702 if (ret != 0) 703 return ret; 704 705 ret = snd_soc_register_codec(&spi->dev, 706 &soc_codec_dev_wm8731, &wm8731_dai, 1); 707 if (ret != 0) { 708 dev_err(&spi->dev, "Failed to register CODEC: %d\n", ret); 709 return ret; 710 } 711 712 return 0; 713 } 714 715 static int wm8731_spi_remove(struct spi_device *spi) 716 { 717 snd_soc_unregister_codec(&spi->dev); 718 return 0; 719 } 720 721 static struct spi_driver wm8731_spi_driver = { 722 .driver = { 723 .name = "wm8731", 724 .of_match_table = wm8731_of_match, 725 }, 726 .probe = wm8731_spi_probe, 727 .remove = wm8731_spi_remove, 728 }; 729 #endif /* CONFIG_SPI_MASTER */ 730 731 #if IS_ENABLED(CONFIG_I2C) 732 static int wm8731_i2c_probe(struct i2c_client *i2c, 733 const struct i2c_device_id *id) 734 { 735 struct wm8731_priv *wm8731; 736 int ret; 737 738 wm8731 = devm_kzalloc(&i2c->dev, sizeof(struct wm8731_priv), 739 GFP_KERNEL); 740 if (wm8731 == NULL) 741 return -ENOMEM; 742 743 wm8731->mclk = devm_clk_get(&i2c->dev, "mclk"); 744 if (IS_ERR(wm8731->mclk)) { 745 ret = PTR_ERR(wm8731->mclk); 746 if (ret == -ENOENT) { 747 wm8731->mclk = NULL; 748 dev_warn(&i2c->dev, "Assuming static MCLK\n"); 749 } else { 750 dev_err(&i2c->dev, "Failed to get MCLK: %d\n", 751 ret); 752 return ret; 753 } 754 } 755 756 mutex_init(&wm8731->lock); 757 758 i2c_set_clientdata(i2c, wm8731); 759 760 ret = wm8731_request_supplies(&i2c->dev, wm8731); 761 if (ret != 0) 762 return ret; 763 764 wm8731->regmap = devm_regmap_init_i2c(i2c, &wm8731_regmap); 765 if (IS_ERR(wm8731->regmap)) { 766 ret = PTR_ERR(wm8731->regmap); 767 dev_err(&i2c->dev, "Failed to allocate register map: %d\n", 768 ret); 769 return ret; 770 } 771 772 ret = wm8731_hw_init(&i2c->dev, wm8731); 773 if (ret != 0) 774 return ret; 775 776 ret = snd_soc_register_codec(&i2c->dev, 777 &soc_codec_dev_wm8731, &wm8731_dai, 1); 778 if (ret != 0) { 779 dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret); 780 return ret; 781 } 782 783 return 0; 784 } 785 786 static int wm8731_i2c_remove(struct i2c_client *client) 787 { 788 snd_soc_unregister_codec(&client->dev); 789 return 0; 790 } 791 792 static const struct i2c_device_id wm8731_i2c_id[] = { 793 { "wm8731", 0 }, 794 { } 795 }; 796 MODULE_DEVICE_TABLE(i2c, wm8731_i2c_id); 797 798 static struct i2c_driver wm8731_i2c_driver = { 799 .driver = { 800 .name = "wm8731", 801 .of_match_table = wm8731_of_match, 802 }, 803 .probe = wm8731_i2c_probe, 804 .remove = wm8731_i2c_remove, 805 .id_table = wm8731_i2c_id, 806 }; 807 #endif 808 809 static int __init wm8731_modinit(void) 810 { 811 int ret = 0; 812 #if IS_ENABLED(CONFIG_I2C) 813 ret = i2c_add_driver(&wm8731_i2c_driver); 814 if (ret != 0) { 815 printk(KERN_ERR "Failed to register WM8731 I2C driver: %d\n", 816 ret); 817 } 818 #endif 819 #if defined(CONFIG_SPI_MASTER) 820 ret = spi_register_driver(&wm8731_spi_driver); 821 if (ret != 0) { 822 printk(KERN_ERR "Failed to register WM8731 SPI driver: %d\n", 823 ret); 824 } 825 #endif 826 return ret; 827 } 828 module_init(wm8731_modinit); 829 830 static void __exit wm8731_exit(void) 831 { 832 #if IS_ENABLED(CONFIG_I2C) 833 i2c_del_driver(&wm8731_i2c_driver); 834 #endif 835 #if defined(CONFIG_SPI_MASTER) 836 spi_unregister_driver(&wm8731_spi_driver); 837 #endif 838 } 839 module_exit(wm8731_exit); 840 841 MODULE_DESCRIPTION("ASoC WM8731 driver"); 842 MODULE_AUTHOR("Richard Purdie"); 843 MODULE_LICENSE("GPL"); 844