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