1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18#include <linux/module.h>
19#include <linux/moduleparam.h>
20#include <linux/init.h>
21#include <linux/delay.h>
22#include <linux/pm.h>
23#include <linux/regmap.h>
24#include <linux/slab.h>
25#include <sound/core.h>
26#include <sound/pcm.h>
27#include <sound/pcm_params.h>
28#include <sound/soc.h>
29#include <sound/tlv.h>
30#include <sound/initval.h>
31
32#include "tlv320aic23.h"
33
34
35
36
37static const struct reg_default tlv320aic23_reg[] = {
38 { 0, 0x0097 },
39 { 1, 0x0097 },
40 { 2, 0x00F9 },
41 { 3, 0x00F9 },
42 { 4, 0x001A },
43 { 5, 0x0004 },
44 { 6, 0x0007 },
45 { 7, 0x0001 },
46 { 8, 0x0020 },
47 { 9, 0x0000 },
48};
49
50const struct regmap_config tlv320aic23_regmap = {
51 .reg_bits = 7,
52 .val_bits = 9,
53
54 .max_register = TLV320AIC23_RESET,
55 .reg_defaults = tlv320aic23_reg,
56 .num_reg_defaults = ARRAY_SIZE(tlv320aic23_reg),
57 .cache_type = REGCACHE_RBTREE,
58};
59EXPORT_SYMBOL(tlv320aic23_regmap);
60
61static const char *rec_src_text[] = { "Line", "Mic" };
62static const char *deemph_text[] = {"None", "32Khz", "44.1Khz", "48Khz"};
63
64static SOC_ENUM_SINGLE_DECL(rec_src_enum,
65 TLV320AIC23_ANLG, 2, rec_src_text);
66
67static const struct snd_kcontrol_new tlv320aic23_rec_src_mux_controls =
68SOC_DAPM_ENUM("Input Select", rec_src_enum);
69
70static SOC_ENUM_SINGLE_DECL(tlv320aic23_deemph,
71 TLV320AIC23_DIGT, 1, deemph_text);
72
73static const DECLARE_TLV_DB_SCALE(out_gain_tlv, -12100, 100, 0);
74static const DECLARE_TLV_DB_SCALE(input_gain_tlv, -1725, 75, 0);
75static const DECLARE_TLV_DB_SCALE(sidetone_vol_tlv, -1800, 300, 0);
76
77static int snd_soc_tlv320aic23_put_volsw(struct snd_kcontrol *kcontrol,
78 struct snd_ctl_elem_value *ucontrol)
79{
80 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
81 u16 val, reg;
82
83 val = (ucontrol->value.integer.value[0] & 0x07);
84
85
86
87
88
89
90
91
92 val = (val >= 4) ? 4 : (3 - val);
93
94 reg = snd_soc_component_read(component, TLV320AIC23_ANLG) & (~0x1C0);
95 snd_soc_component_write(component, TLV320AIC23_ANLG, reg | (val << 6));
96
97 return 0;
98}
99
100static int snd_soc_tlv320aic23_get_volsw(struct snd_kcontrol *kcontrol,
101 struct snd_ctl_elem_value *ucontrol)
102{
103 struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
104 u16 val;
105
106 val = snd_soc_component_read(component, TLV320AIC23_ANLG) & (0x1C0);
107 val = val >> 6;
108 val = (val >= 4) ? 4 : (3 - val);
109 ucontrol->value.integer.value[0] = val;
110 return 0;
111
112}
113
114static const struct snd_kcontrol_new tlv320aic23_snd_controls[] = {
115 SOC_DOUBLE_R_TLV("Digital Playback Volume", TLV320AIC23_LCHNVOL,
116 TLV320AIC23_RCHNVOL, 0, 127, 0, out_gain_tlv),
117 SOC_SINGLE("Digital Playback Switch", TLV320AIC23_DIGT, 3, 1, 1),
118 SOC_DOUBLE_R("Line Input Switch", TLV320AIC23_LINVOL,
119 TLV320AIC23_RINVOL, 7, 1, 0),
120 SOC_DOUBLE_R_TLV("Line Input Volume", TLV320AIC23_LINVOL,
121 TLV320AIC23_RINVOL, 0, 31, 0, input_gain_tlv),
122 SOC_SINGLE("Mic Input Switch", TLV320AIC23_ANLG, 1, 1, 1),
123 SOC_SINGLE("Mic Booster Switch", TLV320AIC23_ANLG, 0, 1, 0),
124 SOC_SINGLE_EXT_TLV("Sidetone Volume", TLV320AIC23_ANLG, 6, 4, 0,
125 snd_soc_tlv320aic23_get_volsw,
126 snd_soc_tlv320aic23_put_volsw, sidetone_vol_tlv),
127 SOC_ENUM("Playback De-emphasis", tlv320aic23_deemph),
128};
129
130
131static const struct snd_kcontrol_new tlv320aic23_output_mixer_controls[] = {
132 SOC_DAPM_SINGLE("Line Bypass Switch", TLV320AIC23_ANLG, 3, 1, 0),
133 SOC_DAPM_SINGLE("Mic Sidetone Switch", TLV320AIC23_ANLG, 5, 1, 0),
134 SOC_DAPM_SINGLE("Playback Switch", TLV320AIC23_ANLG, 4, 1, 0),
135};
136
137static const struct snd_soc_dapm_widget tlv320aic23_dapm_widgets[] = {
138 SND_SOC_DAPM_DAC("DAC", "Playback", TLV320AIC23_PWR, 3, 1),
139 SND_SOC_DAPM_ADC("ADC", "Capture", TLV320AIC23_PWR, 2, 1),
140 SND_SOC_DAPM_MUX("Capture Source", SND_SOC_NOPM, 0, 0,
141 &tlv320aic23_rec_src_mux_controls),
142 SND_SOC_DAPM_MIXER("Output Mixer", TLV320AIC23_PWR, 4, 1,
143 &tlv320aic23_output_mixer_controls[0],
144 ARRAY_SIZE(tlv320aic23_output_mixer_controls)),
145 SND_SOC_DAPM_PGA("Line Input", TLV320AIC23_PWR, 0, 1, NULL, 0),
146 SND_SOC_DAPM_PGA("Mic Input", TLV320AIC23_PWR, 1, 1, NULL, 0),
147
148 SND_SOC_DAPM_OUTPUT("LHPOUT"),
149 SND_SOC_DAPM_OUTPUT("RHPOUT"),
150 SND_SOC_DAPM_OUTPUT("LOUT"),
151 SND_SOC_DAPM_OUTPUT("ROUT"),
152
153 SND_SOC_DAPM_INPUT("LLINEIN"),
154 SND_SOC_DAPM_INPUT("RLINEIN"),
155
156 SND_SOC_DAPM_INPUT("MICIN"),
157};
158
159static const struct snd_soc_dapm_route tlv320aic23_intercon[] = {
160
161 {"Output Mixer", "Line Bypass Switch", "Line Input"},
162 {"Output Mixer", "Playback Switch", "DAC"},
163 {"Output Mixer", "Mic Sidetone Switch", "Mic Input"},
164
165
166 {"RHPOUT", NULL, "Output Mixer"},
167 {"LHPOUT", NULL, "Output Mixer"},
168 {"LOUT", NULL, "Output Mixer"},
169 {"ROUT", NULL, "Output Mixer"},
170
171
172 {"Line Input", NULL, "LLINEIN"},
173 {"Line Input", NULL, "RLINEIN"},
174 {"Mic Input", NULL, "MICIN"},
175
176
177 {"Capture Source", "Line", "Line Input"},
178 {"Capture Source", "Mic", "Mic Input"},
179 {"ADC", NULL, "Capture Source"},
180
181};
182
183
184struct aic23 {
185 struct regmap *regmap;
186 int mclk;
187 int requested_adc;
188 int requested_dac;
189};
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204static const int bosr_usb_divisor_table[] = {
205 128, 125, 192, 136
206};
207#define LOWER_GROUP ((1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<6) | (1<<7))
208#define UPPER_GROUP ((1<<8) | (1<<9) | (1<<10) | (1<<11) | (1<<15))
209static const unsigned short sr_valid_mask[] = {
210 LOWER_GROUP|UPPER_GROUP,
211 LOWER_GROUP,
212 LOWER_GROUP|UPPER_GROUP,
213 UPPER_GROUP,
214};
215
216
217
218#define SR_MULT (11*12)
219#define A(x) (SR_MULT/x)
220static const unsigned char sr_adc_mult_table[] = {
221 A(2), A(2), A(12), A(12), 0, 0, A(3), A(1),
222 A(2), A(2), A(11), A(11), 0, 0, 0, A(1)
223};
224static const unsigned char sr_dac_mult_table[] = {
225 A(2), A(12), A(2), A(12), 0, 0, A(3), A(1),
226 A(2), A(11), A(2), A(11), 0, 0, 0, A(1)
227};
228
229static unsigned get_score(int adc, int adc_l, int adc_h, int need_adc,
230 int dac, int dac_l, int dac_h, int need_dac)
231{
232 if ((adc >= adc_l) && (adc <= adc_h) &&
233 (dac >= dac_l) && (dac <= dac_h)) {
234 int diff_adc = need_adc - adc;
235 int diff_dac = need_dac - dac;
236 return abs(diff_adc) + abs(diff_dac);
237 }
238 return UINT_MAX;
239}
240
241static int find_rate(int mclk, u32 need_adc, u32 need_dac)
242{
243 int i, j;
244 int best_i = -1;
245 int best_j = -1;
246 int best_div = 0;
247 unsigned best_score = UINT_MAX;
248 int adc_l, adc_h, dac_l, dac_h;
249
250 need_adc *= SR_MULT;
251 need_dac *= SR_MULT;
252
253
254
255 adc_l = need_adc - (need_adc >> 5);
256 adc_h = need_adc + (need_adc >> 5);
257 dac_l = need_dac - (need_dac >> 5);
258 dac_h = need_dac + (need_dac >> 5);
259 for (i = 0; i < ARRAY_SIZE(bosr_usb_divisor_table); i++) {
260 int base = mclk / bosr_usb_divisor_table[i];
261 int mask = sr_valid_mask[i];
262 for (j = 0; j < ARRAY_SIZE(sr_adc_mult_table);
263 j++, mask >>= 1) {
264 int adc;
265 int dac;
266 int score;
267 if ((mask & 1) == 0)
268 continue;
269 adc = base * sr_adc_mult_table[j];
270 dac = base * sr_dac_mult_table[j];
271 score = get_score(adc, adc_l, adc_h, need_adc,
272 dac, dac_l, dac_h, need_dac);
273 if (best_score > score) {
274 best_score = score;
275 best_i = i;
276 best_j = j;
277 best_div = 0;
278 }
279 score = get_score((adc >> 1), adc_l, adc_h, need_adc,
280 (dac >> 1), dac_l, dac_h, need_dac);
281
282 if ((score != UINT_MAX) && (best_score >= score)) {
283 best_score = score;
284 best_i = i;
285 best_j = j;
286 best_div = 1;
287 }
288 }
289 }
290 return (best_j << 2) | best_i | (best_div << TLV320AIC23_CLKIN_SHIFT);
291}
292
293#ifdef DEBUG
294static void get_current_sample_rates(struct snd_soc_component *component, int mclk,
295 u32 *sample_rate_adc, u32 *sample_rate_dac)
296{
297 int src = snd_soc_component_read(component, TLV320AIC23_SRATE);
298 int sr = (src >> 2) & 0x0f;
299 int val = (mclk / bosr_usb_divisor_table[src & 3]);
300 int adc = (val * sr_adc_mult_table[sr]) / SR_MULT;
301 int dac = (val * sr_dac_mult_table[sr]) / SR_MULT;
302 if (src & TLV320AIC23_CLKIN_HALF) {
303 adc >>= 1;
304 dac >>= 1;
305 }
306 *sample_rate_adc = adc;
307 *sample_rate_dac = dac;
308}
309#endif
310
311static int set_sample_rate_control(struct snd_soc_component *component, int mclk,
312 u32 sample_rate_adc, u32 sample_rate_dac)
313{
314
315 int data = find_rate(mclk, sample_rate_adc, sample_rate_dac);
316 if (data < 0) {
317 printk(KERN_ERR "%s:Invalid rate %u,%u requested\n",
318 __func__, sample_rate_adc, sample_rate_dac);
319 return -EINVAL;
320 }
321 snd_soc_component_write(component, TLV320AIC23_SRATE, data);
322#ifdef DEBUG
323 {
324 u32 adc, dac;
325 get_current_sample_rates(component, mclk, &adc, &dac);
326 printk(KERN_DEBUG "actual samplerate = %u,%u reg=%x\n",
327 adc, dac, data);
328 }
329#endif
330 return 0;
331}
332
333static int tlv320aic23_hw_params(struct snd_pcm_substream *substream,
334 struct snd_pcm_hw_params *params,
335 struct snd_soc_dai *dai)
336{
337 struct snd_soc_component *component = dai->component;
338 u16 iface_reg;
339 int ret;
340 struct aic23 *aic23 = snd_soc_component_get_drvdata(component);
341 u32 sample_rate_adc = aic23->requested_adc;
342 u32 sample_rate_dac = aic23->requested_dac;
343 u32 sample_rate = params_rate(params);
344
345 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
346 aic23->requested_dac = sample_rate_dac = sample_rate;
347 if (!sample_rate_adc)
348 sample_rate_adc = sample_rate;
349 } else {
350 aic23->requested_adc = sample_rate_adc = sample_rate;
351 if (!sample_rate_dac)
352 sample_rate_dac = sample_rate;
353 }
354 ret = set_sample_rate_control(component, aic23->mclk, sample_rate_adc,
355 sample_rate_dac);
356 if (ret < 0)
357 return ret;
358
359 iface_reg = snd_soc_component_read(component, TLV320AIC23_DIGT_FMT) & ~(0x03 << 2);
360
361 switch (params_width(params)) {
362 case 16:
363 break;
364 case 20:
365 iface_reg |= (0x01 << 2);
366 break;
367 case 24:
368 iface_reg |= (0x02 << 2);
369 break;
370 case 32:
371 iface_reg |= (0x03 << 2);
372 break;
373 }
374 snd_soc_component_write(component, TLV320AIC23_DIGT_FMT, iface_reg);
375
376 return 0;
377}
378
379static int tlv320aic23_pcm_prepare(struct snd_pcm_substream *substream,
380 struct snd_soc_dai *dai)
381{
382 struct snd_soc_component *component = dai->component;
383
384
385 snd_soc_component_write(component, TLV320AIC23_ACTIVE, 0x0001);
386
387 return 0;
388}
389
390static void tlv320aic23_shutdown(struct snd_pcm_substream *substream,
391 struct snd_soc_dai *dai)
392{
393 struct snd_soc_component *component = dai->component;
394 struct aic23 *aic23 = snd_soc_component_get_drvdata(component);
395
396
397 if (!snd_soc_component_active(component)) {
398 udelay(50);
399 snd_soc_component_write(component, TLV320AIC23_ACTIVE, 0x0);
400 }
401 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
402 aic23->requested_dac = 0;
403 else
404 aic23->requested_adc = 0;
405}
406
407static int tlv320aic23_mute(struct snd_soc_dai *dai, int mute, int direction)
408{
409 struct snd_soc_component *component = dai->component;
410 u16 reg;
411
412 reg = snd_soc_component_read(component, TLV320AIC23_DIGT);
413 if (mute)
414 reg |= TLV320AIC23_DACM_MUTE;
415
416 else
417 reg &= ~TLV320AIC23_DACM_MUTE;
418
419 snd_soc_component_write(component, TLV320AIC23_DIGT, reg);
420
421 return 0;
422}
423
424static int tlv320aic23_set_dai_fmt(struct snd_soc_dai *codec_dai,
425 unsigned int fmt)
426{
427 struct snd_soc_component *component = codec_dai->component;
428 u16 iface_reg;
429
430 iface_reg = snd_soc_component_read(component, TLV320AIC23_DIGT_FMT) & (~0x03);
431
432
433 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
434 case SND_SOC_DAIFMT_CBM_CFM:
435 iface_reg |= TLV320AIC23_MS_MASTER;
436 break;
437 case SND_SOC_DAIFMT_CBS_CFS:
438 iface_reg &= ~TLV320AIC23_MS_MASTER;
439 break;
440 default:
441 return -EINVAL;
442
443 }
444
445
446 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
447 case SND_SOC_DAIFMT_I2S:
448 iface_reg |= TLV320AIC23_FOR_I2S;
449 break;
450 case SND_SOC_DAIFMT_DSP_A:
451 iface_reg |= TLV320AIC23_LRP_ON;
452 fallthrough;
453 case SND_SOC_DAIFMT_DSP_B:
454 iface_reg |= TLV320AIC23_FOR_DSP;
455 break;
456 case SND_SOC_DAIFMT_RIGHT_J:
457 break;
458 case SND_SOC_DAIFMT_LEFT_J:
459 iface_reg |= TLV320AIC23_FOR_LJUST;
460 break;
461 default:
462 return -EINVAL;
463
464 }
465
466 snd_soc_component_write(component, TLV320AIC23_DIGT_FMT, iface_reg);
467
468 return 0;
469}
470
471static int tlv320aic23_set_dai_sysclk(struct snd_soc_dai *codec_dai,
472 int clk_id, unsigned int freq, int dir)
473{
474 struct aic23 *aic23 = snd_soc_dai_get_drvdata(codec_dai);
475 aic23->mclk = freq;
476 return 0;
477}
478
479static int tlv320aic23_set_bias_level(struct snd_soc_component *component,
480 enum snd_soc_bias_level level)
481{
482 u16 reg = snd_soc_component_read(component, TLV320AIC23_PWR) & 0x17f;
483
484 switch (level) {
485 case SND_SOC_BIAS_ON:
486
487 reg &= ~(TLV320AIC23_DEVICE_PWR_OFF | TLV320AIC23_OSC_OFF | \
488 TLV320AIC23_DAC_OFF);
489 snd_soc_component_write(component, TLV320AIC23_PWR, reg);
490 break;
491 case SND_SOC_BIAS_PREPARE:
492 break;
493 case SND_SOC_BIAS_STANDBY:
494
495 snd_soc_component_write(component, TLV320AIC23_PWR,
496 reg | TLV320AIC23_CLK_OFF);
497 break;
498 case SND_SOC_BIAS_OFF:
499
500 snd_soc_component_write(component, TLV320AIC23_ACTIVE, 0x0);
501 snd_soc_component_write(component, TLV320AIC23_PWR, 0x1ff);
502 break;
503 }
504 return 0;
505}
506
507#define AIC23_RATES SNDRV_PCM_RATE_8000_96000
508#define AIC23_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
509 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
510
511static const struct snd_soc_dai_ops tlv320aic23_dai_ops = {
512 .prepare = tlv320aic23_pcm_prepare,
513 .hw_params = tlv320aic23_hw_params,
514 .shutdown = tlv320aic23_shutdown,
515 .mute_stream = tlv320aic23_mute,
516 .set_fmt = tlv320aic23_set_dai_fmt,
517 .set_sysclk = tlv320aic23_set_dai_sysclk,
518 .no_capture_mute = 1,
519};
520
521static struct snd_soc_dai_driver tlv320aic23_dai = {
522 .name = "tlv320aic23-hifi",
523 .playback = {
524 .stream_name = "Playback",
525 .channels_min = 2,
526 .channels_max = 2,
527 .rates = AIC23_RATES,
528 .formats = AIC23_FORMATS,},
529 .capture = {
530 .stream_name = "Capture",
531 .channels_min = 2,
532 .channels_max = 2,
533 .rates = AIC23_RATES,
534 .formats = AIC23_FORMATS,},
535 .ops = &tlv320aic23_dai_ops,
536};
537
538static int tlv320aic23_resume(struct snd_soc_component *component)
539{
540 struct aic23 *aic23 = snd_soc_component_get_drvdata(component);
541 regcache_mark_dirty(aic23->regmap);
542 regcache_sync(aic23->regmap);
543
544 return 0;
545}
546
547static int tlv320aic23_component_probe(struct snd_soc_component *component)
548{
549
550 snd_soc_component_write(component, TLV320AIC23_RESET, 0);
551
552 snd_soc_component_write(component, TLV320AIC23_DIGT, TLV320AIC23_DEEMP_44K);
553
554
555 snd_soc_component_update_bits(component, TLV320AIC23_LINVOL,
556 TLV320AIC23_LIM_MUTED, TLV320AIC23_LRS_ENABLED);
557
558 snd_soc_component_update_bits(component, TLV320AIC23_RINVOL,
559 TLV320AIC23_LIM_MUTED, TLV320AIC23_LRS_ENABLED);
560
561 snd_soc_component_update_bits(component, TLV320AIC23_ANLG,
562 TLV320AIC23_BYPASS_ON | TLV320AIC23_MICM_MUTED,
563 0);
564
565
566 snd_soc_component_write(component, TLV320AIC23_LCHNVOL,
567 TLV320AIC23_DEFAULT_OUT_VOL & TLV320AIC23_OUT_VOL_MASK);
568 snd_soc_component_write(component, TLV320AIC23_RCHNVOL,
569 TLV320AIC23_DEFAULT_OUT_VOL & TLV320AIC23_OUT_VOL_MASK);
570
571 snd_soc_component_write(component, TLV320AIC23_ACTIVE, 0x1);
572
573 return 0;
574}
575
576static const struct snd_soc_component_driver soc_component_dev_tlv320aic23 = {
577 .probe = tlv320aic23_component_probe,
578 .resume = tlv320aic23_resume,
579 .set_bias_level = tlv320aic23_set_bias_level,
580 .controls = tlv320aic23_snd_controls,
581 .num_controls = ARRAY_SIZE(tlv320aic23_snd_controls),
582 .dapm_widgets = tlv320aic23_dapm_widgets,
583 .num_dapm_widgets = ARRAY_SIZE(tlv320aic23_dapm_widgets),
584 .dapm_routes = tlv320aic23_intercon,
585 .num_dapm_routes = ARRAY_SIZE(tlv320aic23_intercon),
586 .suspend_bias_off = 1,
587 .idle_bias_on = 1,
588 .use_pmdown_time = 1,
589 .endianness = 1,
590 .non_legacy_dai_naming = 1,
591};
592
593int tlv320aic23_probe(struct device *dev, struct regmap *regmap)
594{
595 struct aic23 *aic23;
596
597 if (IS_ERR(regmap))
598 return PTR_ERR(regmap);
599
600 aic23 = devm_kzalloc(dev, sizeof(struct aic23), GFP_KERNEL);
601 if (aic23 == NULL)
602 return -ENOMEM;
603
604 aic23->regmap = regmap;
605
606 dev_set_drvdata(dev, aic23);
607
608 return devm_snd_soc_register_component(dev,
609 &soc_component_dev_tlv320aic23,
610 &tlv320aic23_dai, 1);
611}
612EXPORT_SYMBOL(tlv320aic23_probe);
613
614MODULE_DESCRIPTION("ASoC TLV320AIC23 codec driver");
615MODULE_AUTHOR("Arun KS <arunks@mistralsolutions.com>");
616MODULE_LICENSE("GPL");
617
