1 // SPDX-License-Identifier: GPL-2.0 2 // 3 // rt711.c -- rt711 ALSA SoC audio driver 4 // 5 // Copyright(c) 2019 Realtek Semiconductor Corp. 6 // 7 // 8 9 #include <linux/module.h> 10 #include <linux/moduleparam.h> 11 #include <linux/kernel.h> 12 #include <linux/init.h> 13 #include <linux/delay.h> 14 #include <linux/pm_runtime.h> 15 #include <linux/pm.h> 16 #include <linux/soundwire/sdw.h> 17 #include <linux/regmap.h> 18 #include <linux/slab.h> 19 #include <sound/core.h> 20 #include <sound/pcm.h> 21 #include <sound/pcm_params.h> 22 #include <sound/soc.h> 23 #include <sound/soc-dapm.h> 24 #include <sound/initval.h> 25 #include <sound/tlv.h> 26 #include <sound/hda_verbs.h> 27 #include <sound/jack.h> 28 29 #include "rt711.h" 30 31 static int rt711_index_write(struct regmap *regmap, 32 unsigned int nid, unsigned int reg, unsigned int value) 33 { 34 int ret; 35 unsigned int addr = ((RT711_PRIV_INDEX_W_H | nid) << 8) | reg; 36 37 ret = regmap_write(regmap, addr, value); 38 if (ret < 0) 39 pr_err("Failed to set private value: %06x <= %04x ret=%d\n", 40 addr, value, ret); 41 42 return ret; 43 } 44 45 static int rt711_index_read(struct regmap *regmap, 46 unsigned int nid, unsigned int reg, unsigned int *value) 47 { 48 int ret; 49 unsigned int addr = ((RT711_PRIV_INDEX_W_H | nid) << 8) | reg; 50 51 *value = 0; 52 ret = regmap_read(regmap, addr, value); 53 if (ret < 0) 54 pr_err("Failed to get private value: %06x => %04x ret=%d\n", 55 addr, *value, ret); 56 57 return ret; 58 } 59 60 static int rt711_index_update_bits(struct regmap *regmap, unsigned int nid, 61 unsigned int reg, unsigned int mask, unsigned int val) 62 { 63 unsigned int tmp, orig; 64 int ret; 65 66 ret = rt711_index_read(regmap, nid, reg, &orig); 67 if (ret < 0) 68 return ret; 69 70 tmp = orig & ~mask; 71 tmp |= val & mask; 72 73 return rt711_index_write(regmap, nid, reg, tmp); 74 } 75 76 static void rt711_reset(struct regmap *regmap) 77 { 78 regmap_write(regmap, RT711_FUNC_RESET, 0); 79 rt711_index_update_bits(regmap, RT711_VENDOR_REG, 80 RT711_PARA_VERB_CTL, RT711_HIDDEN_REG_SW_RESET, 81 RT711_HIDDEN_REG_SW_RESET); 82 } 83 84 static int rt711_calibration(struct rt711_priv *rt711) 85 { 86 unsigned int val, loop = 0; 87 struct device *dev; 88 struct regmap *regmap = rt711->regmap; 89 int ret = 0; 90 91 mutex_lock(&rt711->calibrate_mutex); 92 regmap_write(rt711->regmap, 93 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D0); 94 95 dev = regmap_get_device(regmap); 96 97 /* Calibration manual mode */ 98 rt711_index_update_bits(regmap, RT711_VENDOR_REG, RT711_FSM_CTL, 99 0xf, 0x0); 100 101 /* trigger */ 102 rt711_index_update_bits(regmap, RT711_VENDOR_CALI, 103 RT711_DAC_DC_CALI_CTL1, RT711_DAC_DC_CALI_TRIGGER, 104 RT711_DAC_DC_CALI_TRIGGER); 105 106 /* wait for calibration process */ 107 rt711_index_read(regmap, RT711_VENDOR_CALI, 108 RT711_DAC_DC_CALI_CTL1, &val); 109 110 while (val & RT711_DAC_DC_CALI_TRIGGER) { 111 if (loop >= 500) { 112 pr_err("%s, calibration time-out!\n", 113 __func__); 114 ret = -ETIMEDOUT; 115 break; 116 } 117 loop++; 118 119 usleep_range(10000, 11000); 120 rt711_index_read(regmap, RT711_VENDOR_CALI, 121 RT711_DAC_DC_CALI_CTL1, &val); 122 } 123 124 /* depop mode */ 125 rt711_index_update_bits(regmap, RT711_VENDOR_REG, 126 RT711_FSM_CTL, 0xf, RT711_DEPOP_CTL); 127 128 regmap_write(rt711->regmap, 129 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D3); 130 mutex_unlock(&rt711->calibrate_mutex); 131 132 dev_dbg(dev, "%s calibration complete, ret=%d\n", __func__, ret); 133 return ret; 134 } 135 136 static unsigned int rt711_button_detect(struct rt711_priv *rt711) 137 { 138 unsigned int btn_type = 0, val80, val81; 139 int ret; 140 141 ret = rt711_index_read(rt711->regmap, RT711_VENDOR_REG, 142 RT711_IRQ_FLAG_TABLE1, &val80); 143 if (ret < 0) 144 goto read_error; 145 ret = rt711_index_read(rt711->regmap, RT711_VENDOR_REG, 146 RT711_IRQ_FLAG_TABLE2, &val81); 147 if (ret < 0) 148 goto read_error; 149 150 val80 &= 0x0381; 151 val81 &= 0xff00; 152 153 switch (val80) { 154 case 0x0200: 155 case 0x0100: 156 case 0x0080: 157 btn_type |= SND_JACK_BTN_0; 158 break; 159 case 0x0001: 160 btn_type |= SND_JACK_BTN_3; 161 break; 162 } 163 switch (val81) { 164 case 0x8000: 165 case 0x4000: 166 case 0x2000: 167 btn_type |= SND_JACK_BTN_1; 168 break; 169 case 0x1000: 170 case 0x0800: 171 case 0x0400: 172 btn_type |= SND_JACK_BTN_2; 173 break; 174 case 0x0200: 175 case 0x0100: 176 btn_type |= SND_JACK_BTN_3; 177 break; 178 } 179 read_error: 180 return btn_type; 181 } 182 183 static int rt711_headset_detect(struct rt711_priv *rt711) 184 { 185 unsigned int buf, loop = 0; 186 int ret; 187 unsigned int jack_status = 0, reg; 188 189 ret = rt711_index_read(rt711->regmap, RT711_VENDOR_REG, 190 RT711_COMBO_JACK_AUTO_CTL2, &buf); 191 if (ret < 0) 192 goto io_error; 193 194 while (loop < 500 && 195 (buf & RT711_COMBOJACK_AUTO_DET_STATUS) == 0) { 196 loop++; 197 198 usleep_range(9000, 10000); 199 ret = rt711_index_read(rt711->regmap, RT711_VENDOR_REG, 200 RT711_COMBO_JACK_AUTO_CTL2, &buf); 201 if (ret < 0) 202 goto io_error; 203 204 reg = RT711_VERB_GET_PIN_SENSE | RT711_HP_OUT; 205 ret = regmap_read(rt711->regmap, reg, &jack_status); 206 if (ret < 0) 207 goto io_error; 208 if ((jack_status & (1 << 31)) == 0) 209 goto remove_error; 210 } 211 212 if (loop >= 500) 213 goto to_error; 214 215 if (buf & RT711_COMBOJACK_AUTO_DET_TRS) 216 rt711->jack_type = SND_JACK_HEADPHONE; 217 else if ((buf & RT711_COMBOJACK_AUTO_DET_CTIA) || 218 (buf & RT711_COMBOJACK_AUTO_DET_OMTP)) 219 rt711->jack_type = SND_JACK_HEADSET; 220 221 return 0; 222 223 to_error: 224 ret = -ETIMEDOUT; 225 pr_err_ratelimited("Time-out error in %s\n", __func__); 226 return ret; 227 io_error: 228 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret); 229 return ret; 230 remove_error: 231 pr_err_ratelimited("Jack removal in %s\n", __func__); 232 return -ENODEV; 233 } 234 235 static void rt711_jack_detect_handler(struct work_struct *work) 236 { 237 struct rt711_priv *rt711 = 238 container_of(work, struct rt711_priv, jack_detect_work.work); 239 int btn_type = 0, ret; 240 unsigned int jack_status = 0, reg; 241 242 if (!rt711->hs_jack) 243 return; 244 245 if (!rt711->component->card->instantiated) 246 return; 247 248 reg = RT711_VERB_GET_PIN_SENSE | RT711_HP_OUT; 249 ret = regmap_read(rt711->regmap, reg, &jack_status); 250 if (ret < 0) 251 goto io_error; 252 253 /* pin attached */ 254 if (jack_status & (1 << 31)) { 255 /* jack in */ 256 if (rt711->jack_type == 0) { 257 ret = rt711_headset_detect(rt711); 258 if (ret < 0) 259 return; 260 if (rt711->jack_type == SND_JACK_HEADSET) 261 btn_type = rt711_button_detect(rt711); 262 } else if (rt711->jack_type == SND_JACK_HEADSET) { 263 /* jack is already in, report button event */ 264 btn_type = rt711_button_detect(rt711); 265 } 266 } else { 267 /* jack out */ 268 rt711->jack_type = 0; 269 } 270 271 dev_dbg(&rt711->slave->dev, 272 "in %s, jack_type=0x%x\n", __func__, rt711->jack_type); 273 dev_dbg(&rt711->slave->dev, 274 "in %s, btn_type=0x%x\n", __func__, btn_type); 275 276 snd_soc_jack_report(rt711->hs_jack, rt711->jack_type | btn_type, 277 SND_JACK_HEADSET | 278 SND_JACK_BTN_0 | SND_JACK_BTN_1 | 279 SND_JACK_BTN_2 | SND_JACK_BTN_3); 280 281 if (btn_type) { 282 /* button released */ 283 snd_soc_jack_report(rt711->hs_jack, rt711->jack_type, 284 SND_JACK_HEADSET | 285 SND_JACK_BTN_0 | SND_JACK_BTN_1 | 286 SND_JACK_BTN_2 | SND_JACK_BTN_3); 287 288 mod_delayed_work(system_power_efficient_wq, 289 &rt711->jack_btn_check_work, msecs_to_jiffies(200)); 290 } 291 292 return; 293 294 io_error: 295 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret); 296 } 297 298 static void rt711_btn_check_handler(struct work_struct *work) 299 { 300 struct rt711_priv *rt711 = container_of(work, struct rt711_priv, 301 jack_btn_check_work.work); 302 int btn_type = 0, ret; 303 unsigned int jack_status = 0, reg; 304 305 reg = RT711_VERB_GET_PIN_SENSE | RT711_HP_OUT; 306 ret = regmap_read(rt711->regmap, reg, &jack_status); 307 if (ret < 0) 308 goto io_error; 309 310 /* pin attached */ 311 if (jack_status & (1 << 31)) { 312 if (rt711->jack_type == SND_JACK_HEADSET) { 313 /* jack is already in, report button event */ 314 btn_type = rt711_button_detect(rt711); 315 } 316 } else { 317 rt711->jack_type = 0; 318 } 319 320 /* cbj comparator */ 321 ret = rt711_index_read(rt711->regmap, RT711_VENDOR_REG, 322 RT711_COMBO_JACK_AUTO_CTL2, ®); 323 if (ret < 0) 324 goto io_error; 325 326 if ((reg & 0xf0) == 0xf0) 327 btn_type = 0; 328 329 dev_dbg(&rt711->slave->dev, 330 "%s, btn_type=0x%x\n", __func__, btn_type); 331 snd_soc_jack_report(rt711->hs_jack, rt711->jack_type | btn_type, 332 SND_JACK_HEADSET | 333 SND_JACK_BTN_0 | SND_JACK_BTN_1 | 334 SND_JACK_BTN_2 | SND_JACK_BTN_3); 335 336 if (btn_type) { 337 /* button released */ 338 snd_soc_jack_report(rt711->hs_jack, rt711->jack_type, 339 SND_JACK_HEADSET | 340 SND_JACK_BTN_0 | SND_JACK_BTN_1 | 341 SND_JACK_BTN_2 | SND_JACK_BTN_3); 342 343 mod_delayed_work(system_power_efficient_wq, 344 &rt711->jack_btn_check_work, msecs_to_jiffies(200)); 345 } 346 347 return; 348 349 io_error: 350 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret); 351 } 352 353 static void rt711_jack_init(struct rt711_priv *rt711) 354 { 355 struct snd_soc_dapm_context *dapm = 356 snd_soc_component_get_dapm(rt711->component); 357 358 mutex_lock(&rt711->calibrate_mutex); 359 /* power on */ 360 if (dapm->bias_level <= SND_SOC_BIAS_STANDBY) 361 regmap_write(rt711->regmap, 362 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D0); 363 364 if (rt711->hs_jack) { 365 /* unsolicited response & IRQ control */ 366 regmap_write(rt711->regmap, 367 RT711_SET_MIC2_UNSOLICITED_ENABLE, 0x82); 368 regmap_write(rt711->regmap, 369 RT711_SET_HP_UNSOLICITED_ENABLE, 0x81); 370 regmap_write(rt711->regmap, 371 RT711_SET_INLINE_UNSOLICITED_ENABLE, 0x83); 372 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 373 0x10, 0x2420); 374 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 375 0x19, 0x2e11); 376 377 switch (rt711->jd_src) { 378 case RT711_JD1: 379 /* default settings was already for JD1 */ 380 break; 381 case RT711_JD2: 382 rt711_index_update_bits(rt711->regmap, RT711_VENDOR_REG, 383 RT711_JD_CTL2, RT711_JD2_2PORT_200K_DECODE_HP | 384 RT711_HP_JD_SEL_JD2, 385 RT711_JD2_2PORT_200K_DECODE_HP | 386 RT711_HP_JD_SEL_JD2); 387 rt711_index_update_bits(rt711->regmap, RT711_VENDOR_REG, 388 RT711_CC_DET1, 389 RT711_HP_JD_FINAL_RESULT_CTL_JD12, 390 RT711_HP_JD_FINAL_RESULT_CTL_JD12); 391 break; 392 default: 393 dev_warn(rt711->component->dev, "Wrong JD source\n"); 394 break; 395 } 396 397 dev_dbg(&rt711->slave->dev, "in %s enable\n", __func__); 398 399 mod_delayed_work(system_power_efficient_wq, 400 &rt711->jack_detect_work, msecs_to_jiffies(250)); 401 } else { 402 regmap_write(rt711->regmap, 403 RT711_SET_MIC2_UNSOLICITED_ENABLE, 0x00); 404 regmap_write(rt711->regmap, 405 RT711_SET_HP_UNSOLICITED_ENABLE, 0x00); 406 regmap_write(rt711->regmap, 407 RT711_SET_INLINE_UNSOLICITED_ENABLE, 0x00); 408 409 dev_dbg(&rt711->slave->dev, "in %s disable\n", __func__); 410 } 411 412 /* power off */ 413 if (dapm->bias_level <= SND_SOC_BIAS_STANDBY) 414 regmap_write(rt711->regmap, 415 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D3); 416 mutex_unlock(&rt711->calibrate_mutex); 417 } 418 419 static int rt711_set_jack_detect(struct snd_soc_component *component, 420 struct snd_soc_jack *hs_jack, void *data) 421 { 422 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 423 424 rt711->hs_jack = hs_jack; 425 426 if (!rt711->hw_init) { 427 dev_dbg(&rt711->slave->dev, 428 "%s hw_init not ready yet\n", __func__); 429 return 0; 430 } 431 432 rt711_jack_init(rt711); 433 434 return 0; 435 } 436 437 static void rt711_get_gain(struct rt711_priv *rt711, unsigned int addr_h, 438 unsigned int addr_l, unsigned int val_h, 439 unsigned int *r_val, unsigned int *l_val) 440 { 441 /* R Channel */ 442 *r_val = (val_h << 8); 443 regmap_read(rt711->regmap, addr_l, r_val); 444 445 /* L Channel */ 446 val_h |= 0x20; 447 *l_val = (val_h << 8); 448 regmap_read(rt711->regmap, addr_h, l_val); 449 } 450 451 /* For Verb-Set Amplifier Gain (Verb ID = 3h) */ 452 static int rt711_set_amp_gain_put(struct snd_kcontrol *kcontrol, 453 struct snd_ctl_elem_value *ucontrol) 454 { 455 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); 456 struct snd_soc_dapm_context *dapm = 457 snd_soc_component_get_dapm(component); 458 struct soc_mixer_control *mc = 459 (struct soc_mixer_control *)kcontrol->private_value; 460 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 461 unsigned int addr_h, addr_l, val_h, val_ll, val_lr; 462 unsigned int read_ll, read_rl; 463 int i; 464 465 mutex_lock(&rt711->calibrate_mutex); 466 467 /* Can't use update bit function, so read the original value first */ 468 addr_h = mc->reg; 469 addr_l = mc->rreg; 470 if (mc->shift == RT711_DIR_OUT_SFT) /* output */ 471 val_h = 0x80; 472 else /* input */ 473 val_h = 0x0; 474 475 rt711_get_gain(rt711, addr_h, addr_l, val_h, &read_rl, &read_ll); 476 477 /* L Channel */ 478 if (mc->invert) { 479 /* for mute/unmute */ 480 val_ll = (mc->max - ucontrol->value.integer.value[0]) 481 << RT711_MUTE_SFT; 482 /* keep gain */ 483 read_ll = read_ll & 0x7f; 484 val_ll |= read_ll; 485 } else { 486 /* for gain */ 487 val_ll = ((ucontrol->value.integer.value[0]) & 0x7f); 488 if (val_ll > mc->max) 489 val_ll = mc->max; 490 /* keep mute status */ 491 read_ll = read_ll & (1 << RT711_MUTE_SFT); 492 val_ll |= read_ll; 493 } 494 495 if (dapm->bias_level <= SND_SOC_BIAS_STANDBY) 496 regmap_write(rt711->regmap, 497 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D0); 498 499 /* R Channel */ 500 if (mc->invert) { 501 /* for mute/unmute */ 502 val_lr = (mc->max - ucontrol->value.integer.value[1]) 503 << RT711_MUTE_SFT; 504 /* keep gain */ 505 read_rl = read_rl & 0x7f; 506 val_lr |= read_rl; 507 } else { 508 /* for gain */ 509 val_lr = ((ucontrol->value.integer.value[1]) & 0x7f); 510 if (val_lr > mc->max) 511 val_lr = mc->max; 512 /* keep mute status */ 513 read_rl = read_rl & (1 << RT711_MUTE_SFT); 514 val_lr |= read_rl; 515 } 516 517 for (i = 0; i < 3; i++) { /* retry 3 times at most */ 518 519 if (val_ll == val_lr) { 520 /* Set both L/R channels at the same time */ 521 val_h = (1 << mc->shift) | (3 << 4); 522 regmap_write(rt711->regmap, 523 addr_h, (val_h << 8 | val_ll)); 524 regmap_write(rt711->regmap, 525 addr_l, (val_h << 8 | val_ll)); 526 } else { 527 /* Lch*/ 528 val_h = (1 << mc->shift) | (1 << 5); 529 regmap_write(rt711->regmap, 530 addr_h, (val_h << 8 | val_ll)); 531 532 /* Rch */ 533 val_h = (1 << mc->shift) | (1 << 4); 534 regmap_write(rt711->regmap, 535 addr_l, (val_h << 8 | val_lr)); 536 } 537 /* check result */ 538 if (mc->shift == RT711_DIR_OUT_SFT) /* output */ 539 val_h = 0x80; 540 else /* input */ 541 val_h = 0x0; 542 543 rt711_get_gain(rt711, addr_h, addr_l, val_h, 544 &read_rl, &read_ll); 545 if (read_rl == val_lr && read_ll == val_ll) 546 break; 547 } 548 549 if (dapm->bias_level <= SND_SOC_BIAS_STANDBY) 550 regmap_write(rt711->regmap, 551 RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D3); 552 553 mutex_unlock(&rt711->calibrate_mutex); 554 return 0; 555 } 556 557 static int rt711_set_amp_gain_get(struct snd_kcontrol *kcontrol, 558 struct snd_ctl_elem_value *ucontrol) 559 { 560 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol); 561 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 562 struct soc_mixer_control *mc = 563 (struct soc_mixer_control *)kcontrol->private_value; 564 unsigned int addr_h, addr_l, val_h; 565 unsigned int read_ll, read_rl; 566 567 /* switch to get command */ 568 addr_h = mc->reg; 569 addr_l = mc->rreg; 570 if (mc->shift == RT711_DIR_OUT_SFT) /* output */ 571 val_h = 0x80; 572 else /* input */ 573 val_h = 0x0; 574 575 rt711_get_gain(rt711, addr_h, addr_l, val_h, &read_rl, &read_ll); 576 577 if (mc->invert) { 578 /* mute/unmute for switch controls */ 579 read_ll = !((read_ll & 0x80) >> RT711_MUTE_SFT); 580 read_rl = !((read_rl & 0x80) >> RT711_MUTE_SFT); 581 } else { 582 /* for gain volume controls */ 583 read_ll = read_ll & 0x7f; 584 read_rl = read_rl & 0x7f; 585 } 586 ucontrol->value.integer.value[0] = read_ll; 587 ucontrol->value.integer.value[1] = read_rl; 588 589 return 0; 590 } 591 592 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -6525, 75, 0); 593 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -1725, 75, 0); 594 static const DECLARE_TLV_DB_SCALE(mic_vol_tlv, 0, 1000, 0); 595 596 static const struct snd_kcontrol_new rt711_snd_controls[] = { 597 SOC_DOUBLE_R_EXT_TLV("DAC Surr Playback Volume", 598 RT711_SET_GAIN_DAC2_H, RT711_SET_GAIN_DAC2_L, 599 RT711_DIR_OUT_SFT, 0x57, 0, 600 rt711_set_amp_gain_get, rt711_set_amp_gain_put, out_vol_tlv), 601 SOC_DOUBLE_R_EXT("ADC 08 Capture Switch", 602 RT711_SET_GAIN_ADC2_H, RT711_SET_GAIN_ADC2_L, 603 RT711_DIR_IN_SFT, 1, 1, 604 rt711_set_amp_gain_get, rt711_set_amp_gain_put), 605 SOC_DOUBLE_R_EXT("ADC 09 Capture Switch", 606 RT711_SET_GAIN_ADC1_H, RT711_SET_GAIN_ADC1_L, 607 RT711_DIR_IN_SFT, 1, 1, 608 rt711_set_amp_gain_get, rt711_set_amp_gain_put), 609 SOC_DOUBLE_R_EXT_TLV("ADC 08 Capture Volume", 610 RT711_SET_GAIN_ADC2_H, RT711_SET_GAIN_ADC2_L, 611 RT711_DIR_IN_SFT, 0x3f, 0, 612 rt711_set_amp_gain_get, rt711_set_amp_gain_put, in_vol_tlv), 613 SOC_DOUBLE_R_EXT_TLV("ADC 09 Capture Volume", 614 RT711_SET_GAIN_ADC1_H, RT711_SET_GAIN_ADC1_L, 615 RT711_DIR_IN_SFT, 0x3f, 0, 616 rt711_set_amp_gain_get, rt711_set_amp_gain_put, in_vol_tlv), 617 SOC_DOUBLE_R_EXT_TLV("AMIC Volume", 618 RT711_SET_GAIN_AMIC_H, RT711_SET_GAIN_AMIC_L, 619 RT711_DIR_IN_SFT, 3, 0, 620 rt711_set_amp_gain_get, rt711_set_amp_gain_put, mic_vol_tlv), 621 SOC_DOUBLE_R_EXT_TLV("DMIC1 Volume", 622 RT711_SET_GAIN_DMIC1_H, RT711_SET_GAIN_DMIC1_L, 623 RT711_DIR_IN_SFT, 3, 0, 624 rt711_set_amp_gain_get, rt711_set_amp_gain_put, mic_vol_tlv), 625 SOC_DOUBLE_R_EXT_TLV("DMIC2 Volume", 626 RT711_SET_GAIN_DMIC2_H, RT711_SET_GAIN_DMIC2_L, 627 RT711_DIR_IN_SFT, 3, 0, 628 rt711_set_amp_gain_get, rt711_set_amp_gain_put, mic_vol_tlv), 629 }; 630 631 static int rt711_mux_get(struct snd_kcontrol *kcontrol, 632 struct snd_ctl_elem_value *ucontrol) 633 { 634 struct snd_soc_component *component = 635 snd_soc_dapm_kcontrol_component(kcontrol); 636 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 637 unsigned int reg, val = 0, nid; 638 int ret; 639 640 if (strstr(ucontrol->id.name, "ADC 22 Mux")) 641 nid = RT711_MIXER_IN1; 642 else if (strstr(ucontrol->id.name, "ADC 23 Mux")) 643 nid = RT711_MIXER_IN2; 644 else 645 return -EINVAL; 646 647 /* vid = 0xf01 */ 648 reg = RT711_VERB_SET_CONNECT_SEL | nid; 649 ret = regmap_read(rt711->regmap, reg, &val); 650 if (ret < 0) { 651 dev_err(component->dev, "%s: sdw read failed: %d\n", 652 __func__, ret); 653 return ret; 654 } 655 656 ucontrol->value.enumerated.item[0] = val; 657 658 return 0; 659 } 660 661 static int rt711_mux_put(struct snd_kcontrol *kcontrol, 662 struct snd_ctl_elem_value *ucontrol) 663 { 664 struct snd_soc_component *component = 665 snd_soc_dapm_kcontrol_component(kcontrol); 666 struct snd_soc_dapm_context *dapm = 667 snd_soc_dapm_kcontrol_dapm(kcontrol); 668 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 669 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value; 670 unsigned int *item = ucontrol->value.enumerated.item; 671 unsigned int val, val2 = 0, change, reg, nid; 672 int ret; 673 674 if (item[0] >= e->items) 675 return -EINVAL; 676 677 if (strstr(ucontrol->id.name, "ADC 22 Mux")) 678 nid = RT711_MIXER_IN1; 679 else if (strstr(ucontrol->id.name, "ADC 23 Mux")) 680 nid = RT711_MIXER_IN2; 681 else 682 return -EINVAL; 683 684 /* Verb ID = 0x701h */ 685 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l; 686 687 reg = RT711_VERB_SET_CONNECT_SEL | nid; 688 ret = regmap_read(rt711->regmap, reg, &val2); 689 if (ret < 0) { 690 dev_err(component->dev, "%s: sdw read failed: %d\n", 691 __func__, ret); 692 return ret; 693 } 694 695 if (val == val2) 696 change = 0; 697 else 698 change = 1; 699 700 if (change) { 701 reg = RT711_VERB_SET_CONNECT_SEL | nid; 702 regmap_write(rt711->regmap, reg, val); 703 } 704 705 snd_soc_dapm_mux_update_power(dapm, kcontrol, 706 item[0], e, NULL); 707 708 return change; 709 } 710 711 static const char * const adc_mux_text[] = { 712 "MIC2", 713 "LINE1", 714 "LINE2", 715 "DMIC", 716 }; 717 718 static SOC_ENUM_SINGLE_DECL( 719 rt711_adc22_enum, SND_SOC_NOPM, 0, adc_mux_text); 720 721 static SOC_ENUM_SINGLE_DECL( 722 rt711_adc23_enum, SND_SOC_NOPM, 0, adc_mux_text); 723 724 static const struct snd_kcontrol_new rt711_adc22_mux = 725 SOC_DAPM_ENUM_EXT("ADC 22 Mux", rt711_adc22_enum, 726 rt711_mux_get, rt711_mux_put); 727 728 static const struct snd_kcontrol_new rt711_adc23_mux = 729 SOC_DAPM_ENUM_EXT("ADC 23 Mux", rt711_adc23_enum, 730 rt711_mux_get, rt711_mux_put); 731 732 static int rt711_dac_surround_event(struct snd_soc_dapm_widget *w, 733 struct snd_kcontrol *kcontrol, int event) 734 { 735 struct snd_soc_component *component = 736 snd_soc_dapm_to_component(w->dapm); 737 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 738 unsigned int val_h = (1 << RT711_DIR_OUT_SFT) | (0x3 << 4); 739 unsigned int val_l; 740 741 switch (event) { 742 case SND_SOC_DAPM_POST_PMU: 743 regmap_write(rt711->regmap, 744 RT711_SET_STREAMID_DAC2, 0x10); 745 746 val_l = 0x00; 747 regmap_write(rt711->regmap, 748 RT711_SET_GAIN_HP_H, (val_h << 8 | val_l)); 749 break; 750 case SND_SOC_DAPM_PRE_PMD: 751 val_l = (1 << RT711_MUTE_SFT); 752 regmap_write(rt711->regmap, 753 RT711_SET_GAIN_HP_H, (val_h << 8 | val_l)); 754 usleep_range(50000, 55000); 755 756 regmap_write(rt711->regmap, 757 RT711_SET_STREAMID_DAC2, 0x00); 758 break; 759 } 760 return 0; 761 } 762 763 static int rt711_adc_09_event(struct snd_soc_dapm_widget *w, 764 struct snd_kcontrol *kcontrol, int event) 765 { 766 struct snd_soc_component *component = 767 snd_soc_dapm_to_component(w->dapm); 768 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 769 770 switch (event) { 771 case SND_SOC_DAPM_POST_PMU: 772 regmap_write(rt711->regmap, 773 RT711_SET_STREAMID_ADC1, 0x10); 774 break; 775 case SND_SOC_DAPM_PRE_PMD: 776 regmap_write(rt711->regmap, 777 RT711_SET_STREAMID_ADC1, 0x00); 778 break; 779 } 780 return 0; 781 } 782 783 static int rt711_adc_08_event(struct snd_soc_dapm_widget *w, 784 struct snd_kcontrol *kcontrol, int event) 785 { 786 struct snd_soc_component *component = 787 snd_soc_dapm_to_component(w->dapm); 788 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 789 790 switch (event) { 791 case SND_SOC_DAPM_POST_PMU: 792 regmap_write(rt711->regmap, 793 RT711_SET_STREAMID_ADC2, 0x10); 794 break; 795 case SND_SOC_DAPM_PRE_PMD: 796 regmap_write(rt711->regmap, 797 RT711_SET_STREAMID_ADC2, 0x00); 798 break; 799 } 800 return 0; 801 } 802 803 static const struct snd_soc_dapm_widget rt711_dapm_widgets[] = { 804 SND_SOC_DAPM_OUTPUT("HP"), 805 SND_SOC_DAPM_INPUT("MIC2"), 806 SND_SOC_DAPM_INPUT("DMIC1"), 807 SND_SOC_DAPM_INPUT("DMIC2"), 808 SND_SOC_DAPM_INPUT("LINE1"), 809 SND_SOC_DAPM_INPUT("LINE2"), 810 811 SND_SOC_DAPM_DAC_E("DAC Surround", NULL, SND_SOC_NOPM, 0, 0, 812 rt711_dac_surround_event, 813 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 814 SND_SOC_DAPM_ADC_E("ADC 09", NULL, SND_SOC_NOPM, 0, 0, 815 rt711_adc_09_event, 816 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 817 SND_SOC_DAPM_ADC_E("ADC 08", NULL, SND_SOC_NOPM, 0, 0, 818 rt711_adc_08_event, 819 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 820 SND_SOC_DAPM_MUX("ADC 22 Mux", SND_SOC_NOPM, 0, 0, 821 &rt711_adc22_mux), 822 SND_SOC_DAPM_MUX("ADC 23 Mux", SND_SOC_NOPM, 0, 0, 823 &rt711_adc23_mux), 824 825 SND_SOC_DAPM_AIF_IN("DP3RX", "DP3 Playback", 0, SND_SOC_NOPM, 0, 0), 826 SND_SOC_DAPM_AIF_OUT("DP2TX", "DP2 Capture", 0, SND_SOC_NOPM, 0, 0), 827 SND_SOC_DAPM_AIF_OUT("DP4TX", "DP4 Capture", 0, SND_SOC_NOPM, 0, 0), 828 }; 829 830 static const struct snd_soc_dapm_route rt711_audio_map[] = { 831 {"DAC Surround", NULL, "DP3RX"}, 832 {"DP2TX", NULL, "ADC 09"}, 833 {"DP4TX", NULL, "ADC 08"}, 834 835 {"ADC 09", NULL, "ADC 22 Mux"}, 836 {"ADC 08", NULL, "ADC 23 Mux"}, 837 {"ADC 22 Mux", "DMIC", "DMIC1"}, 838 {"ADC 22 Mux", "LINE1", "LINE1"}, 839 {"ADC 22 Mux", "LINE2", "LINE2"}, 840 {"ADC 22 Mux", "MIC2", "MIC2"}, 841 {"ADC 23 Mux", "DMIC", "DMIC2"}, 842 {"ADC 23 Mux", "LINE1", "LINE1"}, 843 {"ADC 23 Mux", "LINE2", "LINE2"}, 844 {"ADC 23 Mux", "MIC2", "MIC2"}, 845 846 {"HP", NULL, "DAC Surround"}, 847 }; 848 849 static int rt711_set_bias_level(struct snd_soc_component *component, 850 enum snd_soc_bias_level level) 851 { 852 struct snd_soc_dapm_context *dapm = 853 snd_soc_component_get_dapm(component); 854 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 855 856 switch (level) { 857 case SND_SOC_BIAS_PREPARE: 858 if (dapm->bias_level == SND_SOC_BIAS_STANDBY) { 859 regmap_write(rt711->regmap, 860 RT711_SET_AUDIO_POWER_STATE, 861 AC_PWRST_D0); 862 } 863 break; 864 865 case SND_SOC_BIAS_STANDBY: 866 mutex_lock(&rt711->calibrate_mutex); 867 regmap_write(rt711->regmap, 868 RT711_SET_AUDIO_POWER_STATE, 869 AC_PWRST_D3); 870 mutex_unlock(&rt711->calibrate_mutex); 871 break; 872 873 default: 874 break; 875 } 876 877 return 0; 878 } 879 880 static int rt711_parse_dt(struct rt711_priv *rt711, struct device *dev) 881 { 882 device_property_read_u32(dev, "realtek,jd-src", 883 &rt711->jd_src); 884 885 return 0; 886 } 887 888 static int rt711_probe(struct snd_soc_component *component) 889 { 890 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 891 892 rt711_parse_dt(rt711, &rt711->slave->dev); 893 rt711->component = component; 894 895 return 0; 896 } 897 898 static const struct snd_soc_component_driver soc_codec_dev_rt711 = { 899 .probe = rt711_probe, 900 .set_bias_level = rt711_set_bias_level, 901 .controls = rt711_snd_controls, 902 .num_controls = ARRAY_SIZE(rt711_snd_controls), 903 .dapm_widgets = rt711_dapm_widgets, 904 .num_dapm_widgets = ARRAY_SIZE(rt711_dapm_widgets), 905 .dapm_routes = rt711_audio_map, 906 .num_dapm_routes = ARRAY_SIZE(rt711_audio_map), 907 .set_jack = rt711_set_jack_detect, 908 }; 909 910 static int rt711_set_sdw_stream(struct snd_soc_dai *dai, void *sdw_stream, 911 int direction) 912 { 913 struct sdw_stream_data *stream; 914 915 if (!sdw_stream) 916 return 0; 917 918 stream = kzalloc(sizeof(*stream), GFP_KERNEL); 919 if (!stream) 920 return -ENOMEM; 921 922 stream->sdw_stream = sdw_stream; 923 924 /* Use tx_mask or rx_mask to configure stream tag and set dma_data */ 925 if (direction == SNDRV_PCM_STREAM_PLAYBACK) 926 dai->playback_dma_data = stream; 927 else 928 dai->capture_dma_data = stream; 929 930 return 0; 931 } 932 933 static void rt711_shutdown(struct snd_pcm_substream *substream, 934 struct snd_soc_dai *dai) 935 { 936 struct sdw_stream_data *stream; 937 938 stream = snd_soc_dai_get_dma_data(dai, substream); 939 snd_soc_dai_set_dma_data(dai, substream, NULL); 940 kfree(stream); 941 } 942 943 static int rt711_pcm_hw_params(struct snd_pcm_substream *substream, 944 struct snd_pcm_hw_params *params, 945 struct snd_soc_dai *dai) 946 { 947 struct snd_soc_component *component = dai->component; 948 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 949 struct sdw_stream_config stream_config; 950 struct sdw_port_config port_config; 951 enum sdw_data_direction direction; 952 struct sdw_stream_data *stream; 953 int retval, port, num_channels; 954 unsigned int val = 0; 955 956 dev_dbg(dai->dev, "%s %s", __func__, dai->name); 957 stream = snd_soc_dai_get_dma_data(dai, substream); 958 959 if (!stream) 960 return -EINVAL; 961 962 if (!rt711->slave) 963 return -EINVAL; 964 965 /* SoundWire specific configuration */ 966 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { 967 direction = SDW_DATA_DIR_RX; 968 port = 3; 969 } else { 970 direction = SDW_DATA_DIR_TX; 971 if (dai->id == RT711_AIF1) 972 port = 4; 973 else if (dai->id == RT711_AIF2) 974 port = 2; 975 else 976 return -EINVAL; 977 } 978 979 stream_config.frame_rate = params_rate(params); 980 stream_config.ch_count = params_channels(params); 981 stream_config.bps = snd_pcm_format_width(params_format(params)); 982 stream_config.direction = direction; 983 984 num_channels = params_channels(params); 985 port_config.ch_mask = (1 << (num_channels)) - 1; 986 port_config.num = port; 987 988 retval = sdw_stream_add_slave(rt711->slave, &stream_config, 989 &port_config, 1, stream->sdw_stream); 990 if (retval) { 991 dev_err(dai->dev, "Unable to configure port\n"); 992 return retval; 993 } 994 995 if (params_channels(params) <= 16) { 996 /* bit 3:0 Number of Channel */ 997 val |= (params_channels(params) - 1); 998 } else { 999 dev_err(component->dev, "Unsupported channels %d\n", 1000 params_channels(params)); 1001 return -EINVAL; 1002 } 1003 1004 switch (params_width(params)) { 1005 /* bit 6:4 Bits per Sample */ 1006 case 8: 1007 break; 1008 case 16: 1009 val |= (0x1 << 4); 1010 break; 1011 case 20: 1012 val |= (0x2 << 4); 1013 break; 1014 case 24: 1015 val |= (0x3 << 4); 1016 break; 1017 case 32: 1018 val |= (0x4 << 4); 1019 break; 1020 default: 1021 return -EINVAL; 1022 } 1023 1024 /* 48Khz */ 1025 regmap_write(rt711->regmap, RT711_DAC_FORMAT_H, val); 1026 regmap_write(rt711->regmap, RT711_ADC1_FORMAT_H, val); 1027 regmap_write(rt711->regmap, RT711_ADC2_FORMAT_H, val); 1028 1029 return retval; 1030 } 1031 1032 static int rt711_pcm_hw_free(struct snd_pcm_substream *substream, 1033 struct snd_soc_dai *dai) 1034 { 1035 struct snd_soc_component *component = dai->component; 1036 struct rt711_priv *rt711 = snd_soc_component_get_drvdata(component); 1037 struct sdw_stream_data *stream = 1038 snd_soc_dai_get_dma_data(dai, substream); 1039 1040 if (!rt711->slave) 1041 return -EINVAL; 1042 1043 sdw_stream_remove_slave(rt711->slave, stream->sdw_stream); 1044 return 0; 1045 } 1046 1047 #define RT711_STEREO_RATES (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000) 1048 #define RT711_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \ 1049 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8) 1050 1051 static struct snd_soc_dai_ops rt711_ops = { 1052 .hw_params = rt711_pcm_hw_params, 1053 .hw_free = rt711_pcm_hw_free, 1054 .set_sdw_stream = rt711_set_sdw_stream, 1055 .shutdown = rt711_shutdown, 1056 }; 1057 1058 static struct snd_soc_dai_driver rt711_dai[] = { 1059 { 1060 .name = "rt711-aif1", 1061 .id = RT711_AIF1, 1062 .playback = { 1063 .stream_name = "DP3 Playback", 1064 .channels_min = 1, 1065 .channels_max = 2, 1066 .rates = RT711_STEREO_RATES, 1067 .formats = RT711_FORMATS, 1068 }, 1069 .capture = { 1070 .stream_name = "DP4 Capture", 1071 .channels_min = 1, 1072 .channels_max = 2, 1073 .rates = RT711_STEREO_RATES, 1074 .formats = RT711_FORMATS, 1075 }, 1076 .ops = &rt711_ops, 1077 }, 1078 { 1079 .name = "rt711-aif2", 1080 .id = RT711_AIF2, 1081 .capture = { 1082 .stream_name = "DP2 Capture", 1083 .channels_min = 1, 1084 .channels_max = 2, 1085 .rates = RT711_STEREO_RATES, 1086 .formats = RT711_FORMATS, 1087 }, 1088 .ops = &rt711_ops, 1089 } 1090 }; 1091 1092 /* Bus clock frequency */ 1093 #define RT711_CLK_FREQ_9600000HZ 9600000 1094 #define RT711_CLK_FREQ_12000000HZ 12000000 1095 #define RT711_CLK_FREQ_6000000HZ 6000000 1096 #define RT711_CLK_FREQ_4800000HZ 4800000 1097 #define RT711_CLK_FREQ_2400000HZ 2400000 1098 #define RT711_CLK_FREQ_12288000HZ 12288000 1099 1100 int rt711_clock_config(struct device *dev) 1101 { 1102 struct rt711_priv *rt711 = dev_get_drvdata(dev); 1103 unsigned int clk_freq, value; 1104 1105 clk_freq = (rt711->params.curr_dr_freq >> 1); 1106 1107 switch (clk_freq) { 1108 case RT711_CLK_FREQ_12000000HZ: 1109 value = 0x0; 1110 break; 1111 case RT711_CLK_FREQ_6000000HZ: 1112 value = 0x1; 1113 break; 1114 case RT711_CLK_FREQ_9600000HZ: 1115 value = 0x2; 1116 break; 1117 case RT711_CLK_FREQ_4800000HZ: 1118 value = 0x3; 1119 break; 1120 case RT711_CLK_FREQ_2400000HZ: 1121 value = 0x4; 1122 break; 1123 case RT711_CLK_FREQ_12288000HZ: 1124 value = 0x5; 1125 break; 1126 default: 1127 return -EINVAL; 1128 } 1129 1130 regmap_write(rt711->regmap, 0xe0, value); 1131 regmap_write(rt711->regmap, 0xf0, value); 1132 1133 dev_dbg(dev, "%s complete, clk_freq=%d\n", __func__, clk_freq); 1134 1135 return 0; 1136 } 1137 1138 static void rt711_calibration_work(struct work_struct *work) 1139 { 1140 struct rt711_priv *rt711 = 1141 container_of(work, struct rt711_priv, calibration_work); 1142 1143 rt711_calibration(rt711); 1144 } 1145 1146 int rt711_init(struct device *dev, struct regmap *sdw_regmap, 1147 struct regmap *regmap, struct sdw_slave *slave) 1148 { 1149 struct rt711_priv *rt711; 1150 int ret; 1151 1152 rt711 = devm_kzalloc(dev, sizeof(*rt711), GFP_KERNEL); 1153 if (!rt711) 1154 return -ENOMEM; 1155 1156 dev_set_drvdata(dev, rt711); 1157 rt711->slave = slave; 1158 rt711->sdw_regmap = sdw_regmap; 1159 rt711->regmap = regmap; 1160 1161 /* 1162 * Mark hw_init to false 1163 * HW init will be performed when device reports present 1164 */ 1165 rt711->hw_init = false; 1166 rt711->first_hw_init = false; 1167 1168 /* JD source uses JD2 in default */ 1169 rt711->jd_src = RT711_JD2; 1170 1171 ret = devm_snd_soc_register_component(dev, 1172 &soc_codec_dev_rt711, 1173 rt711_dai, 1174 ARRAY_SIZE(rt711_dai)); 1175 1176 dev_dbg(&slave->dev, "%s\n", __func__); 1177 1178 return ret; 1179 } 1180 1181 int rt711_io_init(struct device *dev, struct sdw_slave *slave) 1182 { 1183 struct rt711_priv *rt711 = dev_get_drvdata(dev); 1184 1185 if (rt711->hw_init) 1186 return 0; 1187 1188 if (rt711->first_hw_init) { 1189 regcache_cache_only(rt711->regmap, false); 1190 regcache_cache_bypass(rt711->regmap, true); 1191 } 1192 1193 /* 1194 * PM runtime is only enabled when a Slave reports as Attached 1195 */ 1196 if (!rt711->first_hw_init) { 1197 /* set autosuspend parameters */ 1198 pm_runtime_set_autosuspend_delay(&slave->dev, 3000); 1199 pm_runtime_use_autosuspend(&slave->dev); 1200 1201 /* update count of parent 'active' children */ 1202 pm_runtime_set_active(&slave->dev); 1203 1204 /* make sure the device does not suspend immediately */ 1205 pm_runtime_mark_last_busy(&slave->dev); 1206 1207 pm_runtime_enable(&slave->dev); 1208 } 1209 1210 pm_runtime_get_noresume(&slave->dev); 1211 1212 rt711_reset(rt711->regmap); 1213 1214 /* power on */ 1215 regmap_write(rt711->regmap, RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D0); 1216 1217 /* Set Pin Widget */ 1218 regmap_write(rt711->regmap, RT711_SET_PIN_MIC2, 0x25); 1219 regmap_write(rt711->regmap, RT711_SET_PIN_HP, 0xc0); 1220 regmap_write(rt711->regmap, RT711_SET_PIN_DMIC1, 0x20); 1221 regmap_write(rt711->regmap, RT711_SET_PIN_DMIC2, 0x20); 1222 regmap_write(rt711->regmap, RT711_SET_PIN_LINE1, 0x20); 1223 regmap_write(rt711->regmap, RT711_SET_PIN_LINE2, 0x20); 1224 1225 /* Mute HP/ADC1/ADC2 */ 1226 regmap_write(rt711->regmap, RT711_SET_GAIN_HP_H, 0xa080); 1227 regmap_write(rt711->regmap, RT711_SET_GAIN_HP_H, 0x9080); 1228 regmap_write(rt711->regmap, RT711_SET_GAIN_ADC2_H, 0x6080); 1229 regmap_write(rt711->regmap, RT711_SET_GAIN_ADC2_H, 0x5080); 1230 regmap_write(rt711->regmap, RT711_SET_GAIN_ADC1_H, 0x6080); 1231 regmap_write(rt711->regmap, RT711_SET_GAIN_ADC1_H, 0x5080); 1232 1233 /* Set Configuration Default */ 1234 regmap_write(rt711->regmap, 0x4f12, 0x91); 1235 regmap_write(rt711->regmap, 0x4e12, 0xd6); 1236 regmap_write(rt711->regmap, 0x4d12, 0x11); 1237 regmap_write(rt711->regmap, 0x4c12, 0x20); 1238 regmap_write(rt711->regmap, 0x4f13, 0x91); 1239 regmap_write(rt711->regmap, 0x4e13, 0xd6); 1240 regmap_write(rt711->regmap, 0x4d13, 0x11); 1241 regmap_write(rt711->regmap, 0x4c13, 0x21); 1242 regmap_write(rt711->regmap, 0x4c21, 0xf0); 1243 regmap_write(rt711->regmap, 0x4d21, 0x11); 1244 regmap_write(rt711->regmap, 0x4e21, 0x11); 1245 regmap_write(rt711->regmap, 0x4f21, 0x01); 1246 1247 /* Data port arrangement */ 1248 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 1249 RT711_TX_RX_MUX_CTL, 0x0154); 1250 1251 /* Set index */ 1252 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 1253 RT711_DIGITAL_MISC_CTRL4, 0x201b); 1254 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 1255 RT711_COMBO_JACK_AUTO_CTL1, 0x5089); 1256 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 1257 RT711_VREFOUT_CTL, 0x5064); 1258 rt711_index_write(rt711->regmap, RT711_VENDOR_REG, 1259 RT711_INLINE_CMD_CTL, 0xd249); 1260 1261 /* Finish Initial Settings, set power to D3 */ 1262 regmap_write(rt711->regmap, RT711_SET_AUDIO_POWER_STATE, AC_PWRST_D3); 1263 1264 if (rt711->first_hw_init) 1265 rt711_calibration(rt711); 1266 else { 1267 INIT_DELAYED_WORK(&rt711->jack_detect_work, 1268 rt711_jack_detect_handler); 1269 INIT_DELAYED_WORK(&rt711->jack_btn_check_work, 1270 rt711_btn_check_handler); 1271 mutex_init(&rt711->calibrate_mutex); 1272 INIT_WORK(&rt711->calibration_work, rt711_calibration_work); 1273 schedule_work(&rt711->calibration_work); 1274 } 1275 1276 /* 1277 * if set_jack callback occurred early than io_init, 1278 * we set up the jack detection function now 1279 */ 1280 if (rt711->hs_jack) 1281 rt711_jack_init(rt711); 1282 1283 if (rt711->first_hw_init) { 1284 regcache_cache_bypass(rt711->regmap, false); 1285 regcache_mark_dirty(rt711->regmap); 1286 } else 1287 rt711->first_hw_init = true; 1288 1289 /* Mark Slave initialization complete */ 1290 rt711->hw_init = true; 1291 1292 pm_runtime_mark_last_busy(&slave->dev); 1293 pm_runtime_put_autosuspend(&slave->dev); 1294 1295 dev_dbg(&slave->dev, "%s hw_init complete\n", __func__); 1296 return 0; 1297 } 1298 1299 MODULE_DESCRIPTION("ASoC RT711 SDW driver"); 1300 MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>"); 1301 MODULE_LICENSE("GPL"); 1302