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_put_autosuspend(component->dev);
483
484 return 0;
485 }
486
487 /* For SDCA control DAC/ADC Gain */
rt712_sdca_set_gain_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)488 static int rt712_sdca_set_gain_put(struct snd_kcontrol *kcontrol,
489 struct snd_ctl_elem_value *ucontrol)
490 {
491 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
492 struct soc_mixer_control *mc =
493 (struct soc_mixer_control *)kcontrol->private_value;
494 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
495 unsigned int read_l, read_r, gain_l_val, gain_r_val;
496 unsigned int adc_vol_flag = 0;
497 unsigned int lvalue, rvalue;
498 const unsigned int interval_offset = 0xc0;
499 const unsigned int tendB = 0xa00;
500
501 if (strstr(ucontrol->id.name, "FU0F Capture Volume"))
502 adc_vol_flag = 1;
503
504 regmap_read(rt712->mbq_regmap, mc->reg, &lvalue);
505 regmap_read(rt712->mbq_regmap, mc->rreg, &rvalue);
506
507 /* L Channel */
508 gain_l_val = ucontrol->value.integer.value[0];
509 if (gain_l_val > mc->max)
510 gain_l_val = mc->max;
511
512 if (mc->shift == 8) /* boost gain */
513 gain_l_val = gain_l_val * tendB;
514 else {
515 /* ADC/DAC gain */
516 if (adc_vol_flag)
517 gain_l_val = 0x1e00 - ((mc->max - gain_l_val) * interval_offset);
518 else
519 gain_l_val = 0 - ((mc->max - gain_l_val) * interval_offset);
520 gain_l_val &= 0xffff;
521 }
522
523 /* R Channel */
524 gain_r_val = ucontrol->value.integer.value[1];
525 if (gain_r_val > mc->max)
526 gain_r_val = mc->max;
527
528 if (mc->shift == 8) /* boost gain */
529 gain_r_val = gain_r_val * tendB;
530 else {
531 /* ADC/DAC gain */
532 if (adc_vol_flag)
533 gain_r_val = 0x1e00 - ((mc->max - gain_r_val) * interval_offset);
534 else
535 gain_r_val = 0 - ((mc->max - gain_r_val) * interval_offset);
536 gain_r_val &= 0xffff;
537 }
538
539 if (lvalue == gain_l_val && rvalue == gain_r_val)
540 return 0;
541
542 /* Lch*/
543 regmap_write(rt712->mbq_regmap, mc->reg, gain_l_val);
544 /* Rch */
545 regmap_write(rt712->mbq_regmap, mc->rreg, gain_r_val);
546
547 regmap_read(rt712->mbq_regmap, mc->reg, &read_l);
548 regmap_read(rt712->mbq_regmap, mc->rreg, &read_r);
549 if (read_r == gain_r_val && read_l == gain_l_val)
550 return 1;
551
552 return -EIO;
553 }
554
rt712_sdca_set_gain_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)555 static int rt712_sdca_set_gain_get(struct snd_kcontrol *kcontrol,
556 struct snd_ctl_elem_value *ucontrol)
557 {
558 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
559 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
560 struct soc_mixer_control *mc =
561 (struct soc_mixer_control *)kcontrol->private_value;
562 unsigned int read_l, read_r, ctl_l = 0, ctl_r = 0;
563 unsigned int adc_vol_flag = 0;
564 const unsigned int interval_offset = 0xc0;
565 const unsigned int tendB = 0xa00;
566
567 if (strstr(ucontrol->id.name, "FU0F Capture Volume"))
568 adc_vol_flag = 1;
569
570 regmap_read(rt712->mbq_regmap, mc->reg, &read_l);
571 regmap_read(rt712->mbq_regmap, mc->rreg, &read_r);
572
573 if (mc->shift == 8) /* boost gain */
574 ctl_l = read_l / tendB;
575 else {
576 if (adc_vol_flag)
577 ctl_l = mc->max - (((0x1e00 - read_l) & 0xffff) / interval_offset);
578 else
579 ctl_l = mc->max - (((0 - read_l) & 0xffff) / interval_offset);
580 }
581
582 if (read_l != read_r) {
583 if (mc->shift == 8) /* boost gain */
584 ctl_r = read_r / tendB;
585 else { /* ADC/DAC gain */
586 if (adc_vol_flag)
587 ctl_r = mc->max - (((0x1e00 - read_r) & 0xffff) / interval_offset);
588 else
589 ctl_r = mc->max - (((0 - read_r) & 0xffff) / interval_offset);
590 }
591 } else
592 ctl_r = ctl_l;
593
594 ucontrol->value.integer.value[0] = ctl_l;
595 ucontrol->value.integer.value[1] = ctl_r;
596
597 return 0;
598 }
599
rt712_sdca_set_fu0f_capture_ctl(struct rt712_sdca_priv * rt712)600 static int rt712_sdca_set_fu0f_capture_ctl(struct rt712_sdca_priv *rt712)
601 {
602 int err;
603 unsigned int ch_01, ch_02;
604
605 ch_01 = (rt712->fu0f_dapm_mute || rt712->fu0f_mixer_l_mute) ? 0x01 : 0x00;
606 ch_02 = (rt712->fu0f_dapm_mute || rt712->fu0f_mixer_r_mute) ? 0x01 : 0x00;
607
608 err = regmap_write(rt712->regmap,
609 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F,
610 RT712_SDCA_CTL_FU_MUTE, CH_01), ch_01);
611 if (err < 0)
612 return err;
613
614 err = regmap_write(rt712->regmap,
615 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F,
616 RT712_SDCA_CTL_FU_MUTE, CH_02), ch_02);
617 if (err < 0)
618 return err;
619
620 return 0;
621 }
622
rt712_sdca_fu0f_capture_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)623 static int rt712_sdca_fu0f_capture_get(struct snd_kcontrol *kcontrol,
624 struct snd_ctl_elem_value *ucontrol)
625 {
626 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
627 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
628
629 ucontrol->value.integer.value[0] = !rt712->fu0f_mixer_l_mute;
630 ucontrol->value.integer.value[1] = !rt712->fu0f_mixer_r_mute;
631 return 0;
632 }
633
rt712_sdca_fu0f_capture_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)634 static int rt712_sdca_fu0f_capture_put(struct snd_kcontrol *kcontrol,
635 struct snd_ctl_elem_value *ucontrol)
636 {
637 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
638 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
639 int err;
640
641 if (rt712->fu0f_mixer_l_mute == !ucontrol->value.integer.value[0] &&
642 rt712->fu0f_mixer_r_mute == !ucontrol->value.integer.value[1])
643 return 0;
644
645 rt712->fu0f_mixer_l_mute = !ucontrol->value.integer.value[0];
646 rt712->fu0f_mixer_r_mute = !ucontrol->value.integer.value[1];
647 err = rt712_sdca_set_fu0f_capture_ctl(rt712);
648 if (err < 0)
649 return err;
650
651 return 1;
652 }
653
rt712_sdca_set_fu05_playback_ctl(struct rt712_sdca_priv * rt712)654 static int rt712_sdca_set_fu05_playback_ctl(struct rt712_sdca_priv *rt712)
655 {
656 int err;
657 unsigned int ch_01, ch_02;
658
659 ch_01 = (rt712->fu05_dapm_mute || rt712->fu05_mixer_l_mute) ? 0x01 : 0x00;
660 ch_02 = (rt712->fu05_dapm_mute || rt712->fu05_mixer_r_mute) ? 0x01 : 0x00;
661
662 err = regmap_write(rt712->regmap,
663 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05,
664 RT712_SDCA_CTL_FU_MUTE, CH_01), ch_01);
665 if (err < 0)
666 return err;
667
668 err = regmap_write(rt712->regmap,
669 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05,
670 RT712_SDCA_CTL_FU_MUTE, CH_02), ch_02);
671 if (err < 0)
672 return err;
673
674 return 0;
675 }
676
rt712_sdca_fu05_playback_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)677 static int rt712_sdca_fu05_playback_get(struct snd_kcontrol *kcontrol,
678 struct snd_ctl_elem_value *ucontrol)
679 {
680 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
681 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
682
683 ucontrol->value.integer.value[0] = !rt712->fu05_mixer_l_mute;
684 ucontrol->value.integer.value[1] = !rt712->fu05_mixer_r_mute;
685 return 0;
686 }
687
rt712_sdca_fu05_playback_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)688 static int rt712_sdca_fu05_playback_put(struct snd_kcontrol *kcontrol,
689 struct snd_ctl_elem_value *ucontrol)
690 {
691 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
692 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
693 int err;
694
695 if (rt712->fu05_mixer_l_mute == !ucontrol->value.integer.value[0] &&
696 rt712->fu05_mixer_r_mute == !ucontrol->value.integer.value[1])
697 return 0;
698
699 rt712->fu05_mixer_l_mute = !ucontrol->value.integer.value[0];
700 rt712->fu05_mixer_r_mute = !ucontrol->value.integer.value[1];
701
702 err = rt712_sdca_set_fu05_playback_ctl(rt712);
703 if (err < 0)
704 return err;
705
706 return 1;
707 }
708
709 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -6525, 75, 0);
710 static const DECLARE_TLV_DB_SCALE(mic_vol_tlv, -1725, 75, 0);
711 static const DECLARE_TLV_DB_SCALE(boost_vol_tlv, 0, 1000, 0);
712
713 static const struct snd_kcontrol_new rt712_sdca_controls[] = {
714 SOC_DOUBLE_R_EXT_TLV("FU05 Playback Volume",
715 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05, RT712_SDCA_CTL_FU_VOLUME, CH_01),
716 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU05, RT712_SDCA_CTL_FU_VOLUME, CH_02),
717 0, 0x57, 0,
718 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, out_vol_tlv),
719 SOC_DOUBLE_EXT("FU0F Capture Switch", SND_SOC_NOPM, 0, 1, 1, 0,
720 rt712_sdca_fu0f_capture_get, rt712_sdca_fu0f_capture_put),
721 SOC_DOUBLE_R_EXT_TLV("FU0F Capture Volume",
722 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F, RT712_SDCA_CTL_FU_VOLUME, CH_01),
723 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_USER_FU0F, RT712_SDCA_CTL_FU_VOLUME, CH_02),
724 0, 0x3f, 0,
725 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, mic_vol_tlv),
726 SOC_DOUBLE_R_EXT_TLV("FU44 Boost Volume",
727 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PLATFORM_FU44, RT712_SDCA_CTL_FU_CH_GAIN, CH_01),
728 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PLATFORM_FU44, RT712_SDCA_CTL_FU_CH_GAIN, CH_02),
729 8, 3, 0,
730 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, boost_vol_tlv),
731 SOC_DOUBLE_EXT("FU05 Playback Switch", SND_SOC_NOPM, 0, 1, 1, 0,
732 rt712_sdca_fu05_playback_get, rt712_sdca_fu05_playback_put),
733 };
734
735 static const struct snd_kcontrol_new rt712_sdca_spk_controls[] = {
736 SOC_DOUBLE_R_EXT_TLV("FU06 Playback Volume",
737 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_VOLUME, CH_01),
738 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_VOLUME, CH_02),
739 0, 0x57, 0,
740 rt712_sdca_set_gain_get, rt712_sdca_set_gain_put, out_vol_tlv),
741 };
742
rt712_sdca_mux_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)743 static int rt712_sdca_mux_get(struct snd_kcontrol *kcontrol,
744 struct snd_ctl_elem_value *ucontrol)
745 {
746 struct snd_soc_component *component =
747 snd_soc_dapm_kcontrol_component(kcontrol);
748 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
749 unsigned int val = 0, mask = 0x3300;
750
751 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, &val);
752
753 val = val & mask;
754 switch (val) {
755 case 0x3000:
756 val = 1;
757 break;
758 case 0x0300:
759 val = 0;
760 break;
761 }
762
763 ucontrol->value.enumerated.item[0] = val;
764
765 return 0;
766 }
767
rt712_sdca_mux_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)768 static int rt712_sdca_mux_put(struct snd_kcontrol *kcontrol,
769 struct snd_ctl_elem_value *ucontrol)
770 {
771 struct snd_soc_component *component =
772 snd_soc_dapm_kcontrol_component(kcontrol);
773 struct snd_soc_dapm_context *dapm =
774 snd_soc_dapm_kcontrol_dapm(kcontrol);
775 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
776 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
777 unsigned int *item = ucontrol->value.enumerated.item;
778 unsigned int mask_sft;
779 unsigned int val;
780
781 if (item[0] >= e->items)
782 return -EINVAL;
783
784 if (ucontrol->value.enumerated.item[0] == 0)
785 mask_sft = 12;
786 else if (ucontrol->value.enumerated.item[0] == 1)
787 mask_sft = 8;
788 else
789 return -EINVAL;
790
791 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, &val);
792 val = (val >> mask_sft) & 0x3;
793 if (!val)
794 return 0;
795
796 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
797 RT712_MIXER_CTL1, 0x3fff);
798 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
799 RT712_MIXER_CTL1, 0x3 << mask_sft, 0);
800
801 snd_soc_dapm_mux_update_power(dapm, kcontrol,
802 item[0], e, NULL);
803
804 return 1;
805 }
806
807 static const char * const adc_mux_text[] = {
808 "MIC2",
809 "LINE2",
810 };
811
812 static SOC_ENUM_SINGLE_DECL(
813 rt712_adc23_enum, SND_SOC_NOPM, 0, adc_mux_text);
814
815 static const struct snd_kcontrol_new rt712_sdca_adc23_mux =
816 SOC_DAPM_ENUM_EXT("ADC 23 Mux", rt712_adc23_enum,
817 rt712_sdca_mux_get, rt712_sdca_mux_put);
818
rt712_sdca_fu05_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)819 static int rt712_sdca_fu05_event(struct snd_soc_dapm_widget *w,
820 struct snd_kcontrol *kcontrol, int event)
821 {
822 struct snd_soc_component *component =
823 snd_soc_dapm_to_component(w->dapm);
824 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
825
826 switch (event) {
827 case SND_SOC_DAPM_POST_PMU:
828 rt712->fu05_dapm_mute = false;
829 rt712_sdca_set_fu05_playback_ctl(rt712);
830 break;
831 case SND_SOC_DAPM_PRE_PMD:
832 rt712->fu05_dapm_mute = true;
833 rt712_sdca_set_fu05_playback_ctl(rt712);
834 break;
835 }
836 return 0;
837 }
838
rt712_sdca_fu0f_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)839 static int rt712_sdca_fu0f_event(struct snd_soc_dapm_widget *w,
840 struct snd_kcontrol *kcontrol, int event)
841 {
842 struct snd_soc_component *component =
843 snd_soc_dapm_to_component(w->dapm);
844 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
845
846 switch (event) {
847 case SND_SOC_DAPM_POST_PMU:
848 rt712->fu0f_dapm_mute = false;
849 rt712_sdca_set_fu0f_capture_ctl(rt712);
850 break;
851 case SND_SOC_DAPM_PRE_PMD:
852 rt712->fu0f_dapm_mute = true;
853 rt712_sdca_set_fu0f_capture_ctl(rt712);
854 break;
855 }
856 return 0;
857 }
858
rt712_sdca_pde40_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)859 static int rt712_sdca_pde40_event(struct snd_soc_dapm_widget *w,
860 struct snd_kcontrol *kcontrol, int event)
861 {
862 struct snd_soc_component *component =
863 snd_soc_dapm_to_component(w->dapm);
864 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
865 unsigned char ps0 = 0x0, ps3 = 0x3;
866
867 switch (event) {
868 case SND_SOC_DAPM_POST_PMU:
869 regmap_write(rt712->regmap,
870 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE40,
871 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
872 ps0);
873 break;
874 case SND_SOC_DAPM_PRE_PMD:
875 regmap_write(rt712->regmap,
876 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE40,
877 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
878 ps3);
879 break;
880 }
881 return 0;
882 }
883
rt712_sdca_pde12_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)884 static int rt712_sdca_pde12_event(struct snd_soc_dapm_widget *w,
885 struct snd_kcontrol *kcontrol, int event)
886 {
887 struct snd_soc_component *component =
888 snd_soc_dapm_to_component(w->dapm);
889 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
890 unsigned char ps0 = 0x0, ps3 = 0x3;
891
892 switch (event) {
893 case SND_SOC_DAPM_POST_PMU:
894 regmap_write(rt712->regmap,
895 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE12,
896 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
897 ps0);
898 break;
899 case SND_SOC_DAPM_PRE_PMD:
900 regmap_write(rt712->regmap,
901 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_PDE12,
902 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
903 ps3);
904 break;
905 }
906 return 0;
907 }
908
rt712_sdca_pde23_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)909 static int rt712_sdca_pde23_event(struct snd_soc_dapm_widget *w,
910 struct snd_kcontrol *kcontrol, int event)
911 {
912 struct snd_soc_component *component =
913 snd_soc_dapm_to_component(w->dapm);
914 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
915 unsigned char ps0 = 0x0, ps3 = 0x3;
916
917 switch (event) {
918 case SND_SOC_DAPM_POST_PMU:
919 regmap_write(rt712->regmap,
920 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_PDE23,
921 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
922 ps0);
923 break;
924 case SND_SOC_DAPM_PRE_PMD:
925 regmap_write(rt712->regmap,
926 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_PDE23,
927 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
928 ps3);
929 break;
930
931 default:
932 break;
933 }
934
935 return 0;
936 }
937
938 static const struct snd_kcontrol_new rt712_spk_l_dac =
939 SOC_DAPM_SINGLE_AUTODISABLE("Switch",
940 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_MUTE, CH_01),
941 0, 1, 1);
942 static const struct snd_kcontrol_new rt712_spk_r_dac =
943 SOC_DAPM_SINGLE_AUTODISABLE("Switch",
944 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_USER_FU06, RT712_SDCA_CTL_FU_MUTE, CH_02),
945 0, 1, 1);
946
947 static const struct snd_soc_dapm_widget rt712_sdca_dapm_widgets[] = {
948 SND_SOC_DAPM_OUTPUT("HP"),
949 SND_SOC_DAPM_INPUT("MIC2"),
950 SND_SOC_DAPM_INPUT("LINE2"),
951
952 SND_SOC_DAPM_SUPPLY("PDE 40", SND_SOC_NOPM, 0, 0,
953 rt712_sdca_pde40_event,
954 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
955 SND_SOC_DAPM_SUPPLY("PDE 12", SND_SOC_NOPM, 0, 0,
956 rt712_sdca_pde12_event,
957 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
958
959 SND_SOC_DAPM_DAC_E("FU 05", NULL, SND_SOC_NOPM, 0, 0,
960 rt712_sdca_fu05_event,
961 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
962 SND_SOC_DAPM_ADC_E("FU 0F", NULL, SND_SOC_NOPM, 0, 0,
963 rt712_sdca_fu0f_event,
964 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
965 SND_SOC_DAPM_MUX("ADC 23 Mux", SND_SOC_NOPM, 0, 0,
966 &rt712_sdca_adc23_mux),
967
968 SND_SOC_DAPM_AIF_IN("DP1RX", "DP1 Playback", 0, SND_SOC_NOPM, 0, 0),
969 SND_SOC_DAPM_AIF_OUT("DP4TX", "DP4 Capture", 0, SND_SOC_NOPM, 0, 0),
970 };
971
972 static const struct snd_soc_dapm_route rt712_sdca_audio_map[] = {
973 { "FU 05", NULL, "DP1RX" },
974 { "DP4TX", NULL, "FU 0F" },
975
976 { "FU 0F", NULL, "PDE 12" },
977 { "FU 0F", NULL, "ADC 23 Mux" },
978 { "ADC 23 Mux", "LINE2", "LINE2" },
979 { "ADC 23 Mux", "MIC2", "MIC2" },
980
981 { "HP", NULL, "PDE 40" },
982 { "HP", NULL, "FU 05" },
983 };
984
985 static const struct snd_soc_dapm_widget rt712_sdca_spk_dapm_widgets[] = {
986 SND_SOC_DAPM_AIF_IN("DP3RX", "DP3 Playback", 0, SND_SOC_NOPM, 0, 0),
987
988 /* Digital Interface */
989 SND_SOC_DAPM_PGA("FU06", SND_SOC_NOPM, 0, 0, NULL, 0),
990
991 SND_SOC_DAPM_SUPPLY("PDE 23", SND_SOC_NOPM, 0, 0,
992 rt712_sdca_pde23_event,
993 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
994
995 /* Output */
996 SND_SOC_DAPM_SWITCH("OT23 L", SND_SOC_NOPM, 0, 0, &rt712_spk_l_dac),
997 SND_SOC_DAPM_SWITCH("OT23 R", SND_SOC_NOPM, 0, 0, &rt712_spk_r_dac),
998 SND_SOC_DAPM_OUTPUT("SPOL"),
999 SND_SOC_DAPM_OUTPUT("SPOR"),
1000 };
1001
1002 static const struct snd_soc_dapm_route rt712_sdca_spk_dapm_routes[] = {
1003 { "FU06", NULL, "DP3RX" },
1004 { "FU06", NULL, "PDE 23" },
1005 { "OT23 L", "Switch", "FU06" },
1006 { "OT23 R", "Switch", "FU06" },
1007 { "SPOL", NULL, "OT23 L" },
1008 { "SPOR", NULL, "OT23 R" },
1009 };
1010
rt712_sdca_parse_dt(struct rt712_sdca_priv * rt712,struct device * dev)1011 static int rt712_sdca_parse_dt(struct rt712_sdca_priv *rt712, struct device *dev)
1012 {
1013 device_property_read_u32(dev, "realtek,jd-src", &rt712->jd_src);
1014
1015 return 0;
1016 }
1017
rt712_sdca_probe(struct snd_soc_component * component)1018 static int rt712_sdca_probe(struct snd_soc_component *component)
1019 {
1020 struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
1021 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1022 int ret;
1023
1024 rt712_sdca_parse_dt(rt712, &rt712->slave->dev);
1025 rt712->component = component;
1026
1027 /* add SPK route */
1028 if (rt712->hw_id != RT712_DEV_ID_713) {
1029 snd_soc_add_component_controls(component,
1030 rt712_sdca_spk_controls, ARRAY_SIZE(rt712_sdca_spk_controls));
1031 snd_soc_dapm_new_controls(dapm,
1032 rt712_sdca_spk_dapm_widgets, ARRAY_SIZE(rt712_sdca_spk_dapm_widgets));
1033 snd_soc_dapm_add_routes(dapm,
1034 rt712_sdca_spk_dapm_routes, ARRAY_SIZE(rt712_sdca_spk_dapm_routes));
1035 }
1036
1037 if (!rt712->first_hw_init)
1038 return 0;
1039
1040 ret = pm_runtime_resume(component->dev);
1041 if (ret < 0 && ret != -EACCES)
1042 return ret;
1043
1044 return 0;
1045 }
1046
rt712_sdca_dmic_set_gain_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1047 static int rt712_sdca_dmic_set_gain_get(struct snd_kcontrol *kcontrol,
1048 struct snd_ctl_elem_value *ucontrol)
1049 {
1050 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1051 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1052 struct rt712_dmic_kctrl_priv *p =
1053 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1054 unsigned int regvalue, ctl, i;
1055 unsigned int adc_vol_flag = 0;
1056 const unsigned int interval_offset = 0xc0;
1057
1058 if (strstr(ucontrol->id.name, "FU1E Capture Volume"))
1059 adc_vol_flag = 1;
1060
1061 /* check all channels */
1062 for (i = 0; i < p->count; i++) {
1063 regmap_read(rt712->mbq_regmap, p->reg_base + i, ®value);
1064
1065 if (!adc_vol_flag) /* boost gain */
1066 ctl = regvalue / 0x0a00;
1067 else /* ADC gain */
1068 ctl = p->max - (((0x1e00 - regvalue) & 0xffff) / interval_offset);
1069
1070 ucontrol->value.integer.value[i] = ctl;
1071 }
1072
1073 return 0;
1074 }
1075
rt712_sdca_dmic_set_gain_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1076 static int rt712_sdca_dmic_set_gain_put(struct snd_kcontrol *kcontrol,
1077 struct snd_ctl_elem_value *ucontrol)
1078 {
1079 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1080 struct rt712_dmic_kctrl_priv *p =
1081 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1082 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1083 unsigned int gain_val[4];
1084 unsigned int i, adc_vol_flag = 0, changed = 0;
1085 unsigned int regvalue[4];
1086 const unsigned int interval_offset = 0xc0;
1087 int err;
1088
1089 if (strstr(ucontrol->id.name, "FU1E Capture Volume"))
1090 adc_vol_flag = 1;
1091
1092 /* check all channels */
1093 for (i = 0; i < p->count; i++) {
1094 regmap_read(rt712->mbq_regmap, p->reg_base + i, ®value[i]);
1095
1096 gain_val[i] = ucontrol->value.integer.value[i];
1097 if (gain_val[i] > p->max)
1098 gain_val[i] = p->max;
1099
1100 if (!adc_vol_flag) /* boost gain */
1101 gain_val[i] = gain_val[i] * 0x0a00;
1102 else { /* ADC gain */
1103 gain_val[i] = 0x1e00 - ((p->max - gain_val[i]) * interval_offset);
1104 gain_val[i] &= 0xffff;
1105 }
1106
1107 if (regvalue[i] != gain_val[i])
1108 changed = 1;
1109 }
1110
1111 if (!changed)
1112 return 0;
1113
1114 for (i = 0; i < p->count; i++) {
1115 err = regmap_write(rt712->mbq_regmap, p->reg_base + i, gain_val[i]);
1116 if (err < 0)
1117 dev_err(&rt712->slave->dev, "0x%08x can't be set\n", p->reg_base + i);
1118 }
1119
1120 return changed;
1121 }
1122
rt712_sdca_set_fu1e_capture_ctl(struct rt712_sdca_priv * rt712)1123 static int rt712_sdca_set_fu1e_capture_ctl(struct rt712_sdca_priv *rt712)
1124 {
1125 int err, i;
1126 unsigned int ch_mute;
1127
1128 for (i = 0; i < ARRAY_SIZE(rt712->fu1e_mixer_mute); i++) {
1129 ch_mute = (rt712->fu1e_dapm_mute || rt712->fu1e_mixer_mute[i]) ? 0x01 : 0x00;
1130 err = regmap_write(rt712->regmap,
1131 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E,
1132 RT712_SDCA_CTL_FU_MUTE, CH_01) + i, ch_mute);
1133 if (err < 0)
1134 return err;
1135 }
1136
1137 return 0;
1138 }
1139
rt712_sdca_dmic_fu1e_capture_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1140 static int rt712_sdca_dmic_fu1e_capture_get(struct snd_kcontrol *kcontrol,
1141 struct snd_ctl_elem_value *ucontrol)
1142 {
1143 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1144 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1145 struct rt712_dmic_kctrl_priv *p =
1146 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1147 unsigned int i;
1148
1149 for (i = 0; i < p->count; i++)
1150 ucontrol->value.integer.value[i] = !rt712->fu1e_mixer_mute[i];
1151
1152 return 0;
1153 }
1154
rt712_sdca_dmic_fu1e_capture_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1155 static int rt712_sdca_dmic_fu1e_capture_put(struct snd_kcontrol *kcontrol,
1156 struct snd_ctl_elem_value *ucontrol)
1157 {
1158 struct snd_soc_component *component = snd_kcontrol_chip(kcontrol);
1159 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1160 struct rt712_dmic_kctrl_priv *p =
1161 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1162 int err, changed = 0, i;
1163
1164 for (i = 0; i < p->count; i++) {
1165 if (rt712->fu1e_mixer_mute[i] != !ucontrol->value.integer.value[i])
1166 changed = 1;
1167 rt712->fu1e_mixer_mute[i] = !ucontrol->value.integer.value[i];
1168 }
1169
1170 err = rt712_sdca_set_fu1e_capture_ctl(rt712);
1171 if (err < 0)
1172 return err;
1173
1174 return changed;
1175 }
1176
rt712_sdca_fu_info(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_info * uinfo)1177 static int rt712_sdca_fu_info(struct snd_kcontrol *kcontrol,
1178 struct snd_ctl_elem_info *uinfo)
1179 {
1180 struct rt712_dmic_kctrl_priv *p =
1181 (struct rt712_dmic_kctrl_priv *)kcontrol->private_value;
1182
1183 if (p->max == 1)
1184 uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
1185 else
1186 uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
1187 uinfo->count = p->count;
1188 uinfo->value.integer.min = 0;
1189 uinfo->value.integer.max = p->max;
1190 return 0;
1191 }
1192
1193 #define RT712_SDCA_PR_VALUE(xreg_base, xcount, xmax, xinvert) \
1194 ((unsigned long)&(struct rt712_dmic_kctrl_priv) \
1195 {.reg_base = xreg_base, .count = xcount, .max = xmax, \
1196 .invert = xinvert})
1197
1198 #define RT712_SDCA_FU_CTRL(xname, reg_base, xmax, xinvert, xcount) \
1199 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
1200 .info = rt712_sdca_fu_info, \
1201 .get = rt712_sdca_dmic_fu1e_capture_get, \
1202 .put = rt712_sdca_dmic_fu1e_capture_put, \
1203 .private_value = RT712_SDCA_PR_VALUE(reg_base, xcount, xmax, xinvert)}
1204
1205 #define RT712_SDCA_EXT_TLV(xname, reg_base, xhandler_get,\
1206 xhandler_put, xcount, xmax, tlv_array) \
1207 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
1208 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ | \
1209 SNDRV_CTL_ELEM_ACCESS_READWRITE, \
1210 .tlv.p = (tlv_array), \
1211 .info = rt712_sdca_fu_info, \
1212 .get = xhandler_get, .put = xhandler_put, \
1213 .private_value = RT712_SDCA_PR_VALUE(reg_base, xcount, xmax, 0) }
1214
1215 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -1725, 75, 0);
1216 static const DECLARE_TLV_DB_SCALE(dmic_vol_tlv, 0, 1000, 0);
1217
1218 static const struct snd_kcontrol_new rt712_sdca_dmic_snd_controls[] = {
1219 RT712_SDCA_FU_CTRL("FU1E Capture Switch",
1220 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E, RT712_SDCA_CTL_FU_MUTE, CH_01),
1221 1, 1, 4),
1222 RT712_SDCA_EXT_TLV("FU1E Capture Volume",
1223 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_USER_FU1E, RT712_SDCA_CTL_FU_VOLUME, CH_01),
1224 rt712_sdca_dmic_set_gain_get, rt712_sdca_dmic_set_gain_put, 4, 0x3f, in_vol_tlv),
1225 RT712_SDCA_EXT_TLV("FU15 Boost Volume",
1226 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PLATFORM_FU15, RT712_SDCA_CTL_FU_CH_GAIN, CH_01),
1227 rt712_sdca_dmic_set_gain_get, rt712_sdca_dmic_set_gain_put, 4, 3, dmic_vol_tlv),
1228 };
1229
rt712_sdca_dmic_mux_get(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1230 static int rt712_sdca_dmic_mux_get(struct snd_kcontrol *kcontrol,
1231 struct snd_ctl_elem_value *ucontrol)
1232 {
1233 struct snd_soc_component *component =
1234 snd_soc_dapm_kcontrol_component(kcontrol);
1235 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1236 unsigned int val = 0, mask_sft;
1237
1238 if (strstr(ucontrol->id.name, "ADC 0A Mux"))
1239 mask_sft = 0;
1240 else if (strstr(ucontrol->id.name, "ADC 0B Mux"))
1241 mask_sft = 4;
1242 else
1243 return -EINVAL;
1244
1245 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL,
1246 RT712_HDA_LEGACY_MUX_CTL0, &val);
1247
1248 ucontrol->value.enumerated.item[0] = (((val >> mask_sft) & 0xf) == 0x4) ? 0 : 1;
1249
1250 return 0;
1251 }
1252
rt712_sdca_dmic_mux_put(struct snd_kcontrol * kcontrol,struct snd_ctl_elem_value * ucontrol)1253 static int rt712_sdca_dmic_mux_put(struct snd_kcontrol *kcontrol,
1254 struct snd_ctl_elem_value *ucontrol)
1255 {
1256 struct snd_soc_component *component =
1257 snd_soc_dapm_kcontrol_component(kcontrol);
1258 struct snd_soc_dapm_context *dapm =
1259 snd_soc_dapm_kcontrol_dapm(kcontrol);
1260 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1261 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1262 unsigned int *item = ucontrol->value.enumerated.item;
1263 unsigned int val, val2 = 0, change, mask_sft;
1264
1265 if (item[0] >= e->items)
1266 return -EINVAL;
1267
1268 if (strstr(ucontrol->id.name, "ADC 0A Mux"))
1269 mask_sft = 0;
1270 else if (strstr(ucontrol->id.name, "ADC 0B Mux"))
1271 mask_sft = 4;
1272 else
1273 return -EINVAL;
1274
1275 val = snd_soc_enum_item_to_val(e, item[0]) << e->shift_l;
1276
1277 rt712_sdca_index_read(rt712, RT712_VENDOR_HDA_CTL,
1278 RT712_HDA_LEGACY_MUX_CTL0, &val2);
1279 val2 = ((0xf << mask_sft) & val2) >> mask_sft;
1280
1281 if (val == 0)
1282 val = 0x4;
1283 else if (val >= 1)
1284 val = 0xe;
1285
1286 if (val == val2)
1287 change = 0;
1288 else
1289 change = 1;
1290
1291 if (change)
1292 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1293 RT712_HDA_LEGACY_MUX_CTL0, 0xf << mask_sft,
1294 val << mask_sft);
1295
1296 snd_soc_dapm_mux_update_power(dapm, kcontrol, item[0], e, NULL);
1297
1298 return change;
1299 }
1300
1301 static const char * const adc_dmic_mux_text[] = {
1302 "DMIC1",
1303 "DMIC2",
1304 };
1305
1306 static SOC_ENUM_SINGLE_DECL(
1307 rt712_adc0a_enum, SND_SOC_NOPM, 0, adc_dmic_mux_text);
1308
1309 static SOC_ENUM_SINGLE_DECL(
1310 rt712_adc0b_enum, SND_SOC_NOPM, 0, adc_dmic_mux_text);
1311
1312 static const struct snd_kcontrol_new rt712_sdca_dmic_adc0a_mux =
1313 SOC_DAPM_ENUM_EXT("ADC 0A Mux", rt712_adc0a_enum,
1314 rt712_sdca_dmic_mux_get, rt712_sdca_dmic_mux_put);
1315
1316 static const struct snd_kcontrol_new rt712_sdca_dmic_adc0b_mux =
1317 SOC_DAPM_ENUM_EXT("ADC 0B Mux", rt712_adc0b_enum,
1318 rt712_sdca_dmic_mux_get, rt712_sdca_dmic_mux_put);
1319
rt712_sdca_dmic_fu1e_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1320 static int rt712_sdca_dmic_fu1e_event(struct snd_soc_dapm_widget *w,
1321 struct snd_kcontrol *kcontrol, int event)
1322 {
1323 struct snd_soc_component *component =
1324 snd_soc_dapm_to_component(w->dapm);
1325 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1326
1327 switch (event) {
1328 case SND_SOC_DAPM_POST_PMU:
1329 rt712->fu1e_dapm_mute = false;
1330 rt712_sdca_set_fu1e_capture_ctl(rt712);
1331 break;
1332 case SND_SOC_DAPM_PRE_PMD:
1333 rt712->fu1e_dapm_mute = true;
1334 rt712_sdca_set_fu1e_capture_ctl(rt712);
1335 break;
1336 }
1337 return 0;
1338 }
1339
rt712_sdca_dmic_pde11_event(struct snd_soc_dapm_widget * w,struct snd_kcontrol * kcontrol,int event)1340 static int rt712_sdca_dmic_pde11_event(struct snd_soc_dapm_widget *w,
1341 struct snd_kcontrol *kcontrol, int event)
1342 {
1343 struct snd_soc_component *component =
1344 snd_soc_dapm_to_component(w->dapm);
1345 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1346 unsigned char ps0 = 0x0, ps3 = 0x3;
1347
1348 switch (event) {
1349 case SND_SOC_DAPM_POST_PMU:
1350 regmap_write(rt712->regmap,
1351 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PDE11,
1352 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
1353 ps0);
1354 break;
1355 case SND_SOC_DAPM_PRE_PMD:
1356 regmap_write(rt712->regmap,
1357 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_PDE11,
1358 RT712_SDCA_CTL_REQ_POWER_STATE, 0),
1359 ps3);
1360 break;
1361 }
1362 return 0;
1363 }
1364
1365 static const struct snd_soc_dapm_widget rt712_sdca_dmic_dapm_widgets[] = {
1366 SND_SOC_DAPM_INPUT("DMIC1"),
1367 SND_SOC_DAPM_INPUT("DMIC2"),
1368
1369 SND_SOC_DAPM_SUPPLY("PDE 11", SND_SOC_NOPM, 0, 0,
1370 rt712_sdca_dmic_pde11_event,
1371 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1372
1373 SND_SOC_DAPM_ADC_E("FU 1E", NULL, SND_SOC_NOPM, 0, 0,
1374 rt712_sdca_dmic_fu1e_event,
1375 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1376 SND_SOC_DAPM_MUX("ADC 0A Mux", SND_SOC_NOPM, 0, 0,
1377 &rt712_sdca_dmic_adc0a_mux),
1378 SND_SOC_DAPM_MUX("ADC 0B Mux", SND_SOC_NOPM, 0, 0,
1379 &rt712_sdca_dmic_adc0b_mux),
1380
1381 SND_SOC_DAPM_AIF_OUT("DP8TX", "DP8 Capture", 0, SND_SOC_NOPM, 0, 0),
1382 };
1383
1384 static const struct snd_soc_dapm_route rt712_sdca_dmic_audio_map[] = {
1385 {"DP8TX", NULL, "FU 1E"},
1386
1387 {"FU 1E", NULL, "PDE 11"},
1388 {"FU 1E", NULL, "ADC 0A Mux"},
1389 {"FU 1E", NULL, "ADC 0B Mux"},
1390 {"ADC 0A Mux", "DMIC1", "DMIC1"},
1391 {"ADC 0A Mux", "DMIC2", "DMIC2"},
1392 {"ADC 0B Mux", "DMIC1", "DMIC1"},
1393 {"ADC 0B Mux", "DMIC2", "DMIC2"},
1394 };
1395
rt712_sdca_dmic_probe(struct snd_soc_component * component)1396 static int rt712_sdca_dmic_probe(struct snd_soc_component *component)
1397 {
1398 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1399 int ret;
1400
1401 rt712->dmic_component = component;
1402
1403 if (!rt712->first_hw_init)
1404 return 0;
1405
1406 ret = pm_runtime_resume(component->dev);
1407 if (ret < 0 && ret != -EACCES)
1408 return ret;
1409
1410 return 0;
1411 }
1412
1413 static const struct snd_soc_component_driver soc_sdca_dev_rt712 = {
1414 .probe = rt712_sdca_probe,
1415 .controls = rt712_sdca_controls,
1416 .num_controls = ARRAY_SIZE(rt712_sdca_controls),
1417 .dapm_widgets = rt712_sdca_dapm_widgets,
1418 .num_dapm_widgets = ARRAY_SIZE(rt712_sdca_dapm_widgets),
1419 .dapm_routes = rt712_sdca_audio_map,
1420 .num_dapm_routes = ARRAY_SIZE(rt712_sdca_audio_map),
1421 .set_jack = rt712_sdca_set_jack_detect,
1422 .endianness = 1,
1423 };
1424
1425 static const struct snd_soc_component_driver soc_sdca_dev_rt712_dmic = {
1426 .probe = rt712_sdca_dmic_probe,
1427 .controls = rt712_sdca_dmic_snd_controls,
1428 .num_controls = ARRAY_SIZE(rt712_sdca_dmic_snd_controls),
1429 .dapm_widgets = rt712_sdca_dmic_dapm_widgets,
1430 .num_dapm_widgets = ARRAY_SIZE(rt712_sdca_dmic_dapm_widgets),
1431 .dapm_routes = rt712_sdca_dmic_audio_map,
1432 .num_dapm_routes = ARRAY_SIZE(rt712_sdca_dmic_audio_map),
1433 .endianness = 1,
1434 #ifdef CONFIG_DEBUG_FS
1435 .debugfs_prefix = "dmic",
1436 #endif
1437 };
1438
rt712_sdca_set_sdw_stream(struct snd_soc_dai * dai,void * sdw_stream,int direction)1439 static int rt712_sdca_set_sdw_stream(struct snd_soc_dai *dai, void *sdw_stream,
1440 int direction)
1441 {
1442 snd_soc_dai_dma_data_set(dai, direction, sdw_stream);
1443
1444 return 0;
1445 }
1446
rt712_sdca_shutdown(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)1447 static void rt712_sdca_shutdown(struct snd_pcm_substream *substream,
1448 struct snd_soc_dai *dai)
1449 {
1450 snd_soc_dai_set_dma_data(dai, substream, NULL);
1451 }
1452
rt712_sdca_pcm_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)1453 static int rt712_sdca_pcm_hw_params(struct snd_pcm_substream *substream,
1454 struct snd_pcm_hw_params *params,
1455 struct snd_soc_dai *dai)
1456 {
1457 struct snd_soc_component *component = dai->component;
1458 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1459 struct sdw_stream_config stream_config;
1460 struct sdw_port_config port_config;
1461 enum sdw_data_direction direction;
1462 struct sdw_stream_runtime *sdw_stream;
1463 int retval, port, num_channels;
1464 unsigned int sampling_rate;
1465
1466 dev_dbg(dai->dev, "%s %s id %d", __func__, dai->name, dai->id);
1467 sdw_stream = snd_soc_dai_get_dma_data(dai, substream);
1468
1469 if (!sdw_stream)
1470 return -EINVAL;
1471
1472 if (!rt712->slave)
1473 return -EINVAL;
1474
1475 /* VA doesn't support AIF3 */
1476 if (dai->id == RT712_AIF3 && rt712->version_id == RT712_VA)
1477 return -EINVAL;
1478
1479 /* SoundWire specific configuration */
1480 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
1481 direction = SDW_DATA_DIR_RX;
1482 if (dai->id == RT712_AIF1)
1483 port = 1;
1484 else if (dai->id == RT712_AIF2)
1485 port = 3;
1486 else
1487 return -EINVAL;
1488 } else {
1489 direction = SDW_DATA_DIR_TX;
1490 if (dai->id == RT712_AIF1)
1491 port = 4;
1492 else if (dai->id == RT712_AIF3)
1493 port = 8;
1494 else
1495 return -EINVAL;
1496 }
1497
1498 stream_config.frame_rate = params_rate(params);
1499 stream_config.ch_count = params_channels(params);
1500 stream_config.bps = snd_pcm_format_width(params_format(params));
1501 stream_config.direction = direction;
1502
1503 num_channels = params_channels(params);
1504 port_config.ch_mask = GENMASK(num_channels - 1, 0);
1505 port_config.num = port;
1506
1507 retval = sdw_stream_add_slave(rt712->slave, &stream_config,
1508 &port_config, 1, sdw_stream);
1509 if (retval) {
1510 dev_err(dai->dev, "%s: Unable to configure port\n", __func__);
1511 return retval;
1512 }
1513
1514 if (params_channels(params) > 16) {
1515 dev_err(component->dev, "%s: Unsupported channels %d\n",
1516 __func__, params_channels(params));
1517 return -EINVAL;
1518 }
1519
1520 /* sampling rate configuration */
1521 switch (params_rate(params)) {
1522 case 44100:
1523 sampling_rate = RT712_SDCA_RATE_44100HZ;
1524 break;
1525 case 48000:
1526 sampling_rate = RT712_SDCA_RATE_48000HZ;
1527 break;
1528 case 96000:
1529 sampling_rate = RT712_SDCA_RATE_96000HZ;
1530 break;
1531 case 192000:
1532 sampling_rate = RT712_SDCA_RATE_192000HZ;
1533 break;
1534 default:
1535 dev_err(component->dev, "%s: Rate %d is not supported\n",
1536 __func__, params_rate(params));
1537 return -EINVAL;
1538 }
1539
1540 /* set sampling frequency */
1541 switch (dai->id) {
1542 case RT712_AIF1:
1543 regmap_write(rt712->regmap,
1544 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_CS01, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1545 sampling_rate);
1546 regmap_write(rt712->regmap,
1547 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_CS11, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1548 sampling_rate);
1549 break;
1550 case RT712_AIF2:
1551 regmap_write(rt712->regmap,
1552 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_CS31, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1553 sampling_rate);
1554 break;
1555 case RT712_AIF3:
1556 regmap_write(rt712->regmap,
1557 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_CS1F, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1558 sampling_rate);
1559 regmap_write(rt712->regmap,
1560 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_CS1C, RT712_SDCA_CTL_SAMPLE_FREQ_INDEX, 0),
1561 sampling_rate);
1562 break;
1563 default:
1564 dev_err(component->dev, "%s: Wrong DAI id\n", __func__);
1565 return -EINVAL;
1566 }
1567
1568 return 0;
1569 }
1570
rt712_sdca_pcm_hw_free(struct snd_pcm_substream * substream,struct snd_soc_dai * dai)1571 static int rt712_sdca_pcm_hw_free(struct snd_pcm_substream *substream,
1572 struct snd_soc_dai *dai)
1573 {
1574 struct snd_soc_component *component = dai->component;
1575 struct rt712_sdca_priv *rt712 = snd_soc_component_get_drvdata(component);
1576 struct sdw_stream_runtime *sdw_stream =
1577 snd_soc_dai_get_dma_data(dai, substream);
1578
1579 if (!rt712->slave)
1580 return -EINVAL;
1581
1582 sdw_stream_remove_slave(rt712->slave, sdw_stream);
1583 return 0;
1584 }
1585
1586 #define RT712_STEREO_RATES (SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000 | SNDRV_PCM_RATE_96000 | \
1587 SNDRV_PCM_RATE_192000)
1588 #define RT712_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
1589 SNDRV_PCM_FMTBIT_S24_LE)
1590
1591 static const struct snd_soc_dai_ops rt712_sdca_ops = {
1592 .hw_params = rt712_sdca_pcm_hw_params,
1593 .hw_free = rt712_sdca_pcm_hw_free,
1594 .set_stream = rt712_sdca_set_sdw_stream,
1595 .shutdown = rt712_sdca_shutdown,
1596 };
1597
1598 static struct snd_soc_dai_driver rt712_sdca_dai[] = {
1599 {
1600 .name = "rt712-sdca-aif1",
1601 .id = RT712_AIF1,
1602 .playback = {
1603 .stream_name = "DP1 Playback",
1604 .channels_min = 1,
1605 .channels_max = 2,
1606 .rates = RT712_STEREO_RATES,
1607 .formats = RT712_FORMATS,
1608 },
1609 .capture = {
1610 .stream_name = "DP4 Capture",
1611 .channels_min = 1,
1612 .channels_max = 2,
1613 .rates = RT712_STEREO_RATES,
1614 .formats = RT712_FORMATS,
1615 },
1616 .ops = &rt712_sdca_ops,
1617 },
1618 {
1619 .name = "rt712-sdca-aif2",
1620 .id = RT712_AIF2,
1621 .playback = {
1622 .stream_name = "DP3 Playback",
1623 .channels_min = 1,
1624 .channels_max = 2,
1625 .rates = RT712_STEREO_RATES,
1626 .formats = RT712_FORMATS,
1627 },
1628 .ops = &rt712_sdca_ops,
1629 }
1630 };
1631
1632 static struct snd_soc_dai_driver rt712_sdca_dmic_dai[] = {
1633 {
1634 .name = "rt712-sdca-aif3",
1635 .id = RT712_AIF3,
1636 .capture = {
1637 .stream_name = "DP8 Capture",
1638 .channels_min = 1,
1639 .channels_max = 4,
1640 .rates = RT712_STEREO_RATES,
1641 .formats = RT712_FORMATS,
1642 },
1643 .ops = &rt712_sdca_ops,
1644 }
1645 };
1646
rt712_sdca_init(struct device * dev,struct regmap * regmap,struct regmap * mbq_regmap,struct sdw_slave * slave)1647 int rt712_sdca_init(struct device *dev, struct regmap *regmap,
1648 struct regmap *mbq_regmap, struct sdw_slave *slave)
1649 {
1650 struct rt712_sdca_priv *rt712;
1651 int ret;
1652
1653 rt712 = devm_kzalloc(dev, sizeof(*rt712), GFP_KERNEL);
1654 if (!rt712)
1655 return -ENOMEM;
1656
1657 dev_set_drvdata(dev, rt712);
1658 rt712->slave = slave;
1659 rt712->regmap = regmap;
1660 rt712->mbq_regmap = mbq_regmap;
1661
1662 regcache_cache_only(rt712->regmap, true);
1663 regcache_cache_only(rt712->mbq_regmap, true);
1664
1665 mutex_init(&rt712->calibrate_mutex);
1666 mutex_init(&rt712->disable_irq_lock);
1667
1668 INIT_DELAYED_WORK(&rt712->jack_detect_work, rt712_sdca_jack_detect_handler);
1669 INIT_DELAYED_WORK(&rt712->jack_btn_check_work, rt712_sdca_btn_check_handler);
1670
1671 /*
1672 * Mark hw_init to false
1673 * HW init will be performed when device reports present
1674 */
1675 rt712->hw_init = false;
1676 rt712->first_hw_init = false;
1677 rt712->fu0f_dapm_mute = true;
1678 rt712->fu0f_mixer_l_mute = rt712->fu0f_mixer_r_mute = true;
1679 rt712->fu1e_dapm_mute = true;
1680 rt712->fu1e_mixer_mute[0] = rt712->fu1e_mixer_mute[1] =
1681 rt712->fu1e_mixer_mute[2] = rt712->fu1e_mixer_mute[3] = true;
1682 rt712->fu05_dapm_mute = true;
1683 rt712->fu05_mixer_l_mute = rt712->fu05_mixer_r_mute = false;
1684
1685 /* JD source uses JD1 in default */
1686 rt712->jd_src = RT712_JD1;
1687
1688 if (slave->id.part_id != RT712_PART_ID_713)
1689 ret = devm_snd_soc_register_component(dev,
1690 &soc_sdca_dev_rt712, rt712_sdca_dai, ARRAY_SIZE(rt712_sdca_dai));
1691 else
1692 ret = devm_snd_soc_register_component(dev,
1693 &soc_sdca_dev_rt712, rt712_sdca_dai, 1);
1694 if (ret < 0)
1695 return ret;
1696
1697 /* only add the dmic component if a SMART_MIC function is exposed in ACPI */
1698 if (sdca_device_quirk_match(slave, SDCA_QUIRKS_RT712_VB)) {
1699 ret = devm_snd_soc_register_component(dev,
1700 &soc_sdca_dev_rt712_dmic,
1701 rt712_sdca_dmic_dai,
1702 ARRAY_SIZE(rt712_sdca_dmic_dai));
1703 if (ret < 0)
1704 return ret;
1705 rt712->dmic_function_found = true;
1706 }
1707
1708 /* set autosuspend parameters */
1709 pm_runtime_set_autosuspend_delay(dev, 3000);
1710 pm_runtime_use_autosuspend(dev);
1711
1712 /* make sure the device does not suspend immediately */
1713 pm_runtime_mark_last_busy(dev);
1714
1715 pm_runtime_enable(dev);
1716
1717 /* important note: the device is NOT tagged as 'active' and will remain
1718 * 'suspended' until the hardware is enumerated/initialized. This is required
1719 * to make sure the ASoC framework use of pm_runtime_get_sync() does not silently
1720 * fail with -EACCESS because of race conditions between card creation and enumeration
1721 */
1722
1723 dev_dbg(dev, "%s\n", __func__);
1724
1725 return 0;
1726 }
1727
rt712_sdca_va_io_init(struct rt712_sdca_priv * rt712)1728 static void rt712_sdca_va_io_init(struct rt712_sdca_priv *rt712)
1729 {
1730 int ret = 0;
1731 unsigned int hibernation_flag;
1732 struct device *dev = &rt712->slave->dev;
1733
1734 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_ANALOG_BIAS_CTL3, 0xaa81);
1735 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_LDO2_3_CTL1, 0xa1e0);
1736 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL1, 0x0000);
1737 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL2, 0x0000);
1738 rt712_sdca_index_write(rt712, RT712_VENDOR_ANALOG_CTL, RT712_MISC_POWER_CTL7, 0x0000);
1739 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1740
1741 /* calibration */
1742 rt712_sdca_index_read(rt712, RT712_VENDOR_REG, RT712_SW_CONFIG1, &hibernation_flag);
1743 if (!hibernation_flag) {
1744 ret = rt712_sdca_calibration(rt712);
1745 if (ret < 0)
1746 dev_err(dev, "%s, calibration failed!\n", __func__);
1747 }
1748
1749 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1750 RT712_MIXER_CTL1, 0x3000, 0x0000);
1751 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1752 RT712_ADC0A_08_PDE_FLOAT_CTL, 0x1112);
1753 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1754 RT712_MIC2_LINE2_PDE_FLOAT_CTL, 0x3412);
1755 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL,
1756 RT712_DAC03_HP_PDE_FLOAT_CTL, 0x4040);
1757
1758 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL,
1759 RT712_HDA_LEGACY_GPIO_WAKE_EN_CTL, 0x0001, 0x0000);
1760 regmap_write(rt712->regmap, 0x2f50, 0x00);
1761 regmap_write(rt712->regmap, 0x2f54, 0x00);
1762 regmap_write(rt712->regmap,
1763 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_IT09, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1764
1765 /* add SPK settings */
1766 if (rt712->hw_id != RT712_DEV_ID_713) {
1767 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_AMP_PDE_FLOAT_CTL, 0x2323);
1768 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_EAPD_CTL, 0x0002);
1769 regmap_write(rt712->regmap,
1770 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_OT23, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x04);
1771 }
1772 }
1773
rt712_sdca_vb_io_init(struct rt712_sdca_priv * rt712)1774 static void rt712_sdca_vb_io_init(struct rt712_sdca_priv *rt712)
1775 {
1776 int ret = 0;
1777 unsigned int jack_func_status, mic_func_status, amp_func_status;
1778 struct device *dev = &rt712->slave->dev;
1779
1780 regmap_read(rt712->regmap,
1781 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &jack_func_status);
1782 regmap_read(rt712->regmap,
1783 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &mic_func_status);
1784 regmap_read(rt712->regmap,
1785 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0), &_func_status);
1786 dev_dbg(dev, "%s jack/mic/amp func_status=0x%x, 0x%x, 0x%x\n",
1787 __func__, jack_func_status, mic_func_status, amp_func_status);
1788
1789 /* DMIC */
1790 if ((mic_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1791 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_DMIC2_FU_IT_FLOAT_CTL, 0x1526);
1792 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_DMIC2_FU_CH12_FLOAT_CTL, 0x0304);
1793 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_ADC0A_CS_ADC0B_FU_FLOAT_CTL, 0x1f1e);
1794 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_ADC0B_FU_CH12_FLOAT_CTL, 0x0304);
1795 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_HDA_LEGACY_CONFIG_CTL0, 0x8010);
1796 regmap_write(rt712->regmap,
1797 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT_IT11, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1798 rt712_sdca_index_write(rt712, RT712_ULTRA_SOUND_DET, RT712_ULTRA_SOUND_DETECTOR6, 0x3200);
1799 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1800
1801 /* clear flag */
1802 regmap_write(rt712->regmap,
1803 SDW_SDCA_CTL(FUNC_NUM_MIC_ARRAY, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1804 FUNCTION_NEEDS_INITIALIZATION);
1805 }
1806
1807 /* Jack */
1808 if ((jack_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1809 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_SEL_VEE2_HP_CTL1, 0x042a);
1810 rt712_sdca_index_write(rt712, RT712_CHARGE_PUMP, RT712_HP_DET_CTL3, 0x1fff);
1811 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_IO_CTL, 0xec67);
1812 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_ANALOG_BIAS_CTL3, 0xaa81);
1813 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_LDO2_3_CTL1, 0xa1e0);
1814 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL1, 0x0000);
1815 rt712_sdca_index_write(rt712, RT712_VENDOR_IMS_DRE, RT712_HP_DETECT_RLDET_CTL2, 0x0000);
1816 regmap_write(rt712->regmap, RT712_RC_CAL, 0x23);
1817 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_JD_CTL1, 0x2802);
1818 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CLASSD_AMP_CTL6, 0xf215);
1819
1820 /* calibration */
1821 ret = rt712_sdca_calibration(rt712);
1822 if (ret < 0)
1823 dev_err(dev, "%s, calibration failed!\n", __func__);
1824
1825 rt712_sdca_index_update_bits(rt712, RT712_VENDOR_HDA_CTL, RT712_MIXER_CTL1, 0x3000, 0x0000);
1826 regmap_write(rt712->regmap,
1827 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT_IT09, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x01);
1828 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_MISC_CTL_FOR_UAJ, 0x0003);
1829
1830 /* clear flag */
1831 regmap_write(rt712->regmap,
1832 SDW_SDCA_CTL(FUNC_NUM_JACK_CODEC, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1833 FUNCTION_NEEDS_INITIALIZATION);
1834 }
1835
1836 /* SPK */
1837 if ((amp_func_status & FUNCTION_NEEDS_INITIALIZATION) || (!rt712->first_hw_init)) {
1838 if (rt712->hw_id != RT712_DEV_ID_713) {
1839 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_IO_CTL, 0xec63);
1840 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_CLASSD_AMP_CTL1, 0xfff5);
1841 rt712_sdca_index_write(rt712, RT712_VENDOR_HDA_CTL, RT712_EAPD_CTL, 0x0002);
1842 regmap_write(rt712->regmap,
1843 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT_OT23, RT712_SDCA_CTL_VENDOR_DEF, 0), 0x04);
1844 }
1845 /* clear flag */
1846 regmap_write(rt712->regmap,
1847 SDW_SDCA_CTL(FUNC_NUM_AMP, RT712_SDCA_ENT0, RT712_SDCA_CTL_FUNC_STATUS, 0),
1848 FUNCTION_NEEDS_INITIALIZATION);
1849 }
1850 }
1851
rt712_sdca_io_init(struct device * dev,struct sdw_slave * slave)1852 int rt712_sdca_io_init(struct device *dev, struct sdw_slave *slave)
1853 {
1854 struct rt712_sdca_priv *rt712 = dev_get_drvdata(dev);
1855 unsigned int val;
1856 struct sdw_slave_prop *prop = &slave->prop;
1857
1858 rt712->disable_irq = false;
1859
1860 if (rt712->hw_init)
1861 return 0;
1862
1863 regcache_cache_only(rt712->regmap, false);
1864 regcache_cache_only(rt712->mbq_regmap, false);
1865 if (rt712->first_hw_init) {
1866 regcache_cache_bypass(rt712->regmap, true);
1867 regcache_cache_bypass(rt712->mbq_regmap, true);
1868 } else {
1869 /*
1870 * PM runtime status is marked as 'active' only when a Slave reports as Attached
1871 */
1872
1873 /* update count of parent 'active' children */
1874 pm_runtime_set_active(&slave->dev);
1875 }
1876
1877 pm_runtime_get_noresume(&slave->dev);
1878
1879 rt712_sdca_index_read(rt712, RT712_VENDOR_REG, RT712_JD_PRODUCT_NUM, &val);
1880 rt712->hw_id = (val & 0xf000) >> 12;
1881 rt712->version_id = (val & 0x0f00) >> 8;
1882 dev_dbg(&slave->dev, "%s hw_id=0x%x, version_id=0x%x\n", __func__, rt712->hw_id, rt712->version_id);
1883
1884 if (rt712->version_id == RT712_VA) {
1885 if (rt712->dmic_function_found) {
1886 dev_err(&slave->dev, "%s RT712 VA detected but SMART_MIC function exposed in ACPI\n",
1887 __func__);
1888 goto suspend;
1889 }
1890
1891 rt712_sdca_va_io_init(rt712);
1892 } else {
1893 if (!rt712->dmic_function_found) {
1894 dev_err(&slave->dev, "%s RT712 VB detected but no SMART_MIC function exposed in ACPI\n",
1895 __func__);
1896 goto suspend;
1897 }
1898
1899 /* multilanes and DMIC are supported by rt712vb */
1900 prop->lane_control_support = true;
1901 rt712_sdca_vb_io_init(rt712);
1902 }
1903
1904 /*
1905 * if set_jack callback occurred early than io_init,
1906 * we set up the jack detection function now
1907 */
1908 if (rt712->hs_jack)
1909 rt712_sdca_jack_init(rt712);
1910
1911 rt712_sdca_index_write(rt712, RT712_VENDOR_REG, RT712_SW_CONFIG1, 0x0001);
1912
1913 if (rt712->first_hw_init) {
1914 regcache_cache_bypass(rt712->regmap, false);
1915 regcache_mark_dirty(rt712->regmap);
1916 regcache_cache_bypass(rt712->mbq_regmap, false);
1917 regcache_mark_dirty(rt712->mbq_regmap);
1918 } else
1919 rt712->first_hw_init = true;
1920
1921 /* Mark Slave initialization complete */
1922 rt712->hw_init = true;
1923
1924 dev_dbg(&slave->dev, "%s hw_init complete\n", __func__);
1925
1926 suspend:
1927 pm_runtime_put_autosuspend(&slave->dev);
1928
1929 return 0;
1930 }
1931
1932 MODULE_DESCRIPTION("ASoC RT712 SDCA SDW driver");
1933 MODULE_AUTHOR("Shuming Fan <shumingf@realtek.com>");
1934 MODULE_LICENSE("GPL");
1935