xref: /openbmc/linux/sound/soc/codecs/tlv320aic23.c (revision 8d702f23)
1 /*
2  * ALSA SoC TLV320AIC23 codec driver
3  *
4  * Author:      Arun KS, <arunks@mistralsolutions.com>
5  * Copyright:   (C) 2008 Mistral Solutions Pvt Ltd.,
6  *
7  * Based on sound/soc/codecs/wm8731.c by Richard Purdie
8  *
9  * This program is free software; you can redistribute it and/or modify
10  * it under the terms of the GNU General Public License version 2 as
11  * published by the Free Software Foundation.
12  *
13  * Notes:
14  *  The AIC23 is a driver for a low power stereo audio
15  *  codec tlv320aic23
16  *
17  *  The machine layer should disable unsupported inputs/outputs by
18  *  snd_soc_dapm_disable_pin(codec, "LHPOUT"), etc.
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/i2c.h>
27 #include <linux/platform_device.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/soc-dapm.h>
33 #include <sound/tlv.h>
34 #include <sound/initval.h>
35 
36 #include "tlv320aic23.h"
37 
38 #define AIC23_VERSION "0.1"
39 
40 /*
41  * AIC23 register cache
42  */
43 static const u16 tlv320aic23_reg[] = {
44 	0x0097, 0x0097, 0x00F9, 0x00F9,	/* 0 */
45 	0x001A, 0x0004, 0x0007, 0x0001,	/* 4 */
46 	0x0020, 0x0000, 0x0000, 0x0000,	/* 8 */
47 	0x0000, 0x0000, 0x0000, 0x0000,	/* 12 */
48 };
49 
50 /*
51  * read tlv320aic23 register cache
52  */
53 static inline unsigned int tlv320aic23_read_reg_cache(struct snd_soc_codec
54 						      *codec, unsigned int reg)
55 {
56 	u16 *cache = codec->reg_cache;
57 	if (reg >= ARRAY_SIZE(tlv320aic23_reg))
58 		return -1;
59 	return cache[reg];
60 }
61 
62 /*
63  * write tlv320aic23 register cache
64  */
65 static inline void tlv320aic23_write_reg_cache(struct snd_soc_codec *codec,
66 					       u8 reg, u16 value)
67 {
68 	u16 *cache = codec->reg_cache;
69 	if (reg >= ARRAY_SIZE(tlv320aic23_reg))
70 		return;
71 	cache[reg] = value;
72 }
73 
74 /*
75  * write to the tlv320aic23 register space
76  */
77 static int tlv320aic23_write(struct snd_soc_codec *codec, unsigned int reg,
78 			     unsigned int value)
79 {
80 
81 	u8 data[2];
82 
83 	/* TLV320AIC23 has 7 bit address and 9 bits of data
84 	 * so we need to switch one data bit into reg and rest
85 	 * of data into val
86 	 */
87 
88 	if ((reg < 0 || reg > 9) && (reg != 15)) {
89 		printk(KERN_WARNING "%s Invalid register R%d\n", __func__, reg);
90 		return -1;
91 	}
92 
93 	data[0] = (reg << 1) | (value >> 8 & 0x01);
94 	data[1] = value & 0xff;
95 
96 	tlv320aic23_write_reg_cache(codec, reg, value);
97 
98 	if (codec->hw_write(codec->control_data, data, 2) == 2)
99 		return 0;
100 
101 	printk(KERN_ERR "%s cannot write %03x to register R%d\n", __func__,
102 	       value, reg);
103 
104 	return -EIO;
105 }
106 
107 static const char *rec_src_text[] = { "Line", "Mic" };
108 static const char *deemph_text[] = {"None", "32Khz", "44.1Khz", "48Khz"};
109 
110 static const struct soc_enum rec_src_enum =
111 	SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
112 
113 static const struct snd_kcontrol_new tlv320aic23_rec_src_mux_controls =
114 SOC_DAPM_ENUM("Input Select", rec_src_enum);
115 
116 static const struct soc_enum tlv320aic23_rec_src =
117 	SOC_ENUM_SINGLE(TLV320AIC23_ANLG, 2, 2, rec_src_text);
118 static const struct soc_enum tlv320aic23_deemph =
119 	SOC_ENUM_SINGLE(TLV320AIC23_DIGT, 1, 4, deemph_text);
120 
121 static const DECLARE_TLV_DB_SCALE(out_gain_tlv, -12100, 100, 0);
122 static const DECLARE_TLV_DB_SCALE(input_gain_tlv, -1725, 75, 0);
123 static const DECLARE_TLV_DB_SCALE(sidetone_vol_tlv, -1800, 300, 0);
124 
125 static int snd_soc_tlv320aic23_put_volsw(struct snd_kcontrol *kcontrol,
126 	struct snd_ctl_elem_value *ucontrol)
127 {
128 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
129 	u16 val, reg;
130 
131 	val = (ucontrol->value.integer.value[0] & 0x07);
132 
133 	/* linear conversion to userspace
134 	* 000	=	-6db
135 	* 001	=	-9db
136 	* 010	=	-12db
137 	* 011	=	-18db (Min)
138 	* 100	=	0db (Max)
139 	*/
140 	val = (val >= 4) ? 4  : (3 - val);
141 
142 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (~0x1C0);
143 	tlv320aic23_write(codec, TLV320AIC23_ANLG, reg | (val << 6));
144 
145 	return 0;
146 }
147 
148 static int snd_soc_tlv320aic23_get_volsw(struct snd_kcontrol *kcontrol,
149 	struct snd_ctl_elem_value *ucontrol)
150 {
151 	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
152 	u16 val;
153 
154 	val = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG) & (0x1C0);
155 	val = val >> 6;
156 	val = (val >= 4) ? 4  : (3 -  val);
157 	ucontrol->value.integer.value[0] = val;
158 	return 0;
159 
160 }
161 
162 #define SOC_TLV320AIC23_SINGLE_TLV(xname, reg, shift, max, invert, tlv_array) \
163 {	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
164 	.access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
165 		 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
166 	.tlv.p = (tlv_array), \
167 	.info = snd_soc_info_volsw, .get = snd_soc_tlv320aic23_get_volsw,\
168 	.put = snd_soc_tlv320aic23_put_volsw, \
169 	.private_value =  SOC_SINGLE_VALUE(reg, shift, max, invert) }
170 
171 static const struct snd_kcontrol_new tlv320aic23_snd_controls[] = {
172 	SOC_DOUBLE_R_TLV("Digital Playback Volume", TLV320AIC23_LCHNVOL,
173 			 TLV320AIC23_RCHNVOL, 0, 127, 0, out_gain_tlv),
174 	SOC_SINGLE("Digital Playback Switch", TLV320AIC23_DIGT, 3, 1, 1),
175 	SOC_DOUBLE_R("Line Input Switch", TLV320AIC23_LINVOL,
176 		     TLV320AIC23_RINVOL, 7, 1, 0),
177 	SOC_DOUBLE_R_TLV("Line Input Volume", TLV320AIC23_LINVOL,
178 			 TLV320AIC23_RINVOL, 0, 31, 0, input_gain_tlv),
179 	SOC_SINGLE("Mic Input Switch", TLV320AIC23_ANLG, 1, 1, 1),
180 	SOC_SINGLE("Mic Booster Switch", TLV320AIC23_ANLG, 0, 1, 0),
181 	SOC_TLV320AIC23_SINGLE_TLV("Sidetone Volume", TLV320AIC23_ANLG,
182 				  6, 4, 0, sidetone_vol_tlv),
183 	SOC_ENUM("Playback De-emphasis", tlv320aic23_deemph),
184 };
185 
186 /* add non dapm controls */
187 static int tlv320aic23_add_controls(struct snd_soc_codec *codec)
188 {
189 
190 	int err, i;
191 
192 	for (i = 0; i < ARRAY_SIZE(tlv320aic23_snd_controls); i++) {
193 		err = snd_ctl_add(codec->card,
194 				  snd_soc_cnew(&tlv320aic23_snd_controls[i],
195 					       codec, NULL));
196 		if (err < 0)
197 			return err;
198 	}
199 
200 	return 0;
201 
202 }
203 
204 /* PGA Mixer controls for Line and Mic switch */
205 static const struct snd_kcontrol_new tlv320aic23_output_mixer_controls[] = {
206 	SOC_DAPM_SINGLE("Line Bypass Switch", TLV320AIC23_ANLG, 3, 1, 0),
207 	SOC_DAPM_SINGLE("Mic Sidetone Switch", TLV320AIC23_ANLG, 5, 1, 0),
208 	SOC_DAPM_SINGLE("Playback Switch", TLV320AIC23_ANLG, 4, 1, 0),
209 };
210 
211 static const struct snd_soc_dapm_widget tlv320aic23_dapm_widgets[] = {
212 	SND_SOC_DAPM_DAC("DAC", "Playback", TLV320AIC23_PWR, 3, 1),
213 	SND_SOC_DAPM_ADC("ADC", "Capture", TLV320AIC23_PWR, 2, 1),
214 	SND_SOC_DAPM_MUX("Capture Source", SND_SOC_NOPM, 0, 0,
215 			 &tlv320aic23_rec_src_mux_controls),
216 	SND_SOC_DAPM_MIXER("Output Mixer", TLV320AIC23_PWR, 4, 1,
217 			   &tlv320aic23_output_mixer_controls[0],
218 			   ARRAY_SIZE(tlv320aic23_output_mixer_controls)),
219 	SND_SOC_DAPM_PGA("Line Input", TLV320AIC23_PWR, 0, 1, NULL, 0),
220 	SND_SOC_DAPM_PGA("Mic Input", TLV320AIC23_PWR, 1, 1, NULL, 0),
221 
222 	SND_SOC_DAPM_OUTPUT("LHPOUT"),
223 	SND_SOC_DAPM_OUTPUT("RHPOUT"),
224 	SND_SOC_DAPM_OUTPUT("LOUT"),
225 	SND_SOC_DAPM_OUTPUT("ROUT"),
226 
227 	SND_SOC_DAPM_INPUT("LLINEIN"),
228 	SND_SOC_DAPM_INPUT("RLINEIN"),
229 
230 	SND_SOC_DAPM_INPUT("MICIN"),
231 };
232 
233 static const struct snd_soc_dapm_route intercon[] = {
234 	/* Output Mixer */
235 	{"Output Mixer", "Line Bypass Switch", "Line Input"},
236 	{"Output Mixer", "Playback Switch", "DAC"},
237 	{"Output Mixer", "Mic Sidetone Switch", "Mic Input"},
238 
239 	/* Outputs */
240 	{"RHPOUT", NULL, "Output Mixer"},
241 	{"LHPOUT", NULL, "Output Mixer"},
242 	{"LOUT", NULL, "Output Mixer"},
243 	{"ROUT", NULL, "Output Mixer"},
244 
245 	/* Inputs */
246 	{"Line Input", "NULL", "LLINEIN"},
247 	{"Line Input", "NULL", "RLINEIN"},
248 
249 	{"Mic Input", "NULL", "MICIN"},
250 
251 	/* input mux */
252 	{"Capture Source", "Line", "Line Input"},
253 	{"Capture Source", "Mic", "Mic Input"},
254 	{"ADC", NULL, "Capture Source"},
255 
256 };
257 
258 /* AIC23 driver data */
259 struct aic23 {
260 	struct snd_soc_codec codec;
261 	int mclk;
262 	int requested_adc;
263 	int requested_dac;
264 };
265 
266 /*
267  * Common Crystals used
268  * 11.2896 Mhz /128 = *88.2k  /192 = 58.8k
269  * 12.0000 Mhz /125 = *96k    /136 = 88.235K
270  * 12.2880 Mhz /128 = *96k    /192 = 64k
271  * 16.9344 Mhz /128 = 132.3k /192 = *88.2k
272  * 18.4320 Mhz /128 = 144k   /192 = *96k
273  */
274 
275 /*
276  * Normal BOSR 0-256/2 = 128, 1-384/2 = 192
277  * USB BOSR 0-250/2 = 125, 1-272/2 = 136
278  */
279 static const int bosr_usb_divisor_table[] = {
280 	128, 125, 192, 136
281 };
282 #define LOWER_GROUP ((1<<0) | (1<<1) | (1<<2) | (1<<3) | (1<<6) | (1<<7))
283 #define UPPER_GROUP ((1<<8) | (1<<9) | (1<<10) | (1<<11)        | (1<<15))
284 static const unsigned short sr_valid_mask[] = {
285 	LOWER_GROUP|UPPER_GROUP,	/* Normal, bosr - 0*/
286 	LOWER_GROUP|UPPER_GROUP,	/* Normal, bosr - 1*/
287 	LOWER_GROUP,			/* Usb, bosr - 0*/
288 	UPPER_GROUP,			/* Usb, bosr - 1*/
289 };
290 /*
291  * Every divisor is a factor of 11*12
292  */
293 #define SR_MULT (11*12)
294 #define A(x) (x) ? (SR_MULT/x) : 0
295 static const unsigned char sr_adc_mult_table[] = {
296 	A(2), A(2), A(12), A(12),  A(0), A(0), A(3), A(1),
297 	A(2), A(2), A(11), A(11),  A(0), A(0), A(0), A(1)
298 };
299 static const unsigned char sr_dac_mult_table[] = {
300 	A(2), A(12), A(2), A(12),  A(0), A(0), A(3), A(1),
301 	A(2), A(11), A(2), A(11),  A(0), A(0), A(0), A(1)
302 };
303 
304 static unsigned get_score(int adc, int adc_l, int adc_h, int need_adc,
305 		int dac, int dac_l, int dac_h, int need_dac)
306 {
307 	if ((adc >= adc_l) && (adc <= adc_h) &&
308 			(dac >= dac_l) && (dac <= dac_h)) {
309 		int diff_adc = need_adc - adc;
310 		int diff_dac = need_dac - dac;
311 		return abs(diff_adc) + abs(diff_dac);
312 	}
313 	return UINT_MAX;
314 }
315 
316 static int find_rate(int mclk, u32 need_adc, u32 need_dac)
317 {
318 	int i, j;
319 	int best_i = -1;
320 	int best_j = -1;
321 	int best_div = 0;
322 	unsigned best_score = UINT_MAX;
323 	int adc_l, adc_h, dac_l, dac_h;
324 
325 	need_adc *= SR_MULT;
326 	need_dac *= SR_MULT;
327 	/*
328 	 * rates given are +/- 1/32
329 	 */
330 	adc_l = need_adc - (need_adc >> 5);
331 	adc_h = need_adc + (need_adc >> 5);
332 	dac_l = need_dac - (need_dac >> 5);
333 	dac_h = need_dac + (need_dac >> 5);
334 	for (i = 0; i < ARRAY_SIZE(bosr_usb_divisor_table); i++) {
335 		int base = mclk / bosr_usb_divisor_table[i];
336 		int mask = sr_valid_mask[i];
337 		for (j = 0; j < ARRAY_SIZE(sr_adc_mult_table);
338 				j++, mask >>= 1) {
339 			int adc;
340 			int dac;
341 			int score;
342 			if ((mask & 1) == 0)
343 				continue;
344 			adc = base * sr_adc_mult_table[j];
345 			dac = base * sr_dac_mult_table[j];
346 			score = get_score(adc, adc_l, adc_h, need_adc,
347 					dac, dac_l, dac_h, need_dac);
348 			if (best_score > score) {
349 				best_score = score;
350 				best_i = i;
351 				best_j = j;
352 				best_div = 0;
353 			}
354 			score = get_score((adc >> 1), adc_l, adc_h, need_adc,
355 					(dac >> 1), dac_l, dac_h, need_dac);
356 			/* prefer to have a /2 */
357 			if ((score != UINT_MAX) && (best_score >= score)) {
358 				best_score = score;
359 				best_i = i;
360 				best_j = j;
361 				best_div = 1;
362 			}
363 		}
364 	}
365 	return (best_j << 2) | best_i | (best_div << TLV320AIC23_CLKIN_SHIFT);
366 }
367 
368 #ifdef DEBUG
369 static void get_current_sample_rates(struct snd_soc_codec *codec, int mclk,
370 		u32 *sample_rate_adc, u32 *sample_rate_dac)
371 {
372 	int src = tlv320aic23_read_reg_cache(codec, TLV320AIC23_SRATE);
373 	int sr = (src >> 2) & 0x0f;
374 	int val = (mclk / bosr_usb_divisor_table[src & 3]);
375 	int adc = (val * sr_adc_mult_table[sr]) / SR_MULT;
376 	int dac = (val * sr_dac_mult_table[sr]) / SR_MULT;
377 	if (src & TLV320AIC23_CLKIN_HALF) {
378 		adc >>= 1;
379 		dac >>= 1;
380 	}
381 	*sample_rate_adc = adc;
382 	*sample_rate_dac = dac;
383 }
384 #endif
385 
386 static int set_sample_rate_control(struct snd_soc_codec *codec, int mclk,
387 		u32 sample_rate_adc, u32 sample_rate_dac)
388 {
389 	/* Search for the right sample rate */
390 	int data = find_rate(mclk, sample_rate_adc, sample_rate_dac);
391 	if (data < 0) {
392 		printk(KERN_ERR "%s:Invalid rate %u,%u requested\n",
393 				__func__, sample_rate_adc, sample_rate_dac);
394 		return -EINVAL;
395 	}
396 	tlv320aic23_write(codec, TLV320AIC23_SRATE, data);
397 #ifdef DEBUG
398 	{
399 		u32 adc, dac;
400 		get_current_sample_rates(codec, mclk, &adc, &dac);
401 		printk(KERN_DEBUG "actual samplerate = %u,%u reg=%x\n",
402 			adc, dac, data);
403 	}
404 #endif
405 	return 0;
406 }
407 
408 static int tlv320aic23_add_widgets(struct snd_soc_codec *codec)
409 {
410 	snd_soc_dapm_new_controls(codec, tlv320aic23_dapm_widgets,
411 				  ARRAY_SIZE(tlv320aic23_dapm_widgets));
412 
413 	/* set up audio path interconnects */
414 	snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
415 
416 	snd_soc_dapm_new_widgets(codec);
417 	return 0;
418 }
419 
420 static int tlv320aic23_hw_params(struct snd_pcm_substream *substream,
421 				 struct snd_pcm_hw_params *params)
422 {
423 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
424 	struct snd_soc_device *socdev = rtd->socdev;
425 	struct snd_soc_codec *codec = socdev->codec;
426 	u16 iface_reg;
427 	int ret;
428 	struct aic23 *aic23 = container_of(codec, struct aic23, codec);
429 	u32 sample_rate_adc = aic23->requested_adc;
430 	u32 sample_rate_dac = aic23->requested_dac;
431 	u32 sample_rate = params_rate(params);
432 
433 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
434 		aic23->requested_dac = sample_rate_dac = sample_rate;
435 		if (!sample_rate_adc)
436 			sample_rate_adc = sample_rate;
437 	} else {
438 		aic23->requested_adc = sample_rate_adc = sample_rate;
439 		if (!sample_rate_dac)
440 			sample_rate_dac = sample_rate;
441 	}
442 	ret = set_sample_rate_control(codec, aic23->mclk, sample_rate_adc,
443 			sample_rate_dac);
444 	if (ret < 0)
445 		return ret;
446 
447 	iface_reg =
448 	    tlv320aic23_read_reg_cache(codec,
449 				       TLV320AIC23_DIGT_FMT) & ~(0x03 << 2);
450 	switch (params_format(params)) {
451 	case SNDRV_PCM_FORMAT_S16_LE:
452 		break;
453 	case SNDRV_PCM_FORMAT_S20_3LE:
454 		iface_reg |= (0x01 << 2);
455 		break;
456 	case SNDRV_PCM_FORMAT_S24_LE:
457 		iface_reg |= (0x02 << 2);
458 		break;
459 	case SNDRV_PCM_FORMAT_S32_LE:
460 		iface_reg |= (0x03 << 2);
461 		break;
462 	}
463 	tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
464 
465 	return 0;
466 }
467 
468 static int tlv320aic23_pcm_prepare(struct snd_pcm_substream *substream)
469 {
470 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
471 	struct snd_soc_device *socdev = rtd->socdev;
472 	struct snd_soc_codec *codec = socdev->codec;
473 
474 	/* set active */
475 	tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0001);
476 
477 	return 0;
478 }
479 
480 static void tlv320aic23_shutdown(struct snd_pcm_substream *substream)
481 {
482 	struct snd_soc_pcm_runtime *rtd = substream->private_data;
483 	struct snd_soc_device *socdev = rtd->socdev;
484 	struct snd_soc_codec *codec = socdev->codec;
485 	struct aic23 *aic23 = container_of(codec, struct aic23, codec);
486 
487 	/* deactivate */
488 	if (!codec->active) {
489 		udelay(50);
490 		tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
491 	}
492 	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
493 		aic23->requested_dac = 0;
494 	else
495 		aic23->requested_adc = 0;
496 }
497 
498 static int tlv320aic23_mute(struct snd_soc_dai *dai, int mute)
499 {
500 	struct snd_soc_codec *codec = dai->codec;
501 	u16 reg;
502 
503 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT);
504 	if (mute)
505 		reg |= TLV320AIC23_DACM_MUTE;
506 
507 	else
508 		reg &= ~TLV320AIC23_DACM_MUTE;
509 
510 	tlv320aic23_write(codec, TLV320AIC23_DIGT, reg);
511 
512 	return 0;
513 }
514 
515 static int tlv320aic23_set_dai_fmt(struct snd_soc_dai *codec_dai,
516 				   unsigned int fmt)
517 {
518 	struct snd_soc_codec *codec = codec_dai->codec;
519 	u16 iface_reg;
520 
521 	iface_reg =
522 	    tlv320aic23_read_reg_cache(codec, TLV320AIC23_DIGT_FMT) & (~0x03);
523 
524 	/* set master/slave audio interface */
525 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
526 	case SND_SOC_DAIFMT_CBM_CFM:
527 		iface_reg |= TLV320AIC23_MS_MASTER;
528 		break;
529 	case SND_SOC_DAIFMT_CBS_CFS:
530 		break;
531 	default:
532 		return -EINVAL;
533 
534 	}
535 
536 	/* interface format */
537 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
538 	case SND_SOC_DAIFMT_I2S:
539 		iface_reg |= TLV320AIC23_FOR_I2S;
540 		break;
541 	case SND_SOC_DAIFMT_DSP_A:
542 		iface_reg |= TLV320AIC23_FOR_DSP;
543 		break;
544 	case SND_SOC_DAIFMT_RIGHT_J:
545 		break;
546 	case SND_SOC_DAIFMT_LEFT_J:
547 		iface_reg |= TLV320AIC23_FOR_LJUST;
548 		break;
549 	default:
550 		return -EINVAL;
551 
552 	}
553 
554 	tlv320aic23_write(codec, TLV320AIC23_DIGT_FMT, iface_reg);
555 
556 	return 0;
557 }
558 
559 static int tlv320aic23_set_dai_sysclk(struct snd_soc_dai *codec_dai,
560 				      int clk_id, unsigned int freq, int dir)
561 {
562 	struct snd_soc_codec *codec = codec_dai->codec;
563 	struct aic23 *aic23 = container_of(codec, struct aic23, codec);
564 	aic23->mclk = freq;
565 	return 0;
566 }
567 
568 static int tlv320aic23_set_bias_level(struct snd_soc_codec *codec,
569 				      enum snd_soc_bias_level level)
570 {
571 	u16 reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_PWR) & 0xff7f;
572 
573 	switch (level) {
574 	case SND_SOC_BIAS_ON:
575 		/* vref/mid, osc on, dac unmute */
576 		tlv320aic23_write(codec, TLV320AIC23_PWR, reg);
577 		break;
578 	case SND_SOC_BIAS_PREPARE:
579 		break;
580 	case SND_SOC_BIAS_STANDBY:
581 		/* everything off except vref/vmid, */
582 		tlv320aic23_write(codec, TLV320AIC23_PWR, reg | 0x0040);
583 		break;
584 	case SND_SOC_BIAS_OFF:
585 		/* everything off, dac mute, inactive */
586 		tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
587 		tlv320aic23_write(codec, TLV320AIC23_PWR, 0xffff);
588 		break;
589 	}
590 	codec->bias_level = level;
591 	return 0;
592 }
593 
594 #define AIC23_RATES	SNDRV_PCM_RATE_8000_96000
595 #define AIC23_FORMATS	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
596 			 SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
597 
598 struct snd_soc_dai tlv320aic23_dai = {
599 	.name = "tlv320aic23",
600 	.playback = {
601 		     .stream_name = "Playback",
602 		     .channels_min = 2,
603 		     .channels_max = 2,
604 		     .rates = AIC23_RATES,
605 		     .formats = AIC23_FORMATS,},
606 	.capture = {
607 		    .stream_name = "Capture",
608 		    .channels_min = 2,
609 		    .channels_max = 2,
610 		    .rates = AIC23_RATES,
611 		    .formats = AIC23_FORMATS,},
612 	.ops = {
613 		.prepare = tlv320aic23_pcm_prepare,
614 		.hw_params = tlv320aic23_hw_params,
615 		.shutdown = tlv320aic23_shutdown,
616 		},
617 	.dai_ops = {
618 		    .digital_mute = tlv320aic23_mute,
619 		    .set_fmt = tlv320aic23_set_dai_fmt,
620 		    .set_sysclk = tlv320aic23_set_dai_sysclk,
621 		    }
622 };
623 EXPORT_SYMBOL_GPL(tlv320aic23_dai);
624 
625 static int tlv320aic23_suspend(struct platform_device *pdev,
626 			       pm_message_t state)
627 {
628 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
629 	struct snd_soc_codec *codec = socdev->codec;
630 
631 	tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x0);
632 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
633 
634 	return 0;
635 }
636 
637 static int tlv320aic23_resume(struct platform_device *pdev)
638 {
639 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
640 	struct snd_soc_codec *codec = socdev->codec;
641 	int i;
642 	u16 reg;
643 
644 	/* Sync reg_cache with the hardware */
645 	for (reg = 0; reg < ARRAY_SIZE(tlv320aic23_reg); i++) {
646 		u16 val = tlv320aic23_read_reg_cache(codec, reg);
647 		tlv320aic23_write(codec, reg, val);
648 	}
649 
650 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
651 	tlv320aic23_set_bias_level(codec, codec->suspend_bias_level);
652 
653 	return 0;
654 }
655 
656 /*
657  * initialise the AIC23 driver
658  * register the mixer and dsp interfaces with the kernel
659  */
660 static int tlv320aic23_init(struct snd_soc_device *socdev)
661 {
662 	struct snd_soc_codec *codec = socdev->codec;
663 	int ret = 0;
664 	u16 reg;
665 
666 	codec->name = "tlv320aic23";
667 	codec->owner = THIS_MODULE;
668 	codec->read = tlv320aic23_read_reg_cache;
669 	codec->write = tlv320aic23_write;
670 	codec->set_bias_level = tlv320aic23_set_bias_level;
671 	codec->dai = &tlv320aic23_dai;
672 	codec->num_dai = 1;
673 	codec->reg_cache_size = ARRAY_SIZE(tlv320aic23_reg);
674 	codec->reg_cache =
675 	    kmemdup(tlv320aic23_reg, sizeof(tlv320aic23_reg), GFP_KERNEL);
676 	if (codec->reg_cache == NULL)
677 		return -ENOMEM;
678 
679 	/* Reset codec */
680 	tlv320aic23_write(codec, TLV320AIC23_RESET, 0);
681 
682 	/* register pcms */
683 	ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
684 	if (ret < 0) {
685 		printk(KERN_ERR "tlv320aic23: failed to create pcms\n");
686 		goto pcm_err;
687 	}
688 
689 	/* power on device */
690 	tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
691 
692 	tlv320aic23_write(codec, TLV320AIC23_DIGT, TLV320AIC23_DEEMP_44K);
693 
694 	/* Unmute input */
695 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_LINVOL);
696 	tlv320aic23_write(codec, TLV320AIC23_LINVOL,
697 			  (reg & (~TLV320AIC23_LIM_MUTED)) |
698 			  (TLV320AIC23_LRS_ENABLED));
699 
700 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_RINVOL);
701 	tlv320aic23_write(codec, TLV320AIC23_RINVOL,
702 			  (reg & (~TLV320AIC23_LIM_MUTED)) |
703 			  TLV320AIC23_LRS_ENABLED);
704 
705 	reg = tlv320aic23_read_reg_cache(codec, TLV320AIC23_ANLG);
706 	tlv320aic23_write(codec, TLV320AIC23_ANLG,
707 			 (reg) & (~TLV320AIC23_BYPASS_ON) &
708 			 (~TLV320AIC23_MICM_MUTED));
709 
710 	/* Default output volume */
711 	tlv320aic23_write(codec, TLV320AIC23_LCHNVOL,
712 			  TLV320AIC23_DEFAULT_OUT_VOL &
713 			  TLV320AIC23_OUT_VOL_MASK);
714 	tlv320aic23_write(codec, TLV320AIC23_RCHNVOL,
715 			  TLV320AIC23_DEFAULT_OUT_VOL &
716 			  TLV320AIC23_OUT_VOL_MASK);
717 
718 	tlv320aic23_write(codec, TLV320AIC23_ACTIVE, 0x1);
719 
720 	tlv320aic23_add_controls(codec);
721 	tlv320aic23_add_widgets(codec);
722 	ret = snd_soc_register_card(socdev);
723 	if (ret < 0) {
724 		printk(KERN_ERR "tlv320aic23: failed to register card\n");
725 		goto card_err;
726 	}
727 
728 	return ret;
729 
730 card_err:
731 	snd_soc_free_pcms(socdev);
732 	snd_soc_dapm_free(socdev);
733 pcm_err:
734 	kfree(codec->reg_cache);
735 	return ret;
736 }
737 static struct snd_soc_device *tlv320aic23_socdev;
738 
739 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
740 /*
741  * If the i2c layer weren't so broken, we could pass this kind of data
742  * around
743  */
744 static int tlv320aic23_codec_probe(struct i2c_client *i2c,
745 				   const struct i2c_device_id *i2c_id)
746 {
747 	struct snd_soc_device *socdev = tlv320aic23_socdev;
748 	struct snd_soc_codec *codec = socdev->codec;
749 	int ret;
750 
751 	if (!i2c_check_functionality(i2c->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
752 		return -EINVAL;
753 
754 	i2c_set_clientdata(i2c, codec);
755 	codec->control_data = i2c;
756 
757 	ret = tlv320aic23_init(socdev);
758 	if (ret < 0) {
759 		printk(KERN_ERR "tlv320aic23: failed to initialise AIC23\n");
760 		goto err;
761 	}
762 	return ret;
763 
764 err:
765 	kfree(codec);
766 	kfree(i2c);
767 	return ret;
768 }
769 static int __exit tlv320aic23_i2c_remove(struct i2c_client *i2c)
770 {
771 	put_device(&i2c->dev);
772 	return 0;
773 }
774 
775 static const struct i2c_device_id tlv320aic23_id[] = {
776 	{"tlv320aic23", 0},
777 	{}
778 };
779 
780 MODULE_DEVICE_TABLE(i2c, tlv320aic23_id);
781 
782 static struct i2c_driver tlv320aic23_i2c_driver = {
783 	.driver = {
784 		   .name = "tlv320aic23",
785 		   },
786 	.probe = tlv320aic23_codec_probe,
787 	.remove = __exit_p(tlv320aic23_i2c_remove),
788 	.id_table = tlv320aic23_id,
789 };
790 
791 #endif
792 
793 static int tlv320aic23_probe(struct platform_device *pdev)
794 {
795 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
796 	struct snd_soc_codec *codec;
797 	struct aic23 *aic23;
798 	int ret = 0;
799 
800 	printk(KERN_INFO "AIC23 Audio Codec %s\n", AIC23_VERSION);
801 
802 	aic23 = kzalloc(sizeof(struct aic23), GFP_KERNEL);
803 	if (aic23 == NULL)
804 		return -ENOMEM;
805 	codec = &aic23->codec;
806 	socdev->codec = codec;
807 	mutex_init(&codec->mutex);
808 	INIT_LIST_HEAD(&codec->dapm_widgets);
809 	INIT_LIST_HEAD(&codec->dapm_paths);
810 
811 	tlv320aic23_socdev = socdev;
812 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
813 	codec->hw_write = (hw_write_t) i2c_master_send;
814 	codec->hw_read = NULL;
815 	ret = i2c_add_driver(&tlv320aic23_i2c_driver);
816 	if (ret != 0)
817 		printk(KERN_ERR "can't add i2c driver");
818 #endif
819 	return ret;
820 }
821 
822 static int tlv320aic23_remove(struct platform_device *pdev)
823 {
824 	struct snd_soc_device *socdev = platform_get_drvdata(pdev);
825 	struct snd_soc_codec *codec = socdev->codec;
826 	struct aic23 *aic23 = container_of(codec, struct aic23, codec);
827 
828 	if (codec->control_data)
829 		tlv320aic23_set_bias_level(codec, SND_SOC_BIAS_OFF);
830 
831 	snd_soc_free_pcms(socdev);
832 	snd_soc_dapm_free(socdev);
833 #if defined(CONFIG_I2C) || defined(CONFIG_I2C_MODULE)
834 	i2c_del_driver(&tlv320aic23_i2c_driver);
835 #endif
836 	kfree(codec->reg_cache);
837 	kfree(aic23);
838 
839 	return 0;
840 }
841 struct snd_soc_codec_device soc_codec_dev_tlv320aic23 = {
842 	.probe = tlv320aic23_probe,
843 	.remove = tlv320aic23_remove,
844 	.suspend = tlv320aic23_suspend,
845 	.resume = tlv320aic23_resume,
846 };
847 EXPORT_SYMBOL_GPL(soc_codec_dev_tlv320aic23);
848 
849 MODULE_DESCRIPTION("ASoC TLV320AIC23 codec driver");
850 MODULE_AUTHOR("Arun KS <arunks@mistralsolutions.com>");
851 MODULE_LICENSE("GPL");
852