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