1 // SPDX-License-Identifier: GPL-2.0-only
2 //
3 // rt712-sdca.c -- rt712 SDCA ALSA SoC audio driver
4 //
5 // Copyright(c) 2023 Realtek Semiconductor Corp.
6 //
7 //
8
9 #include <linux/bitops.h>
10 #include <sound/core.h>
11 #include <linux/delay.h>
12 #include <linux/init.h>
13 #include <sound/initval.h>
14 #include <sound/jack.h>
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/moduleparam.h>
18 #include <linux/pm_runtime.h>
19 #include <sound/pcm.h>
20 #include <sound/pcm_params.h>
21 #include <sound/sdca.h>
22 #include <linux/soundwire/sdw_registers.h>
23 #include <linux/slab.h>
24 #include <sound/soc-dapm.h>
25 #include <sound/tlv.h>
26 #include "rt712-sdca.h"
27
rt712_sdca_index_write(struct rt712_sdca_priv * rt712,unsigned int nid,unsigned int reg,unsigned int value)28 static int rt712_sdca_index_write(struct rt712_sdca_priv *rt712,
29 unsigned int nid, unsigned int reg, unsigned int value)
30 {
31 int ret;
32 struct regmap *regmap = rt712->mbq_regmap;
33 unsigned int addr = (nid << 20) | reg;
34
35 ret = regmap_write(regmap, addr, value);
36 if (ret < 0)
37 dev_err(&rt712->slave->dev,
38 "%s: Failed to set private value: %06x <= %04x ret=%d\n",
39 __func__, addr, value, ret);
40
41 return ret;
42 }
43
rt712_sdca_index_read(struct rt712_sdca_priv * rt712,unsigned int nid,unsigned int reg,unsigned int * value)44 static int rt712_sdca_index_read(struct rt712_sdca_priv *rt712,
45 unsigned int nid, unsigned int reg, unsigned int *value)
46 {
47 int ret;
48 struct regmap *regmap = rt712->mbq_regmap;
49 unsigned int addr = (nid << 20) | reg;
50
51 ret = regmap_read(regmap, addr, value);
52 if (ret < 0)
53 dev_err(&rt712->slave->dev,
54 "%s: Failed to get private value: %06x => %04x ret=%d\n",
55 __func__, addr, *value, ret);
56
57 return ret;
58 }
59
rt712_sdca_index_update_bits(struct rt712_sdca_priv * rt712,unsigned int nid,unsigned int reg,unsigned int mask,unsigned int val)60 static int rt712_sdca_index_update_bits(struct rt712_sdca_priv *rt712,
61 unsigned int nid, unsigned int reg, unsigned int mask, unsigned int val)
62 {
63 unsigned int tmp;
64 int ret;
65
66 ret = rt712_sdca_index_read(rt712, nid, reg, &tmp);
67 if (ret < 0)
68 return ret;
69
70 set_mask_bits(&tmp, mask, val);
71 return rt712_sdca_index_write(rt712, nid, reg, tmp);
72 }
73
rt712_sdca_calibration(struct rt712_sdca_priv * rt712)74 static int rt712_sdca_calibration(struct rt712_sdca_priv *rt712)
75 {
76 unsigned int val, loop_rc = 0, loop_dc = 0;
77 struct device *dev;
78 struct regmap *regmap = rt712->regmap;
79 int chk_cnt = 100;
80 int ret = 0;
81
82 mutex_lock(&rt712->calibrate_mutex);
83 dev = regmap_get_device(regmap);
84
85 /* Set HP-JD source from JD1 */
86 if (rt712->version_id == RT712_VA)
87 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CC_DET1, 0x043a);
88
89 /* FSM switch to calibration manual mode */
90 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_FSM_CTL, 0x4100);
91
92 /* Calibration setting */
93 rt712_sdca_index_write(rt712, RT712_VENDOR_CALI, RT712_DAC_DC_CALI_CTL1, 0x7883);
94
95 /* W1C Trigger DC calibration (HP & Class-D) */
96 rt712_sdca_index_write(rt712, RT712_VENDOR_CALI, RT712_DAC_DC_CALI_CTL1, 0xf893);
97
98 /* wait for calibration process */
99 rt712_sdca_index_read(rt712, RT712_VENDOR_CALI,
100 RT712_DAC_DC_CALI_CTL1, &val);
101
102 for (loop_dc = 0; loop_dc < chk_cnt &&
103 (val & RT712_DAC_DC_CALI_TRIGGER); loop_dc++) {
104 usleep_range(10000, 11000);
105 ret = rt712_sdca_index_read(rt712, RT712_VENDOR_CALI,
106 RT712_DAC_DC_CALI_CTL1, &val);
107 if (ret < 0)
108 goto _cali_fail_;
109 }
110 if (loop_dc == chk_cnt)
111 dev_err(dev, "%s, calibration time-out!\n", __func__);
112
113 if (loop_dc == chk_cnt || loop_rc == chk_cnt)
114 ret = -ETIMEDOUT;
115
116 _cali_fail_:
117 /* Enable Rldet in FSM */
118 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_FSM_CTL, 0x4500);
119
120 /* Sensing Lch+Rch */
121 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_IMS_DIGITAL_CTL1, 0x040f);
122
123 /* Sine gen path control */
124 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_IMS_DIGITAL_CTL5, 0x0000);
125
126 /* Release HP-JD, EN_CBJ_TIE_GL/R open, en_osw gating auto done bit */
127 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_DIGITAL_MISC_CTRL4, 0x0010);
128
129 mutex_unlock(&rt712->calibrate_mutex);
130 dev_dbg(dev, "%s calibration complete, ret=%d\n", __func__, ret);
131 return ret;
132 }
133
rt712_sdca_button_detect(struct rt712_sdca_priv * rt712)134 static unsigned int rt712_sdca_button_detect(struct rt712_sdca_priv *rt712)
135 {
136 unsigned int btn_type = 0, offset, idx, val, owner;
137 int ret;
138 unsigned char buf[3];
139
140 /* get current UMP message owner */
141 ret = regmap_read(rt712->regmap,
142 SDW_SDCA_CTL(FUNC_NUM_HID, RT712_SDCA_ENT_HID01, RT712_SDCA_CTL_HIDTX_CURRENT_OWNER, 0),
143 &owner);
144 if (ret < 0)
145 return 0;
146
147 /* if owner is device then there is no button event from device */
148 if (owner == 1)
149 return 0;
150
151 /* read UMP message offset */
152 ret = regmap_read(rt712->regmap,
153 SDW_SDCA_CTL(FUNC_NUM_HID, RT712_SDCA_ENT_HID01, RT712_SDCA_CTL_HIDTX_MESSAGE_OFFSET, 0),
154 &offset);
155 if (ret < 0)
156 goto _end_btn_det_;
157
158 for (idx = 0; idx < sizeof(buf); idx++) {
159 ret = regmap_read(rt712->regmap,
160 RT712_BUF_ADDR_HID1 + offset + idx, &val);
161 if (ret < 0)
162 goto _end_btn_det_;
163 buf[idx] = val & 0xff;
164 }
165
166 if (buf[0] == 0x11) {
167 switch (buf[1] & 0xf0) {
168 case 0x10:
169 btn_type |= SND_JACK_BTN_2;
170 break;
171 case 0x20:
172 btn_type |= SND_JACK_BTN_3;
173 break;
174 case 0x40:
175 btn_type |= SND_JACK_BTN_0;
176 break;
177 case 0x80:
178 btn_type |= SND_JACK_BTN_1;
179 break;
180 }
181 switch (buf[2]) {
182 case 0x01:
183 case 0x10:
184 btn_type |= SND_JACK_BTN_2;
185 break;
186 case 0x02:
187 case 0x20:
188 btn_type |= SND_JACK_BTN_3;
189 break;
190 case 0x04:
191 case 0x40:
192 btn_type |= SND_JACK_BTN_0;
193 break;
194 case 0x08:
195 case 0x80:
196 btn_type |= SND_JACK_BTN_1;
197 break;
198 }
199 }
200
201 _end_btn_det_:
202 /* Host is owner, so set back to device */
203 if (owner == 0) {
204 /* set owner to device */
205 if (rt712->version_id == RT712_VA)
206 regmap_write(rt712->regmap,
207 SDW_SDCA_CTL(FUNC_NUM_HID, RT712_SDCA_ENT_HID01,
208 RT712_SDCA_CTL_HIDTX_SET_OWNER_TO_DEVICE, 0), 0x01);
209 else
210 regmap_write(rt712->regmap,
211 SDW_SDCA_CTL(FUNC_NUM_HID, RT712_SDCA_ENT_HID01,
212 RT712_SDCA_CTL_HIDTX_CURRENT_OWNER, 0), 0x01);
213 }
214
215 return btn_type;
216 }
217
rt712_sdca_headset_detect(struct rt712_sdca_priv * rt712)218 static int rt712_sdca_headset_detect(struct rt712_sdca_priv *rt712)
219 {
220 unsigned int det_mode;
221 int ret;
222
223 /* get detected_mode */
224 ret = regmap_read(rt712->regmap,
225 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_GE49, RT712_SDCA_CTL_DETECTED_MODE, 0),
226 &det_mode);
227 if (ret < 0)
228 goto io_error;
229
230 switch (det_mode) {
231 case 0x00:
232 rt712->jack_type = 0;
233 break;
234 case 0x03:
235 rt712->jack_type = SND_JACK_HEADPHONE;
236 break;
237 case 0x05:
238 rt712->jack_type = SND_JACK_HEADSET;
239 break;
240 }
241
242 /* write selected_mode */
243 if (det_mode) {
244 ret = regmap_write(rt712->regmap,
245 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_GE49, RT712_SDCA_CTL_SELECTED_MODE, 0),
246 det_mode);
247 if (ret < 0)
248 goto io_error;
249 }
250
251 dev_dbg(&rt712->slave->dev,
252 "%s, detected_mode=0x%x\n", __func__, det_mode);
253
254 return 0;
255
256 io_error:
257 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret);
258 return ret;
259 }
260
rt712_sdca_jack_detect_handler(struct work_struct * work)261 static void rt712_sdca_jack_detect_handler(struct work_struct *work)
262 {
263 struct rt712_sdca_priv *rt712 =
264 container_of(work, struct rt712_sdca_priv, jack_detect_work.work);
265 int btn_type = 0, ret;
266
267 if (!rt712->hs_jack)
268 return;
269
270 if (!rt712->component->card || !rt712->component->card->instantiated)
271 return;
272
273 /* SDW_SCP_SDCA_INT_SDCA_0 is used for jack detection */
274 if (rt712->scp_sdca_stat1 & SDW_SCP_SDCA_INT_SDCA_0) {
275 ret = rt712_sdca_headset_detect(rt712);
276 if (ret < 0)
277 return;
278 }
279
280 /* SDW_SCP_SDCA_INT_SDCA_8 is used for button detection */
281 if (rt712->scp_sdca_stat2 & SDW_SCP_SDCA_INT_SDCA_8)
282 btn_type = rt712_sdca_button_detect(rt712);
283
284 if (rt712->jack_type == 0)
285 btn_type = 0;
286
287 dev_dbg(&rt712->slave->dev,
288 "in %s, jack_type=0x%x\n", __func__, rt712->jack_type);
289 dev_dbg(&rt712->slave->dev,
290 "in %s, btn_type=0x%x\n", __func__, btn_type);
291 dev_dbg(&rt712->slave->dev,
292 "in %s, scp_sdca_stat1=0x%x, scp_sdca_stat2=0x%x\n", __func__,
293 rt712->scp_sdca_stat1, rt712->scp_sdca_stat2);
294
295 snd_soc_jack_report(rt712->hs_jack, rt712->jack_type | btn_type,
296 SND_JACK_HEADSET |
297 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
298 SND_JACK_BTN_2 | SND_JACK_BTN_3);
299
300 if (btn_type) {
301 /* button released */
302 snd_soc_jack_report(rt712->hs_jack, rt712->jack_type,
303 SND_JACK_HEADSET |
304 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
305 SND_JACK_BTN_2 | SND_JACK_BTN_3);
306
307 mod_delayed_work(system_power_efficient_wq,
308 &rt712->jack_btn_check_work, msecs_to_jiffies(200));
309 }
310 }
311
rt712_sdca_btn_check_handler(struct work_struct * work)312 static void rt712_sdca_btn_check_handler(struct work_struct *work)
313 {
314 struct rt712_sdca_priv *rt712 =
315 container_of(work, struct rt712_sdca_priv, jack_btn_check_work.work);
316 int btn_type = 0, ret, idx;
317 unsigned int det_mode, offset, val;
318 unsigned char buf[3];
319
320 ret = regmap_read(rt712->regmap,
321 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_GE49, RT712_SDCA_CTL_DETECTED_MODE, 0),
322 &det_mode);
323 if (ret < 0)
324 goto io_error;
325
326 /* pin attached */
327 if (det_mode) {
328 /* read UMP message offset */
329 ret = regmap_read(rt712->regmap,
330 SDW_SDCA_CTL(FUNC_NUM_HID, RT712_SDCA_ENT_HID01, RT712_SDCA_CTL_HIDTX_MESSAGE_OFFSET, 0),
331 &offset);
332 if (ret < 0)
333 goto io_error;
334
335 for (idx = 0; idx < sizeof(buf); idx++) {
336 ret = regmap_read(rt712->regmap,
337 RT712_BUF_ADDR_HID1 + offset + idx, &val);
338 if (ret < 0)
339 goto io_error;
340 buf[idx] = val & 0xff;
341 }
342
343 if (buf[0] == 0x11) {
344 switch (buf[1] & 0xf0) {
345 case 0x10:
346 btn_type |= SND_JACK_BTN_2;
347 break;
348 case 0x20:
349 btn_type |= SND_JACK_BTN_3;
350 break;
351 case 0x40:
352 btn_type |= SND_JACK_BTN_0;
353 break;
354 case 0x80:
355 btn_type |= SND_JACK_BTN_1;
356 break;
357 }
358 switch (buf[2]) {
359 case 0x01:
360 case 0x10:
361 btn_type |= SND_JACK_BTN_2;
362 break;
363 case 0x02:
364 case 0x20:
365 btn_type |= SND_JACK_BTN_3;
366 break;
367 case 0x04:
368 case 0x40:
369 btn_type |= SND_JACK_BTN_0;
370 break;
371 case 0x08:
372 case 0x80:
373 btn_type |= SND_JACK_BTN_1;
374 break;
375 }
376 }
377 } else {
378 rt712->jack_type = 0;
379 }
380
381 dev_dbg(&rt712->slave->dev, "%s, btn_type=0x%x\n", __func__, btn_type);
382 snd_soc_jack_report(rt712->hs_jack, rt712->jack_type | btn_type,
383 SND_JACK_HEADSET |
384 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
385 SND_JACK_BTN_2 | SND_JACK_BTN_3);
386
387 if (btn_type) {
388 /* button released */
389 snd_soc_jack_report(rt712->hs_jack, rt712->jack_type,
390 SND_JACK_HEADSET |
391 SND_JACK_BTN_0 | SND_JACK_BTN_1 |
392 SND_JACK_BTN_2 | SND_JACK_BTN_3);
393
394 mod_delayed_work(system_power_efficient_wq,
395 &rt712->jack_btn_check_work, msecs_to_jiffies(200));
396 }
397
398 return;
399
400 io_error:
401 pr_err_ratelimited("IO error in %s, ret %d\n", __func__, ret);
402 }
403
rt712_sdca_jack_init(struct rt712_sdca_priv * rt712)404 static void rt712_sdca_jack_init(struct rt712_sdca_priv *rt712)
405 {
406 mutex_lock(&rt712->calibrate_mutex);
407
408 if (rt712->hs_jack) {
409 /* Enable HID1 event & set button RTC mode */
410 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
411 RT712_UMP_HID_CTL5, 0xfff0);
412 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
413 RT712_UMP_HID_CTL0, 0x1100, 0x1100);
414 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
415 RT712_UMP_HID_CTL7, 0xf000, 0x0000);
416
417 /* detected_mode_change_event_en & hid1_push_button_event_en */
418 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
419 RT712_GE_RELATED_CTL1, 0x0c00, 0x0c00);
420 /* ge_inbox_en */
421 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
422 RT712_GE_RELATED_CTL2, 0x0020, 0x0000);
423
424 switch (rt712->jd_src) {
425 case RT712_JD1:
426 /* Set HP-JD source from JD1, VB uses JD1 in default */
427 if (rt712->version_id == RT712_VA)
428 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CC_DET1, 0x043a);
429 break;
430 default:
431 dev_warn(rt712->component->dev, "Wrong JD source\n");
432 break;
433 }
434
435 /* set SCP_SDCA_IntMask1[0]=1 */
436 sdw_write_no_pm(rt712->slave, SDW_SCP_SDCA_INTMASK1, SDW_SCP_SDCA_INTMASK_SDCA_0);
437 /* set SCP_SDCA_IntMask2[0]=1 */
438 sdw_write_no_pm(rt712->slave, SDW_SCP_SDCA_INTMASK2, SDW_SCP_SDCA_INTMASK_SDCA_8);
439 dev_dbg(&rt712->slave->dev, "in %s enable\n", __func__);
440
441 /* trigger GE interrupt */
442 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
443 RT712_GE_RELATED_CTL1, 0x0080, 0x0080);
444 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
445 RT712_GE_RELATED_CTL1, 0x0080, 0x0000);
446 } else {
447 /* disable HID1 & detected_mode_change event */
448 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
449 RT712_GE_RELATED_CTL1, 0x0c00, 0x0000);
450
451 dev_dbg(&rt712->slave->dev, "in %s disable\n", __func__);
452 }
453
454 mutex_unlock(&rt712->calibrate_mutex);
455 }
456
rt712_sdca_set_jack_detect(struct snd_soc_component * component,struct snd_soc_jack * hs_jack,void * data)457 static int rt712_sdca_set_jack_detect(struct snd_soc_component *component,
458 struct snd_soc_jack *hs_jack, void *data)
459 {
460 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
461 int ret;
462
463 rt712->hs_jack = hs_jack;
464
465 if (!rt712->first_hw_init)
466 return 0;
467
468 ret = pm_runtime_resume_and_get(component->dev);
469 if (ret < 0) {
470 if (ret != -EACCES) {
471 dev_err(component->dev, "%s: failed to resume %d\n", __func__, ret);
472 return ret;
473 }
474
475 /* pm_runtime not enabled yet */
476 dev_dbg(component->dev, "%s: skipping jack init for now\n", __func__);
477 return 0;
478 }
479
480 rt712_sdca_jack_init(rt712);
481
482 pm_runtime_mark_last_busy(component->dev);
483 pm_runtime_put_autosuspend(component->dev);
484
485 return 0;
486 }
487
488 /* For SDCA control DAC/ADC Gain */
rt712_sdca_set_gain_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)489 static int rt712_sdca_set_gain_put(struct snd_kcontrol *kcontrol,
490 struct snd_ctl_elem_value *ucontrol)
491 {
492 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
493 struct soc_mixer_control *mc =
494 (struct soc_mixer_control *)kcontrol->private_value;
495 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
496 unsigned int read_l, read_r, gain_l_val, gain_r_val;
497 unsigned int adc_vol_flag = 0;
498 unsigned int lvalue, rvalue;
499 const unsigned int interval_offset = 0xc0;
500 const unsigned int tendB = 0xa00;
501
502 if (strstr(ucontrol->id.name, "FU0F Capture Volume"))
503 adc_vol_flag = 1;
504
505 regmap_read(rt712->mbq_regmap, mc->reg, &lvalue);
506 regmap_read(rt712->mbq_regmap, mc->rreg, &rvalue);
507
508 /* L Channel */
509 gain_l_val = ucontrol->value.integer.value[0];
510 if (gain_l_val > mc->max)
511 gain_l_val = mc->max;
512
513 if (mc->shift == 8) /* boost gain */
514 gain_l_val = gain_l_val * tendB;
515 else {
516 /* ADC/DAC gain */
517 if (adc_vol_flag)
518 gain_l_val = 0x1e00 - ((mc->max - gain_l_val) * interval_offset);
519 else
520 gain_l_val = 0 - ((mc->max - gain_l_val) * interval_offset);
521 gain_l_val &= 0xffff;
522 }
523
524 /* R Channel */
525 gain_r_val = ucontrol->value.integer.value[1];
526 if (gain_r_val > mc->max)
527 gain_r_val = mc->max;
528
529 if (mc->shift == 8) /* boost gain */
530 gain_r_val = gain_r_val * tendB;
531 else {
532 /* ADC/DAC gain */
533 if (adc_vol_flag)
534 gain_r_val = 0x1e00 - ((mc->max - gain_r_val) * interval_offset);
535 else
536 gain_r_val = 0 - ((mc->max - gain_r_val) * interval_offset);
537 gain_r_val &= 0xffff;
538 }
539
540 if (lvalue == gain_l_val && rvalue == gain_r_val)
541 return 0;
542
543 /* Lch*/
544 regmap_write(rt712->mbq_regmap, mc->reg, gain_l_val);
545 /* Rch */
546 regmap_write(rt712->mbq_regmap, mc->rreg, gain_r_val);
547
548 regmap_read(rt712->mbq_regmap, mc->reg, &read_l);
549 regmap_read(rt712->mbq_regmap, mc->rreg, &read_r);
550 if (read_r == gain_r_val && read_l == gain_l_val)
551 return 1;
552
553 return -EIO;
554 }
555
rt712_sdca_set_gain_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)556 static int rt712_sdca_set_gain_get(struct snd_kcontrol *kcontrol,
557 struct snd_ctl_elem_value *ucontrol)
558 {
559 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
560 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
561 struct soc_mixer_control *mc =
562 (struct soc_mixer_control *)kcontrol->private_value;
563 unsigned int read_l, read_r, ctl_l = 0, ctl_r = 0;
564 unsigned int adc_vol_flag = 0;
565 const unsigned int interval_offset = 0xc0;
566 const unsigned int tendB = 0xa00;
567
568 if (strstr(ucontrol->id.name, "FU0F Capture Volume"))
569 adc_vol_flag = 1;
570
571 regmap_read(rt712->mbq_regmap, mc->reg, &read_l);
572 regmap_read(rt712->mbq_regmap, mc->rreg, &read_r);
573
574 if (mc->shift == 8) /* boost gain */
575 ctl_l = read_l / tendB;
576 else {
577 if (adc_vol_flag)
578 ctl_l = mc->max - (((0x1e00 - read_l) & 0xffff) / interval_offset);
579 else
580 ctl_l = mc->max - (((0 - read_l) & 0xffff) / interval_offset);
581 }
582
583 if (read_l != read_r) {
584 if (mc->shift == 8) /* boost gain */
585 ctl_r = read_r / tendB;
586 else { /* ADC/DAC gain */
587 if (adc_vol_flag)
588 ctl_r = mc->max - (((0x1e00 - read_r) & 0xffff) / interval_offset);
589 else
590 ctl_r = mc->max - (((0 - read_r) & 0xffff) / interval_offset);
591 }
592 } else
593 ctl_r = ctl_l;
594
595 ucontrol->value.integer.value[0] = ctl_l;
596 ucontrol->value.integer.value[1] = ctl_r;
597
598 return 0;
599 }
600
rt712_sdca_set_fu0f_capture_ctl(struct rt712_sdca_priv * rt712)601 static int rt712_sdca_set_fu0f_capture_ctl(struct rt712_sdca_priv *rt712)
602 {
603 int err;
604 unsigned int ch_01, ch_02;
605
606 ch_01 = (rt712->fu0f_dapm_mute || rt712->fu0f_mixer_l_mute) ? 0x01 : 0x00;
607 ch_02 = (rt712->fu0f_dapm_mute || rt712->fu0f_mixer_r_mute) ? 0x01 : 0x00;
608
609 err = regmap_write(rt712->regmap,
610 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F,
611 RT712_SDCA_CTL_FU_MUTE, CH_01), ch_01);
612 if (err < 0)
613 return err;
614
615 err = regmap_write(rt712->regmap,
616 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F,
617 RT712_SDCA_CTL_FU_MUTE, CH_02), ch_02);
618 if (err < 0)
619 return err;
620
621 return 0;
622 }
623
rt712_sdca_fu0f_capture_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)624 static int rt712_sdca_fu0f_capture_get(struct snd_kcontrol *kcontrol,
625 struct snd_ctl_elem_value *ucontrol)
626 {
627 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
628 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
629
630 ucontrol->value.integer.value[0] = !rt712->fu0f_mixer_l_mute;
631 ucontrol->value.integer.value[1] = !rt712->fu0f_mixer_r_mute;
632 return 0;
633 }
634
rt712_sdca_fu0f_capture_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)635 static int rt712_sdca_fu0f_capture_put(struct snd_kcontrol *kcontrol,
636 struct snd_ctl_elem_value *ucontrol)
637 {
638 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
639 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
640 int err;
641
642 if (rt712->fu0f_mixer_l_mute == !ucontrol->value.integer.value[0] &&
643 rt712->fu0f_mixer_r_mute == !ucontrol->value.integer.value[1])
644 return 0;
645
646 rt712->fu0f_mixer_l_mute = !ucontrol->value.integer.value[0];
647 rt712->fu0f_mixer_r_mute = !ucontrol->value.integer.value[1];
648 err = rt712_sdca_set_fu0f_capture_ctl(rt712);
649 if (err < 0)
650 return err;
651
652 return 1;
653 }
654
rt712_sdca_set_fu05_playback_ctl(struct rt712_sdca_priv * rt712)655 static int rt712_sdca_set_fu05_playback_ctl(struct rt712_sdca_priv *rt712)
656 {
657 int err;
658 unsigned int ch_01, ch_02;
659
660 ch_01 = (rt712->fu05_dapm_mute || rt712->fu05_mixer_l_mute) ? 0x01 : 0x00;
661 ch_02 = (rt712->fu05_dapm_mute || rt712->fu05_mixer_r_mute) ? 0x01 : 0x00;
662
663 err = regmap_write(rt712->regmap,
664 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05,
665 RT712_SDCA_CTL_FU_MUTE, CH_01), ch_01);
666 if (err < 0)
667 return err;
668
669 err = regmap_write(rt712->regmap,
670 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05,
671 RT712_SDCA_CTL_FU_MUTE, CH_02), ch_02);
672 if (err < 0)
673 return err;
674
675 return 0;
676 }
677
rt712_sdca_fu05_playback_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)678 static int rt712_sdca_fu05_playback_get(struct snd_kcontrol *kcontrol,
679 struct snd_ctl_elem_value *ucontrol)
680 {
681 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
682 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
683
684 ucontrol->value.integer.value[0] = !rt712->fu05_mixer_l_mute;
685 ucontrol->value.integer.value[1] = !rt712->fu05_mixer_r_mute;
686 return 0;
687 }
688
rt712_sdca_fu05_playback_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)689 static int rt712_sdca_fu05_playback_put(struct snd_kcontrol *kcontrol,
690 struct snd_ctl_elem_value *ucontrol)
691 {
692 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
693 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
694 int err;
695
696 if (rt712->fu05_mixer_l_mute == !ucontrol->value.integer.value[0] &&
697 rt712->fu05_mixer_r_mute == !ucontrol->value.integer.value[1])
698 return 0;
699
700 rt712->fu05_mixer_l_mute = !ucontrol->value.integer.value[0];
701 rt712->fu05_mixer_r_mute = !ucontrol->value.integer.value[1];
702
703 err = rt712_sdca_set_fu05_playback_ctl(rt712);
704 if (err < 0)
705 return err;
706
707 return 1;
708 }
709
710 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -6525, 75, 0);
711 static const DECLARE_TLV_DB_SCALE(mic_vol_tlv, -1725, 75, 0);
712 static const DECLARE_TLV_DB_SCALE(boost_vol_tlv, 0, 1000, 0);
713
714 static const struct snd_kcontrol_new rt712_sdca_controls[] = {
715 SOC_DOUBLE_R_EXT_TLV("FU05 Playback Volume",
716 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05, RT712_SDCA_CTL_FU_VOLUME, CH_01),
717 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05, RT712_SDCA_CTL_FU_VOLUME, CH_02),
718 0, 0x57, 0,
719 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, out_vol_tlv),
720 SOC_DOUBLE_EXT("FU0F Capture Switch", SND_SOC_NOPM, 0, 1, 1, 0,
721 rt712_sdca_fu0f_capture_get, rt712_sdca_fu0f_capture_put),
722 SOC_DOUBLE_R_EXT_TLV("FU0F Capture Volume",
723 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F, RT712_SDCA_CTL_FU_VOLUME, CH_01),
724 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F, RT712_SDCA_CTL_FU_VOLUME, CH_02),
725 0, 0x3f, 0,
726 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, mic_vol_tlv),
727 SOC_DOUBLE_R_EXT_TLV("FU44 Boost Volume",
728 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PLATFORM_FU44, RT712_SDCA_CTL_FU_CH_GAIN, CH_01),
729 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PLATFORM_FU44, RT712_SDCA_CTL_FU_CH_GAIN, CH_02),
730 8, 3, 0,
731 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, boost_vol_tlv),
732 SOC_DOUBLE_EXT("FU05 Playback Switch", SND_SOC_NOPM, 0, 1, 1, 0,
733 rt712_sdca_fu05_playback_get, rt712_sdca_fu05_playback_put),
734 };
735
736 static const struct snd_kcontrol_new rt712_sdca_spk_controls[] = {
737 SOC_DOUBLE_R_EXT_TLV("FU06 Playback Volume",
738 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_VOLUME, CH_01),
739 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_VOLUME, CH_02),
740 0, 0x57, 0,
741 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, out_vol_tlv),
742 };
743
rt712_sdca_mux_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)744 static int rt712_sdca_mux_get(struct snd_kcontrol *kcontrol,
745 struct snd_ctl_elem_value *ucontrol)
746 {
747 struct snd_soc_component *component =
748 snd_soc_dapm_kcontrol_component(kcontrol);
749 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
750 unsigned int val = 0, mask = 0x3300;
751
752 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, &val);
753
754 val = val & mask;
755 switch (val) {
756 case 0x3000:
757 val = 1;
758 break;
759 case 0x0300:
760 val = 0;
761 break;
762 }
763
764 ucontrol->value.enumerated.item[0] = val;
765
766 return 0;
767 }
768
rt712_sdca_mux_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)769 static int rt712_sdca_mux_put(struct snd_kcontrol *kcontrol,
770 struct snd_ctl_elem_value *ucontrol)
771 {
772 struct snd_soc_component *component =
773 snd_soc_dapm_kcontrol_component(kcontrol);
774 struct snd_soc_dapm_context *dapm =
775 snd_soc_dapm_kcontrol_dapm(kcontrol);
776 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
777 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
778 unsigned int *item = ucontrol->value.enumerated.item;
779 unsigned int mask_sft;
780 unsigned int val;
781
782 if (item[0] >= e->items)
783 return -EINVAL;
784
785 if (ucontrol->value.enumerated.item[0] == 0)
786 mask_sft = 12;
787 else if (ucontrol->value.enumerated.item[0] == 1)
788 mask_sft = 8;
789 else
790 return -EINVAL;
791
792 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, &val);
793 val = (val >> mask_sft) & 0x3;
794 if (!val)
795 return 0;
796
797 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
798 RT712_MIXER_CTL1, 0x3fff);
799 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
800 RT712_MIXER_CTL1, 0x3 << mask_sft, 0);
801
802 snd_soc_dapm_mux_update_power(dapm, kcontrol,
803 item[0], e, NULL);
804
805 return 1;
806 }
807
808 static const char * const adc_mux_text[] = {
809 "MIC2",
810 "LINE2",
811 };
812
813 static SOC_ENUM_SINGLE_DECL(
814 rt712_adc23_enum, SND_SOC_NOPM, 0, adc_mux_text);
815
816 static const struct snd_kcontrol_new rt712_sdca_adc23_mux =
817 SOC_DAPM_ENUM_EXT("ADC 23 Mux", rt712_adc23_enum,
818 rt712_sdca_mux_get, rt712_sdca_mux_put);
819
rt712_sdca_fu05_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)820 static int rt712_sdca_fu05_event(struct snd_soc_dapm_widget *w,
821 struct snd_kcontrol *kcontrol, int event)
822 {
823 struct snd_soc_component *component =
824 snd_soc_dapm_to_component(w->dapm);
825 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
826
827 switch (event) {
828 case SND_SOC_DAPM_POST_PMU:
829 rt712->fu05_dapm_mute = false;
830 rt712_sdca_set_fu05_playback_ctl(rt712);
831 break;
832 case SND_SOC_DAPM_PRE_PMD:
833 rt712->fu05_dapm_mute = true;
834 rt712_sdca_set_fu05_playback_ctl(rt712);
835 break;
836 }
837 return 0;
838 }
839
rt712_sdca_fu0f_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)840 static int rt712_sdca_fu0f_event(struct snd_soc_dapm_widget *w,
841 struct snd_kcontrol *kcontrol, int event)
842 {
843 struct snd_soc_component *component =
844 snd_soc_dapm_to_component(w->dapm);
845 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
846
847 switch (event) {
848 case SND_SOC_DAPM_POST_PMU:
849 rt712->fu0f_dapm_mute = false;
850 rt712_sdca_set_fu0f_capture_ctl(rt712);
851 break;
852 case SND_SOC_DAPM_PRE_PMD:
853 rt712->fu0f_dapm_mute = true;
854 rt712_sdca_set_fu0f_capture_ctl(rt712);
855 break;
856 }
857 return 0;
858 }
859
rt712_sdca_pde40_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)860 static int rt712_sdca_pde40_event(struct snd_soc_dapm_widget *w,
861 struct snd_kcontrol *kcontrol, int event)
862 {
863 struct snd_soc_component *component =
864 snd_soc_dapm_to_component(w->dapm);
865 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
866 unsigned char ps0 = 0x0, ps3 = 0x3;
867
868 switch (event) {
869 case SND_SOC_DAPM_POST_PMU:
870 regmap_write(rt712->regmap,
871 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE40,
872 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
873 ps0);
874 break;
875 case SND_SOC_DAPM_PRE_PMD:
876 regmap_write(rt712->regmap,
877 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE40,
878 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
879 ps3);
880 break;
881 }
882 return 0;
883 }
884
rt712_sdca_pde12_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)885 static int rt712_sdca_pde12_event(struct snd_soc_dapm_widget *w,
886 struct snd_kcontrol *kcontrol, int event)
887 {
888 struct snd_soc_component *component =
889 snd_soc_dapm_to_component(w->dapm);
890 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
891 unsigned char ps0 = 0x0, ps3 = 0x3;
892
893 switch (event) {
894 case SND_SOC_DAPM_POST_PMU:
895 regmap_write(rt712->regmap,
896 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE12,
897 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
898 ps0);
899 break;
900 case SND_SOC_DAPM_PRE_PMD:
901 regmap_write(rt712->regmap,
902 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE12,
903 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
904 ps3);
905 break;
906 }
907 return 0;
908 }
909
rt712_sdca_pde23_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)910 static int rt712_sdca_pde23_event(struct snd_soc_dapm_widget *w,
911 struct snd_kcontrol *kcontrol, int event)
912 {
913 struct snd_soc_component *component =
914 snd_soc_dapm_to_component(w->dapm);
915 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
916 unsigned char ps0 = 0x0, ps3 = 0x3;
917
918 switch (event) {
919 case SND_SOC_DAPM_POST_PMU:
920 regmap_write(rt712->regmap,
921 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_PDE23,
922 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
923 ps0);
924 break;
925 case SND_SOC_DAPM_PRE_PMD:
926 regmap_write(rt712->regmap,
927 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_PDE23,
928 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
929 ps3);
930 break;
931
932 default:
933 break;
934 }
935
936 return 0;
937 }
938
939 static const struct snd_kcontrol_new rt712_spk_l_dac =
940 SOC_DAPM_SINGLE_AUTODISABLE("Switch",
941 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_MUTE, CH_01),
942 0, 1, 1);
943 static const struct snd_kcontrol_new rt712_spk_r_dac =
944 SOC_DAPM_SINGLE_AUTODISABLE("Switch",
945 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_MUTE, CH_02),
946 0, 1, 1);
947
948 static const struct snd_soc_dapm_widget rt712_sdca_dapm_widgets[] = {
949 SND_SOC_DAPM_OUTPUT("HP"),
950 SND_SOC_DAPM_INPUT("MIC2"),
951 SND_SOC_DAPM_INPUT("LINE2"),
952
953 SND_SOC_DAPM_SUPPLY("PDE 40", SND_SOC_NOPM, 0, 0,
954 rt712_sdca_pde40_event,
955 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
956 SND_SOC_DAPM_SUPPLY("PDE 12", SND_SOC_NOPM, 0, 0,
957 rt712_sdca_pde12_event,
958 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
959
960 SND_SOC_DAPM_DAC_E("FU 05", NULL, SND_SOC_NOPM, 0, 0,
961 rt712_sdca_fu05_event,
962 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
963 SND_SOC_DAPM_ADC_E("FU 0F", NULL, SND_SOC_NOPM, 0, 0,
964 rt712_sdca_fu0f_event,
965 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
966 SND_SOC_DAPM_MUX("ADC 23 Mux", SND_SOC_NOPM, 0, 0,
967 &rt712_sdca_adc23_mux),
968
969 SND_SOC_DAPM_AIF_IN("DP1RX", "DP1 Playback", 0, SND_SOC_NOPM, 0, 0),
970 SND_SOC_DAPM_AIF_OUT("DP4TX", "DP4 Capture", 0, SND_SOC_NOPM, 0, 0),
971 };
972
973 static const struct snd_soc_dapm_route rt712_sdca_audio_map[] = {
974 { "FU 05", NULL, "DP1RX" },
975 { "DP4TX", NULL, "FU 0F" },
976
977 { "FU 0F", NULL, "PDE 12" },
978 { "FU 0F", NULL, "ADC 23 Mux" },
979 { "ADC 23 Mux", "LINE2", "LINE2" },
980 { "ADC 23 Mux", "MIC2", "MIC2" },
981
982 { "HP", NULL, "PDE 40" },
983 { "HP", NULL, "FU 05" },
984 };
985
986 static const struct snd_soc_dapm_widget rt712_sdca_spk_dapm_widgets[] = {
987 SND_SOC_DAPM_AIF_IN("DP3RX", "DP3 Playback", 0, SND_SOC_NOPM, 0, 0),
988
989 /* Digital Interface */
990 SND_SOC_DAPM_PGA("FU06", SND_SOC_NOPM, 0, 0, NULL, 0),
991
992 SND_SOC_DAPM_SUPPLY("PDE 23", SND_SOC_NOPM, 0, 0,
993 rt712_sdca_pde23_event,
994 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
995
996 /* Output */
997 SND_SOC_DAPM_SWITCH("OT23 L", SND_SOC_NOPM, 0, 0, &rt712_spk_l_dac),
998 SND_SOC_DAPM_SWITCH("OT23 R", SND_SOC_NOPM, 0, 0, &rt712_spk_r_dac),
999 SND_SOC_DAPM_OUTPUT("SPOL"),
1000 SND_SOC_DAPM_OUTPUT("SPOR"),
1001 };
1002
1003 static const struct snd_soc_dapm_route rt712_sdca_spk_dapm_routes[] = {
1004 { "FU06", NULL, "DP3RX" },
1005 { "FU06", NULL, "PDE 23" },
1006 { "OT23 L", "Switch", "FU06" },
1007 { "OT23 R", "Switch", "FU06" },
1008 { "SPOL", NULL, "OT23 L" },
1009 { "SPOR", NULL, "OT23 R" },
1010 };
1011
rt712_sdca_parse_dt(struct rt712_sdca_priv * rt712,struct device * dev)1012 static int rt712_sdca_parse_dt(struct rt712_sdca_priv *rt712, struct device *dev)
1013 {
1014 device_property_read_u32(dev, "realtek,jd-src", &rt712->jd_src);
1015
1016 return 0;
1017 }
1018
rt712_sdca_probe(struct snd_soc_component * component)1019 static int rt712_sdca_probe(struct snd_soc_component *component)
1020 {
1021 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
1022 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1023 int ret;
1024
1025 rt712_sdca_parse_dt(rt712, &rt712->slave->dev);
1026 rt712->component = component;
1027
1028 /* add SPK route */
1029 if (rt712->hw_id != RT712_DEV_ID_713) {
1030 snd_soc_add_component_controls(component,
1031 rt712_sdca_spk_controls, ARRAY_SIZE(rt712_sdca_spk_controls));
1032 snd_soc_dapm_new_controls(dapm,
1033 rt712_sdca_spk_dapm_widgets, ARRAY_SIZE(rt712_sdca_spk_dapm_widgets));
1034 snd_soc_dapm_add_routes(dapm,
1035 rt712_sdca_spk_dapm_routes, ARRAY_SIZE(rt712_sdca_spk_dapm_routes));
1036 }
1037
1038 if (!rt712->first_hw_init)
1039 return 0;
1040
1041 ret = pm_runtime_resume(component->dev);
1042 if (ret < 0 && ret != -EACCES)
1043 return ret;
1044
1045 return 0;
1046 }
1047
rt712_sdca_dmic_set_gain_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1048 static int rt712_sdca_dmic_set_gain_get(struct snd_kcontrol *kcontrol,
1049 struct snd_ctl_elem_value *ucontrol)
1050 {
1051 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1052 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1053 struct rt712_dmic_kctrl_priv *p =
1054 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1055 unsigned int regvalue, ctl, i;
1056 unsigned int adc_vol_flag = 0;
1057 const unsigned int interval_offset = 0xc0;
1058
1059 if (strstr(ucontrol->id.name, "FU1E Capture Volume"))
1060 adc_vol_flag = 1;
1061
1062 /* check all channels */
1063 for (i = 0; i < p->count; i++) {
1064 regmap_read(rt712->mbq_regmap, p->reg_base + i, ®value);
1065
1066 if (!adc_vol_flag) /* boost gain */
1067 ctl = regvalue / 0x0a00;
1068 else { /* ADC gain */
1069 if (adc_vol_flag)
1070 ctl = p->max - (((0x1e00 - regvalue) & 0xffff) / interval_offset);
1071 else
1072 ctl = p->max - (((0 - regvalue) & 0xffff) / interval_offset);
1073 }
1074
1075 ucontrol->value.integer.value[i] = ctl;
1076 }
1077
1078 return 0;
1079 }
1080
rt712_sdca_dmic_set_gain_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1081 static int rt712_sdca_dmic_set_gain_put(struct snd_kcontrol *kcontrol,
1082 struct snd_ctl_elem_value *ucontrol)
1083 {
1084 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1085 struct rt712_dmic_kctrl_priv *p =
1086 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1087 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1088 unsigned int gain_val[4];
1089 unsigned int i, adc_vol_flag = 0, changed = 0;
1090 unsigned int regvalue[4];
1091 const unsigned int interval_offset = 0xc0;
1092 int err;
1093
1094 if (strstr(ucontrol->id.name, "FU1E Capture Volume"))
1095 adc_vol_flag = 1;
1096
1097 /* check all channels */
1098 for (i = 0; i < p->count; i++) {
1099 regmap_read(rt712->mbq_regmap, p->reg_base + i, ®value[i]);
1100
1101 gain_val[i] = ucontrol->value.integer.value[i];
1102 if (gain_val[i] > p->max)
1103 gain_val[i] = p->max;
1104
1105 if (!adc_vol_flag) /* boost gain */
1106 gain_val[i] = gain_val[i] * 0x0a00;
1107 else { /* ADC gain */
1108 gain_val[i] = 0x1e00 - ((p->max - gain_val[i]) * interval_offset);
1109 gain_val[i] &= 0xffff;
1110 }
1111
1112 if (regvalue[i] != gain_val[i])
1113 changed = 1;
1114 }
1115
1116 if (!changed)
1117 return 0;
1118
1119 for (i = 0; i < p->count; i++) {
1120 err = regmap_write(rt712->mbq_regmap, p->reg_base + i, gain_val[i]);
1121 if (err < 0)
1122 dev_err(&rt712->slave->dev, "0x%08x can't be set\n", p->reg_base + i);
1123 }
1124
1125 return changed;
1126 }
1127
rt712_sdca_set_fu1e_capture_ctl(struct rt712_sdca_priv * rt712)1128 static int rt712_sdca_set_fu1e_capture_ctl(struct rt712_sdca_priv *rt712)
1129 {
1130 int err, i;
1131 unsigned int ch_mute;
1132
1133 for (i = 0; i < ARRAY_SIZE(rt712->fu1e_mixer_mute); i++) {
1134 ch_mute = (rt712->fu1e_dapm_mute || rt712->fu1e_mixer_mute[i]) ? 0x01 : 0x00;
1135 err = regmap_write(rt712->regmap,
1136 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E,
1137 RT712_SDCA_CTL_FU_MUTE, CH_01) + i, ch_mute);
1138 if (err < 0)
1139 return err;
1140 }
1141
1142 return 0;
1143 }
1144
rt712_sdca_dmic_fu1e_capture_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1145 static int rt712_sdca_dmic_fu1e_capture_get(struct snd_kcontrol *kcontrol,
1146 struct snd_ctl_elem_value *ucontrol)
1147 {
1148 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1149 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1150 struct rt712_dmic_kctrl_priv *p =
1151 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1152 unsigned int i;
1153
1154 for (i = 0; i < p->count; i++)
1155 ucontrol->value.integer.value[i] = !rt712->fu1e_mixer_mute[i];
1156
1157 return 0;
1158 }
1159
rt712_sdca_dmic_fu1e_capture_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1160 static int rt712_sdca_dmic_fu1e_capture_put(struct snd_kcontrol *kcontrol,
1161 struct snd_ctl_elem_value *ucontrol)
1162 {
1163 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1164 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1165 struct rt712_dmic_kctrl_priv *p =
1166 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1167 int err, changed = 0, i;
1168
1169 for (i = 0; i < p->count; i++) {
1170 if (rt712->fu1e_mixer_mute[i] != !ucontrol->value.integer.value[i])
1171 changed = 1;
1172 rt712->fu1e_mixer_mute[i] = !ucontrol->value.integer.value[i];
1173 }
1174
1175 err = rt712_sdca_set_fu1e_capture_ctl(rt712);
1176 if (err < 0)
1177 return err;
1178
1179 return changed;
1180 }
1181
rt712_sdca_fu_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)1182 static int rt712_sdca_fu_info(struct snd_kcontrol *kcontrol,
1183 struct snd_ctl_elem_info *uinfo)
1184 {
1185 struct rt712_dmic_kctrl_priv *p =
1186 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1187
1188 if (p->max == 1)
1189 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1190 else
1191 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1192 uinfo->count = p->count;
1193 uinfo->value.integer.min = 0;
1194 uinfo->value.integer.max = p->max;
1195 return 0;
1196 }
1197
1198 #define RT712_SDCA_PR_VALUE(xreg_base, xcount, xmax, xinvert) \
1199 ((unsigned long)&(struct rt712_dmic_kctrl_priv) \
1200 {.reg_base = xreg_base, .count = xcount, .max = xmax, \
1201 .invert = xinvert})
1202
1203 #define RT712_SDCA_FU_CTRL(xname, reg_base, xmax, xinvert, xcount) \
1204 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
1205 .info = rt712_sdca_fu_info, \
1206 .get = rt712_sdca_dmic_fu1e_capture_get, \
1207 .put = rt712_sdca_dmic_fu1e_capture_put, \
1208 .private_value = RT712_SDCA_PR_VALUE(reg_base, xcount, xmax, xinvert)}
1209
1210 #define RT712_SDCA_EXT_TLV(xname, reg_base, xhandler_get,\
1211 xhandler_put, xcount, xmax, tlv_array) \
1212 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
1213 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ | \
1214 SNDRV_CTL_ELEM_ACCESS_READWRITE, \
1215 .tlv.p = (tlv_array), \
1216 .info = rt712_sdca_fu_info, \
1217 .get = xhandler_get, .put = xhandler_put, \
1218 .private_value = RT712_SDCA_PR_VALUE(reg_base, xcount, xmax, 0) }
1219
1220 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -1725, 75, 0);
1221 static const DECLARE_TLV_DB_SCALE(dmic_vol_tlv, 0, 1000, 0);
1222
1223 static const struct snd_kcontrol_new rt712_sdca_dmic_snd_controls[] = {
1224 RT712_SDCA_FU_CTRL("FU1E Capture Switch",
1225 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E, RT712_SDCA_CTL_FU_MUTE, CH_01),
1226 1, 1, 4),
1227 RT712_SDCA_EXT_TLV("FU1E Capture Volume",
1228 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E, RT712_SDCA_CTL_FU_VOLUME, CH_01),
1229 rt712_sdca_dmic_set_gain_get, rt712_sdca_dmic_set_gain_put, 4, 0x3f, in_vol_tlv),
1230 RT712_SDCA_EXT_TLV("FU15 Boost Volume",
1231 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PLATFORM_FU15, RT712_SDCA_CTL_FU_CH_GAIN, CH_01),
1232 rt712_sdca_dmic_set_gain_get, rt712_sdca_dmic_set_gain_put, 4, 3, dmic_vol_tlv),
1233 };
1234
rt712_sdca_dmic_mux_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1235 static int rt712_sdca_dmic_mux_get(struct snd_kcontrol *kcontrol,
1236 struct snd_ctl_elem_value *ucontrol)
1237 {
1238 struct snd_soc_component *component =
1239 snd_soc_dapm_kcontrol_component(kcontrol);
1240 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1241 unsigned int val = 0, mask_sft;
1242
1243 if (strstr(ucontrol->id.name, "ADC 0A Mux"))
1244 mask_sft = 0;
1245 else if (strstr(ucontrol->id.name, "ADC 0B Mux"))
1246 mask_sft = 4;
1247 else
1248 return -EINVAL;
1249
1250 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL,
1251 RT712_HDA_LEGACY_MUX_CTL0, &val);
1252
1253 ucontrol->value.enumerated.item[0] = (((val >> mask_sft) & 0xf) == 0x4) ? 0 : 1;
1254
1255 return 0;
1256 }
1257
rt712_sdca_dmic_mux_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1258 static int rt712_sdca_dmic_mux_put(struct snd_kcontrol *kcontrol,
1259 struct snd_ctl_elem_value *ucontrol)
1260 {
1261 struct snd_soc_component *component =
1262 snd_soc_dapm_kcontrol_component(kcontrol);
1263 struct snd_soc_dapm_context *dapm =
1264 snd_soc_dapm_kcontrol_dapm(kcontrol);
1265 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1266 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1267 unsigned int *item = ucontrol->value.enumerated.item;
1268 unsigned int val, val2 = 0, change, mask_sft;
1269
1270 if (item[0] >= e->items)
1271 return -EINVAL;
1272
1273 if (strstr(ucontrol->id.name, "ADC 0A Mux"))
1274 mask_sft = 0;
1275 else if (strstr(ucontrol->id.name, "ADC 0B Mux"))
1276 mask_sft = 4;
1277 else
1278 return -EINVAL;
1279
1280 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
1281
1282 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL,
1283 RT712_HDA_LEGACY_MUX_CTL0, &val2);
1284 val2 = ((0xf << mask_sft) & val2) >> mask_sft;
1285
1286 if (val == 0)
1287 val = 0x4;
1288 else if (val >= 1)
1289 val = 0xe;
1290
1291 if (val == val2)
1292 change = 0;
1293 else
1294 change = 1;
1295
1296 if (change)
1297 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1298 RT712_HDA_LEGACY_MUX_CTL0, 0xf << mask_sft,
1299 val << mask_sft);
1300
1301 snd_soc_dapm_mux_update_power(dapm, kcontrol, item[0], e, NULL);
1302
1303 return change;
1304 }
1305
1306 static const char * const adc_dmic_mux_text[] = {
1307 "DMIC1",
1308 "DMIC2",
1309 };
1310
1311 static SOC_ENUM_SINGLE_DECL(
1312 rt712_adc0a_enum, SND_SOC_NOPM, 0, adc_dmic_mux_text);
1313
1314 static SOC_ENUM_SINGLE_DECL(
1315 rt712_adc0b_enum, SND_SOC_NOPM, 0, adc_dmic_mux_text);
1316
1317 static const struct snd_kcontrol_new rt712_sdca_dmic_adc0a_mux =
1318 SOC_DAPM_ENUM_EXT("ADC 0A Mux", rt712_adc0a_enum,
1319 rt712_sdca_dmic_mux_get, rt712_sdca_dmic_mux_put);
1320
1321 static const struct snd_kcontrol_new rt712_sdca_dmic_adc0b_mux =
1322 SOC_DAPM_ENUM_EXT("ADC 0B Mux", rt712_adc0b_enum,
1323 rt712_sdca_dmic_mux_get, rt712_sdca_dmic_mux_put);
1324
rt712_sdca_dmic_fu1e_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1325 static int rt712_sdca_dmic_fu1e_event(struct snd_soc_dapm_widget *w,
1326 struct snd_kcontrol *kcontrol, int event)
1327 {
1328 struct snd_soc_component *component =
1329 snd_soc_dapm_to_component(w->dapm);
1330 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1331
1332 switch (event) {
1333 case SND_SOC_DAPM_POST_PMU:
1334 rt712->fu1e_dapm_mute = false;
1335 rt712_sdca_set_fu1e_capture_ctl(rt712);
1336 break;
1337 case SND_SOC_DAPM_PRE_PMD:
1338 rt712->fu1e_dapm_mute = true;
1339 rt712_sdca_set_fu1e_capture_ctl(rt712);
1340 break;
1341 }
1342 return 0;
1343 }
1344
rt712_sdca_dmic_pde11_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1345 static int rt712_sdca_dmic_pde11_event(struct snd_soc_dapm_widget *w,
1346 struct snd_kcontrol *kcontrol, int event)
1347 {
1348 struct snd_soc_component *component =
1349 snd_soc_dapm_to_component(w->dapm);
1350 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1351 unsigned char ps0 = 0x0, ps3 = 0x3;
1352
1353 switch (event) {
1354 case SND_SOC_DAPM_POST_PMU:
1355 regmap_write(rt712->regmap,
1356 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PDE11,
1357 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
1358 ps0);
1359 break;
1360 case SND_SOC_DAPM_PRE_PMD:
1361 regmap_write(rt712->regmap,
1362 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PDE11,
1363 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
1364 ps3);
1365 break;
1366 }
1367 return 0;
1368 }
1369
1370 static const struct snd_soc_dapm_widget rt712_sdca_dmic_dapm_widgets[] = {
1371 SND_SOC_DAPM_INPUT("DMIC1"),
1372 SND_SOC_DAPM_INPUT("DMIC2"),
1373
1374 SND_SOC_DAPM_SUPPLY("PDE 11", SND_SOC_NOPM, 0, 0,
1375 rt712_sdca_dmic_pde11_event,
1376 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1377
1378 SND_SOC_DAPM_ADC_E("FU 1E", NULL, SND_SOC_NOPM, 0, 0,
1379 rt712_sdca_dmic_fu1e_event,
1380 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1381 SND_SOC_DAPM_MUX("ADC 0A Mux", SND_SOC_NOPM, 0, 0,
1382 &rt712_sdca_dmic_adc0a_mux),
1383 SND_SOC_DAPM_MUX("ADC 0B Mux", SND_SOC_NOPM, 0, 0,
1384 &rt712_sdca_dmic_adc0b_mux),
1385
1386 SND_SOC_DAPM_AIF_OUT("DP8TX", "DP8 Capture", 0, SND_SOC_NOPM, 0, 0),
1387 };
1388
1389 static const struct snd_soc_dapm_route rt712_sdca_dmic_audio_map[] = {
1390 {"DP8TX", NULL, "FU 1E"},
1391
1392 {"FU 1E", NULL, "PDE 11"},
1393 {"FU 1E", NULL, "ADC 0A Mux"},
1394 {"FU 1E", NULL, "ADC 0B Mux"},
1395 {"ADC 0A Mux", "DMIC1", "DMIC1"},
1396 {"ADC 0A Mux", "DMIC2", "DMIC2"},
1397 {"ADC 0B Mux", "DMIC1", "DMIC1"},
1398 {"ADC 0B Mux", "DMIC2", "DMIC2"},
1399 };
1400
rt712_sdca_dmic_probe(struct snd_soc_component * component)1401 static int rt712_sdca_dmic_probe(struct snd_soc_component *component)
1402 {
1403 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1404 int ret;
1405
1406 rt712->dmic_component = component;
1407
1408 if (!rt712->first_hw_init)
1409 return 0;
1410
1411 ret = pm_runtime_resume(component->dev);
1412 if (ret < 0 && ret != -EACCES)
1413 return ret;
1414
1415 return 0;
1416 }
1417
1418 static const struct snd_soc_component_driver soc_sdca_dev_rt712 = {
1419 .probe = rt712_sdca_probe,
1420 .controls = rt712_sdca_controls,
1421 .num_controls = ARRAY_SIZE(rt712_sdca_controls),
1422 .dapm_widgets = rt712_sdca_dapm_widgets,
1423 .num_dapm_widgets = ARRAY_SIZE(rt712_sdca_dapm_widgets),
1424 .dapm_routes = rt712_sdca_audio_map,
1425 .num_dapm_routes = ARRAY_SIZE(rt712_sdca_audio_map),
1426 .set_jack = rt712_sdca_set_jack_detect,
1427 .endianness = 1,
1428 };
1429
1430 static const struct snd_soc_component_driver soc_sdca_dev_rt712_dmic = {
1431 .probe = rt712_sdca_dmic_probe,
1432 .controls = rt712_sdca_dmic_snd_controls,
1433 .num_controls = ARRAY_SIZE(rt712_sdca_dmic_snd_controls),
1434 .dapm_widgets = rt712_sdca_dmic_dapm_widgets,
1435 .num_dapm_widgets = ARRAY_SIZE(rt712_sdca_dmic_dapm_widgets),
1436 .dapm_routes = rt712_sdca_dmic_audio_map,
1437 .num_dapm_routes = ARRAY_SIZE(rt712_sdca_dmic_audio_map),
1438 .endianness = 1,
1439 #ifdef CONFIG_DEBUG_FS
1440 .debugfs_prefix = "dmic",
1441 #endif
1442 };
1443
rt712_sdca_set_sdw_stream(struct snd_soc_dai * dai,void * sdw_stream,int direction)1444 static int rt712_sdca_set_sdw_stream(struct snd_soc_dai *dai, void *sdw_stream,
1445 int direction)
1446 {
1447 snd_soc_dai_dma_data_set(dai, direction, sdw_stream);
1448
1449 return 0;
1450 }
1451
rt712_sdca_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)1452 static void rt712_sdca_shutdown(struct snd_pcm_substream *substream,
1453 struct snd_soc_dai *dai)
1454 {
1455 snd_soc_dai_set_dma_data(dai, substream, NULL);
1456 }
1457
rt712_sdca_pcm_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)1458 static int rt712_sdca_pcm_hw_params(struct snd_pcm_substream *substream,
1459 struct snd_pcm_hw_params *params,
1460 struct snd_soc_dai *dai)
1461 {
1462 struct snd_soc_component *component = dai->component;
1463 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1464 struct sdw_stream_config stream_config;
1465 struct sdw_port_config port_config;
1466 enum sdw_data_direction direction;
1467 struct sdw_stream_runtime *sdw_stream;
1468 int retval, port, num_channels;
1469 unsigned int sampling_rate;
1470
1471 dev_dbg(dai->dev, "%s %s id %d", __func__, dai->name, dai->id);
1472 sdw_stream = snd_soc_dai_get_dma_data(dai, substream);
1473
1474 if (!sdw_stream)
1475 return -EINVAL;
1476
1477 if (!rt712->slave)
1478 return -EINVAL;
1479
1480 /* VA doesn't support AIF3 */
1481 if (dai->id == RT712_AIF3 && rt712->version_id == RT712_VA)
1482 return -EINVAL;
1483
1484 /* SoundWire specific configuration */
1485 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1486 direction = SDW_DATA_DIR_RX;
1487 if (dai->id == RT712_AIF1)
1488 port = 1;
1489 else if (dai->id == RT712_AIF2)
1490 port = 3;
1491 else
1492 return -EINVAL;
1493 } else {
1494 direction = SDW_DATA_DIR_TX;
1495 if (dai->id == RT712_AIF1)
1496 port = 4;
1497 else if (dai->id == RT712_AIF3)
1498 port = 8;
1499 else
1500 return -EINVAL;
1501 }
1502
1503 stream_config.frame_rate = params_rate(params);
1504 stream_config.ch_count = params_channels(params);
1505 stream_config.bps = snd_pcm_format_width(params_format(params));
1506 stream_config.direction = direction;
1507
1508 num_channels = params_channels(params);
1509 port_config.ch_mask = GENMASK(num_channels - 1, 0);
1510 port_config.num = port;
1511
1512 retval = sdw_stream_add_slave(rt712->slave, &stream_config,
1513 &port_config, 1, sdw_stream);
1514 if (retval) {
1515 dev_err(dai->dev, "%s: Unable to configure port\n", __func__);
1516 return retval;
1517 }
1518
1519 if (params_channels(params) > 16) {
1520 dev_err(component->dev, "%s: Unsupported channels %d\n",
1521 __func__, params_channels(params));
1522 return -EINVAL;
1523 }
1524
1525 /* sampling rate configuration */
1526 switch (params_rate(params)) {
1527 case 44100:
1528 sampling_rate = RT712_SDCA_RATE_44100HZ;
1529 break;
1530 case 48000:
1531 sampling_rate = RT712_SDCA_RATE_48000HZ;
1532 break;
1533 case 96000:
1534 sampling_rate = RT712_SDCA_RATE_96000HZ;
1535 break;
1536 case 192000:
1537 sampling_rate = RT712_SDCA_RATE_192000HZ;
1538 break;
1539 default:
1540 dev_err(component->dev, "%s: Rate %d is not supported\n",
1541 __func__, params_rate(params));
1542 return -EINVAL;
1543 }
1544
1545 /* set sampling frequency */
1546 switch (dai->id) {
1547 case RT712_AIF1:
1548 regmap_write(rt712->regmap,
1549 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_CS01, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1550 sampling_rate);
1551 regmap_write(rt712->regmap,
1552 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_CS11, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1553 sampling_rate);
1554 break;
1555 case RT712_AIF2:
1556 regmap_write(rt712->regmap,
1557 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_CS31, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1558 sampling_rate);
1559 break;
1560 case RT712_AIF3:
1561 regmap_write(rt712->regmap,
1562 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_CS1F, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1563 sampling_rate);
1564 regmap_write(rt712->regmap,
1565 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_CS1C, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1566 sampling_rate);
1567 break;
1568 default:
1569 dev_err(component->dev, "%s: Wrong DAI id\n", __func__);
1570 return -EINVAL;
1571 }
1572
1573 return 0;
1574 }
1575
rt712_sdca_pcm_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)1576 static int rt712_sdca_pcm_hw_free(struct snd_pcm_substream *substream,
1577 struct snd_soc_dai *dai)
1578 {
1579 struct snd_soc_component *component = dai->component;
1580 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1581 struct sdw_stream_runtime *sdw_stream =
1582 snd_soc_dai_get_dma_data(dai, substream);
1583
1584 if (!rt712->slave)
1585 return -EINVAL;
1586
1587 sdw_stream_remove_slave(rt712->slave, sdw_stream);
1588 return 0;
1589 }
1590
1591 #define RT712_STEREO_RATES (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 | \
1592 SNDRV_PCM_RATE_192000)
1593 #define RT712_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
1594 SNDRV_PCM_FMTBIT_S24_LE)
1595
1596 static const struct snd_soc_dai_ops rt712_sdca_ops = {
1597 .hw_params = rt712_sdca_pcm_hw_params,
1598 .hw_free = rt712_sdca_pcm_hw_free,
1599 .set_stream = rt712_sdca_set_sdw_stream,
1600 .shutdown = rt712_sdca_shutdown,
1601 };
1602
1603 static struct snd_soc_dai_driver rt712_sdca_dai[] = {
1604 {
1605 .name = "rt712-sdca-aif1",
1606 .id = RT712_AIF1,
1607 .playback = {
1608 .stream_name = "DP1 Playback",
1609 .channels_min = 1,
1610 .channels_max = 2,
1611 .rates = RT712_STEREO_RATES,
1612 .formats = RT712_FORMATS,
1613 },
1614 .capture = {
1615 .stream_name = "DP4 Capture",
1616 .channels_min = 1,
1617 .channels_max = 2,
1618 .rates = RT712_STEREO_RATES,
1619 .formats = RT712_FORMATS,
1620 },
1621 .ops = &rt712_sdca_ops,
1622 },
1623 {
1624 .name = "rt712-sdca-aif2",
1625 .id = RT712_AIF2,
1626 .playback = {
1627 .stream_name = "DP3 Playback",
1628 .channels_min = 1,
1629 .channels_max = 2,
1630 .rates = RT712_STEREO_RATES,
1631 .formats = RT712_FORMATS,
1632 },
1633 .ops = &rt712_sdca_ops,
1634 }
1635 };
1636
1637 static struct snd_soc_dai_driver rt712_sdca_dmic_dai[] = {
1638 {
1639 .name = "rt712-sdca-aif3",
1640 .id = RT712_AIF3,
1641 .capture = {
1642 .stream_name = "DP8 Capture",
1643 .channels_min = 1,
1644 .channels_max = 4,
1645 .rates = RT712_STEREO_RATES,
1646 .formats = RT712_FORMATS,
1647 },
1648 .ops = &rt712_sdca_ops,
1649 }
1650 };
1651
rt712_sdca_init(struct device * dev,struct regmap * regmap,struct regmap * mbq_regmap,struct sdw_slave * slave)1652 int rt712_sdca_init(struct device *dev, struct regmap *regmap,
1653 struct regmap *mbq_regmap, struct sdw_slave *slave)
1654 {
1655 struct rt712_sdca_priv *rt712;
1656 int ret;
1657
1658 rt712 = devm_kzalloc(dev, sizeof(*rt712), GFP_KERNEL);
1659 if (!rt712)
1660 return -ENOMEM;
1661
1662 dev_set_drvdata(dev, rt712);
1663 rt712->slave = slave;
1664 rt712->regmap = regmap;
1665 rt712->mbq_regmap = mbq_regmap;
1666
1667 regcache_cache_only(rt712->regmap, true);
1668 regcache_cache_only(rt712->mbq_regmap, true);
1669
1670 mutex_init(&rt712->calibrate_mutex);
1671 mutex_init(&rt712->disable_irq_lock);
1672
1673 INIT_DELAYED_WORK(&rt712->jack_detect_work, rt712_sdca_jack_detect_handler);
1674 INIT_DELAYED_WORK(&rt712->jack_btn_check_work, rt712_sdca_btn_check_handler);
1675
1676 /*
1677 * Mark hw_init to false
1678 * HW init will be performed when device reports present
1679 */
1680 rt712->hw_init = false;
1681 rt712->first_hw_init = false;
1682 rt712->fu0f_dapm_mute = true;
1683 rt712->fu0f_mixer_l_mute = rt712->fu0f_mixer_r_mute = true;
1684 rt712->fu1e_dapm_mute = true;
1685 rt712->fu1e_mixer_mute[0] = rt712->fu1e_mixer_mute[1] =
1686 rt712->fu1e_mixer_mute[2] = rt712->fu1e_mixer_mute[3] = true;
1687 rt712->fu05_dapm_mute = true;
1688 rt712->fu05_mixer_l_mute = rt712->fu05_mixer_r_mute = false;
1689
1690 /* JD source uses JD1 in default */
1691 rt712->jd_src = RT712_JD1;
1692
1693 if (slave->id.part_id != RT712_PART_ID_713)
1694 ret = devm_snd_soc_register_component(dev,
1695 &soc_sdca_dev_rt712, rt712_sdca_dai, ARRAY_SIZE(rt712_sdca_dai));
1696 else
1697 ret = devm_snd_soc_register_component(dev,
1698 &soc_sdca_dev_rt712, rt712_sdca_dai, 1);
1699 if (ret < 0)
1700 return ret;
1701
1702 /* only add the dmic component if a SMART_MIC function is exposed in ACPI */
1703 if (sdca_device_quirk_match(slave, SDCA_QUIRKS_RT712_VB)) {
1704 ret = devm_snd_soc_register_component(dev,
1705 &soc_sdca_dev_rt712_dmic,
1706 rt712_sdca_dmic_dai,
1707 ARRAY_SIZE(rt712_sdca_dmic_dai));
1708 if (ret < 0)
1709 return ret;
1710 rt712->dmic_function_found = true;
1711 }
1712
1713 /* set autosuspend parameters */
1714 pm_runtime_set_autosuspend_delay(dev, 3000);
1715 pm_runtime_use_autosuspend(dev);
1716
1717 /* make sure the device does not suspend immediately */
1718 pm_runtime_mark_last_busy(dev);
1719
1720 pm_runtime_enable(dev);
1721
1722 /* important note: the device is NOT tagged as 'active' and will remain
1723 * 'suspended' until the hardware is enumerated/initialized. This is required
1724 * to make sure the ASoC framework use of pm_runtime_get_sync() does not silently
1725 * fail with -EACCESS because of race conditions between card creation and enumeration
1726 */
1727
1728 dev_dbg(dev, "%s\n", __func__);
1729
1730 return 0;
1731 }
1732
rt712_sdca_va_io_init(struct rt712_sdca_priv * rt712)1733 static void rt712_sdca_va_io_init(struct rt712_sdca_priv *rt712)
1734 {
1735 int ret = 0;
1736 unsigned int hibernation_flag;
1737 struct device *dev = &rt712->slave->dev;
1738
1739 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_ANALOG_BIAS_CTL3, 0xaa81);
1740 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_LDO2_3_CTL1, 0xa1e0);
1741 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL1, 0x0000);
1742 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL2, 0x0000);
1743 rt712_sdca_index_write(rt712, RT712_VENDOR_ANALOG_CTL, RT712_MISC_POWER_CTL7, 0x0000);
1744 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1745
1746 /* calibration */
1747 rt712_sdca_index_read(rt712, RT712_VENDOR_REG, RT712_SW_CONFIG1, &hibernation_flag);
1748 if (!hibernation_flag) {
1749 ret = rt712_sdca_calibration(rt712);
1750 if (ret < 0)
1751 dev_err(dev, "%s, calibration failed!\n", __func__);
1752 }
1753
1754 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1755 RT712_MIXER_CTL1, 0x3000, 0x0000);
1756 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1757 RT712_ADC0A_08_PDE_FLOAT_CTL, 0x1112);
1758 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1759 RT712_MIC2_LINE2_PDE_FLOAT_CTL, 0x3412);
1760 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1761 RT712_DAC03_HP_PDE_FLOAT_CTL, 0x4040);
1762
1763 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1764 RT712_HDA_LEGACY_GPIO_WAKE_EN_CTL, 0x0001, 0x0000);
1765 regmap_write(rt712->regmap, 0x2f50, 0x00);
1766 regmap_write(rt712->regmap, 0x2f54, 0x00);
1767 regmap_write(rt712->regmap,
1768 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_IT09, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1769
1770 /* add SPK settings */
1771 if (rt712->hw_id != RT712_DEV_ID_713) {
1772 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_AMP_PDE_FLOAT_CTL, 0x2323);
1773 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_EAPD_CTL, 0x0002);
1774 regmap_write(rt712->regmap,
1775 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_OT23, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x04);
1776 }
1777 }
1778
rt712_sdca_vb_io_init(struct rt712_sdca_priv * rt712)1779 static void rt712_sdca_vb_io_init(struct rt712_sdca_priv *rt712)
1780 {
1781 int ret = 0;
1782 unsigned int jack_func_status, mic_func_status, amp_func_status;
1783 struct device *dev = &rt712->slave->dev;
1784
1785 regmap_read(rt712->regmap,
1786 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &jack_func_status);
1787 regmap_read(rt712->regmap,
1788 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &mic_func_status);
1789 regmap_read(rt712->regmap,
1790 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &_func_status);
1791 dev_dbg(dev, "%s jack/mic/amp func_status=0x%x, 0x%x, 0x%x\n",
1792 __func__, jack_func_status, mic_func_status, amp_func_status);
1793
1794 /* DMIC */
1795 if ((mic_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1796 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_DMIC2_FU_IT_FLOAT_CTL, 0x1526);
1797 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_DMIC2_FU_CH12_FLOAT_CTL, 0x0304);
1798 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_ADC0A_CS_ADC0B_FU_FLOAT_CTL, 0x1f1e);
1799 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_ADC0B_FU_CH12_FLOAT_CTL, 0x0304);
1800 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_HDA_LEGACY_CONFIG_CTL0, 0x8010);
1801 regmap_write(rt712->regmap,
1802 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_IT11, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1803 rt712_sdca_index_write(rt712, RT712_ULTRA_SOUND_DET, RT712_ULTRA_SOUND_DETECTOR6, 0x3200);
1804 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1805
1806 /* clear flag */
1807 regmap_write(rt712->regmap,
1808 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1809 FUNCTION_NEEDS_INITIALIZATION);
1810 }
1811
1812 /* Jack */
1813 if ((jack_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1814 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_SEL_VEE2_HP_CTL1, 0x042a);
1815 rt712_sdca_index_write(rt712, RT712_CHARGE_PUMP, RT712_HP_DET_CTL3, 0x1fff);
1816 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_IO_CTL, 0xec67);
1817 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_ANALOG_BIAS_CTL3, 0xaa81);
1818 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_LDO2_3_CTL1, 0xa1e0);
1819 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL1, 0x0000);
1820 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL2, 0x0000);
1821 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1822 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_JD_CTL1, 0x2802);
1823 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CLASSD_AMP_CTL6, 0xf215);
1824
1825 /* calibration */
1826 ret = rt712_sdca_calibration(rt712);
1827 if (ret < 0)
1828 dev_err(dev, "%s, calibration failed!\n", __func__);
1829
1830 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, 0x3000, 0x0000);
1831 regmap_write(rt712->regmap,
1832 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_IT09, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1833 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_MISC_CTL_FOR_UAJ, 0x0003);
1834
1835 /* clear flag */
1836 regmap_write(rt712->regmap,
1837 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1838 FUNCTION_NEEDS_INITIALIZATION);
1839 }
1840
1841 /* SPK */
1842 if ((amp_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1843 if (rt712->hw_id != RT712_DEV_ID_713) {
1844 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_IO_CTL, 0xec63);
1845 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CLASSD_AMP_CTL1, 0xfff5);
1846 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_EAPD_CTL, 0x0002);
1847 regmap_write(rt712->regmap,
1848 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_OT23, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x04);
1849 }
1850 /* clear flag */
1851 regmap_write(rt712->regmap,
1852 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1853 FUNCTION_NEEDS_INITIALIZATION);
1854 }
1855 }
1856
rt712_sdca_io_init(struct device * dev,struct sdw_slave * slave)1857 int rt712_sdca_io_init(struct device *dev, struct sdw_slave *slave)
1858 {
1859 struct rt712_sdca_priv *rt712 = dev_get_drvdata(dev);
1860 unsigned int val;
1861 struct sdw_slave_prop *prop = &slave->prop;
1862
1863 rt712->disable_irq = false;
1864
1865 if (rt712->hw_init)
1866 return 0;
1867
1868 regcache_cache_only(rt712->regmap, false);
1869 regcache_cache_only(rt712->mbq_regmap, false);
1870 if (rt712->first_hw_init) {
1871 regcache_cache_bypass(rt712->regmap, true);
1872 regcache_cache_bypass(rt712->mbq_regmap, true);
1873 } else {
1874 /*
1875 * PM runtime status is marked as 'active' only when a Slave reports as Attached
1876 */
1877
1878 /* update count of parent 'active' children */
1879 pm_runtime_set_active(&slave->dev);
1880 }
1881
1882 pm_runtime_get_noresume(&slave->dev);
1883
1884 rt712_sdca_index_read(rt712, RT712_VENDOR_REG, RT712_JD_PRODUCT_NUM, &val);
1885 rt712->hw_id = (val & 0xf000) >> 12;
1886 rt712->version_id = (val & 0x0f00) >> 8;
1887 dev_dbg(&slave->dev, "%s hw_id=0x%x, version_id=0x%x\n", __func__, rt712->hw_id, rt712->version_id);
1888
1889 if (rt712->version_id == RT712_VA) {
1890 if (rt712->dmic_function_found) {
1891 dev_err(&slave->dev, "%s RT712 VA detected but SMART_MIC function exposed in ACPI\n",
1892 __func__);
1893 goto suspend;
1894 }
1895
1896 rt712_sdca_va_io_init(rt712);
1897 } else {
1898 if (!rt712->dmic_function_found) {
1899 dev_err(&slave->dev, "%s RT712 VB detected but no SMART_MIC function exposed in ACPI\n",
1900 __func__);
1901 goto suspend;
1902 }
1903
1904 /* multilanes and DMIC are supported by rt712vb */
1905 prop->lane_control_support = true;
1906 rt712_sdca_vb_io_init(rt712);
1907 }
1908
1909 /*
1910 * if set_jack callback occurred early than io_init,
1911 * we set up the jack detection function now
1912 */
1913 if (rt712->hs_jack)
1914 rt712_sdca_jack_init(rt712);
1915
1916 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_SW_CONFIG1, 0x0001);
1917
1918 if (rt712->first_hw_init) {
1919 regcache_cache_bypass(rt712->regmap, false);
1920 regcache_mark_dirty(rt712->regmap);
1921 regcache_cache_bypass(rt712->mbq_regmap, false);
1922 regcache_mark_dirty(rt712->mbq_regmap);
1923 } else
1924 rt712->first_hw_init = true;
1925
1926 /* Mark Slave initialization complete */
1927 rt712->hw_init = true;
1928
1929 dev_dbg(&slave->dev, "%s hw_init complete\n", __func__);
1930
1931 suspend:
1932 pm_runtime_mark_last_busy(&slave->dev);
1933 pm_runtime_put_autosuspend(&slave->dev);
1934
1935 return 0;
1936 }
1937
1938 MODULE_DESCRIPTION("ASoC RT712 SDCA SDW driver");
1939 MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>");
1940 MODULE_LICENSE("GPL");
1941