1 /*
2  * linux/sound/soc/codecs/tlv320aic32x4.c
3  *
4  * Copyright 2011 Vista Silicon S.L.
5  *
6  * Author: Javier Martin <javier.martin@vista-silicon.com>
7  *
8  * Based on sound/soc/codecs/wm8974 and TI driver for kernel 2.6.27.
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License as published by
12  * the Free Software Foundation; either version 2 of the License, or
13  * (at your option) any later version.
14  *
15  * This program is distributed in the hope that it will be useful,
16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18  * GNU General Public License for more details.
19  *
20  * You should have received a copy of the GNU General Public License
21  * along with this program; if not, write to the Free Software
22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
23  * MA 02110-1301, USA.
24  */
25 
26 #include <linux/module.h>
27 #include <linux/moduleparam.h>
28 #include <linux/init.h>
29 #include <linux/delay.h>
30 #include <linux/pm.h>
31 #include <linux/i2c.h>
32 #include <linux/platform_device.h>
33 #include <linux/cdev.h>
34 #include <linux/slab.h>
35 
36 #include <sound/tlv320aic32x4.h>
37 #include <sound/core.h>
38 #include <sound/pcm.h>
39 #include <sound/pcm_params.h>
40 #include <sound/soc.h>
41 #include <sound/soc-dapm.h>
42 #include <sound/initval.h>
43 #include <sound/tlv.h>
44 
45 #include "tlv320aic32x4.h"
46 
47 struct aic32x4_rate_divs {
48 	u32 mclk;
49 	u32 rate;
50 	u8 p_val;
51 	u8 pll_j;
52 	u16 pll_d;
53 	u16 dosr;
54 	u8 ndac;
55 	u8 mdac;
56 	u8 aosr;
57 	u8 nadc;
58 	u8 madc;
59 	u8 blck_N;
60 };
61 
62 struct aic32x4_priv {
63 	u32 sysclk;
64 	s32 master;
65 	u8 page_no;
66 	void *control_data;
67 	u32 power_cfg;
68 	u32 micpga_routing;
69 	bool swapdacs;
70 };
71 
72 /* 0dB min, 1dB steps */
73 static DECLARE_TLV_DB_SCALE(tlv_step_1, 0, 100, 0);
74 /* 0dB min, 0.5dB steps */
75 static DECLARE_TLV_DB_SCALE(tlv_step_0_5, 0, 50, 0);
76 
77 static const struct snd_kcontrol_new aic32x4_snd_controls[] = {
78 	SOC_DOUBLE_R_TLV("PCM Playback Volume", AIC32X4_LDACVOL,
79 			AIC32X4_RDACVOL, 0, 0x30, 0, tlv_step_0_5),
80 	SOC_DOUBLE_R_TLV("HP Driver Gain Volume", AIC32X4_HPLGAIN,
81 			AIC32X4_HPRGAIN, 0, 0x1D, 0, tlv_step_1),
82 	SOC_DOUBLE_R_TLV("LO Driver Gain Volume", AIC32X4_LOLGAIN,
83 			AIC32X4_LORGAIN, 0, 0x1D, 0, tlv_step_1),
84 	SOC_DOUBLE_R("HP DAC Playback Switch", AIC32X4_HPLGAIN,
85 			AIC32X4_HPRGAIN, 6, 0x01, 1),
86 	SOC_DOUBLE_R("LO DAC Playback Switch", AIC32X4_LOLGAIN,
87 			AIC32X4_LORGAIN, 6, 0x01, 1),
88 	SOC_DOUBLE_R("Mic PGA Switch", AIC32X4_LMICPGAVOL,
89 			AIC32X4_RMICPGAVOL, 7, 0x01, 1),
90 
91 	SOC_SINGLE("ADCFGA Left Mute Switch", AIC32X4_ADCFGA, 7, 1, 0),
92 	SOC_SINGLE("ADCFGA Right Mute Switch", AIC32X4_ADCFGA, 3, 1, 0),
93 
94 	SOC_DOUBLE_R_TLV("ADC Level Volume", AIC32X4_LADCVOL,
95 			AIC32X4_RADCVOL, 0, 0x28, 0, tlv_step_0_5),
96 	SOC_DOUBLE_R_TLV("PGA Level Volume", AIC32X4_LMICPGAVOL,
97 			AIC32X4_RMICPGAVOL, 0, 0x5f, 0, tlv_step_0_5),
98 
99 	SOC_SINGLE("Auto-mute Switch", AIC32X4_DACMUTE, 4, 7, 0),
100 
101 	SOC_SINGLE("AGC Left Switch", AIC32X4_LAGC1, 7, 1, 0),
102 	SOC_SINGLE("AGC Right Switch", AIC32X4_RAGC1, 7, 1, 0),
103 	SOC_DOUBLE_R("AGC Target Level", AIC32X4_LAGC1, AIC32X4_RAGC1,
104 			4, 0x07, 0),
105 	SOC_DOUBLE_R("AGC Gain Hysteresis", AIC32X4_LAGC1, AIC32X4_RAGC1,
106 			0, 0x03, 0),
107 	SOC_DOUBLE_R("AGC Hysteresis", AIC32X4_LAGC2, AIC32X4_RAGC2,
108 			6, 0x03, 0),
109 	SOC_DOUBLE_R("AGC Noise Threshold", AIC32X4_LAGC2, AIC32X4_RAGC2,
110 			1, 0x1F, 0),
111 	SOC_DOUBLE_R("AGC Max PGA", AIC32X4_LAGC3, AIC32X4_RAGC3,
112 			0, 0x7F, 0),
113 	SOC_DOUBLE_R("AGC Attack Time", AIC32X4_LAGC4, AIC32X4_RAGC4,
114 			3, 0x1F, 0),
115 	SOC_DOUBLE_R("AGC Decay Time", AIC32X4_LAGC5, AIC32X4_RAGC5,
116 			3, 0x1F, 0),
117 	SOC_DOUBLE_R("AGC Noise Debounce", AIC32X4_LAGC6, AIC32X4_RAGC6,
118 			0, 0x1F, 0),
119 	SOC_DOUBLE_R("AGC Signal Debounce", AIC32X4_LAGC7, AIC32X4_RAGC7,
120 			0, 0x0F, 0),
121 };
122 
123 static const struct aic32x4_rate_divs aic32x4_divs[] = {
124 	/* 8k rate */
125 	{AIC32X4_FREQ_12000000, 8000, 1, 7, 6800, 768, 5, 3, 128, 5, 18, 24},
126 	{AIC32X4_FREQ_24000000, 8000, 2, 7, 6800, 768, 15, 1, 64, 45, 4, 24},
127 	{AIC32X4_FREQ_25000000, 8000, 2, 7, 3728, 768, 15, 1, 64, 45, 4, 24},
128 	/* 11.025k rate */
129 	{AIC32X4_FREQ_12000000, 11025, 1, 7, 5264, 512, 8, 2, 128, 8, 8, 16},
130 	{AIC32X4_FREQ_24000000, 11025, 2, 7, 5264, 512, 16, 1, 64, 32, 4, 16},
131 	/* 16k rate */
132 	{AIC32X4_FREQ_12000000, 16000, 1, 7, 6800, 384, 5, 3, 128, 5, 9, 12},
133 	{AIC32X4_FREQ_24000000, 16000, 2, 7, 6800, 384, 15, 1, 64, 18, 5, 12},
134 	{AIC32X4_FREQ_25000000, 16000, 2, 7, 3728, 384, 15, 1, 64, 18, 5, 12},
135 	/* 22.05k rate */
136 	{AIC32X4_FREQ_12000000, 22050, 1, 7, 5264, 256, 4, 4, 128, 4, 8, 8},
137 	{AIC32X4_FREQ_24000000, 22050, 2, 7, 5264, 256, 16, 1, 64, 16, 4, 8},
138 	{AIC32X4_FREQ_25000000, 22050, 2, 7, 2253, 256, 16, 1, 64, 16, 4, 8},
139 	/* 32k rate */
140 	{AIC32X4_FREQ_12000000, 32000, 1, 7, 1680, 192, 2, 7, 64, 2, 21, 6},
141 	{AIC32X4_FREQ_24000000, 32000, 2, 7, 1680, 192, 7, 2, 64, 7, 6, 6},
142 	/* 44.1k rate */
143 	{AIC32X4_FREQ_12000000, 44100, 1, 7, 5264, 128, 2, 8, 128, 2, 8, 4},
144 	{AIC32X4_FREQ_24000000, 44100, 2, 7, 5264, 128, 8, 2, 64, 8, 4, 4},
145 	{AIC32X4_FREQ_25000000, 44100, 2, 7, 2253, 128, 8, 2, 64, 8, 4, 4},
146 	/* 48k rate */
147 	{AIC32X4_FREQ_12000000, 48000, 1, 8, 1920, 128, 2, 8, 128, 2, 8, 4},
148 	{AIC32X4_FREQ_24000000, 48000, 2, 8, 1920, 128, 8, 2, 64, 8, 4, 4},
149 	{AIC32X4_FREQ_25000000, 48000, 2, 7, 8643, 128, 8, 2, 64, 8, 4, 4}
150 };
151 
152 static const struct snd_kcontrol_new hpl_output_mixer_controls[] = {
153 	SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_HPLROUTE, 3, 1, 0),
154 	SOC_DAPM_SINGLE("IN1_L Switch", AIC32X4_HPLROUTE, 2, 1, 0),
155 };
156 
157 static const struct snd_kcontrol_new hpr_output_mixer_controls[] = {
158 	SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_HPRROUTE, 3, 1, 0),
159 	SOC_DAPM_SINGLE("IN1_R Switch", AIC32X4_HPRROUTE, 2, 1, 0),
160 };
161 
162 static const struct snd_kcontrol_new lol_output_mixer_controls[] = {
163 	SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_LOLROUTE, 3, 1, 0),
164 };
165 
166 static const struct snd_kcontrol_new lor_output_mixer_controls[] = {
167 	SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_LORROUTE, 3, 1, 0),
168 };
169 
170 static const struct snd_kcontrol_new left_input_mixer_controls[] = {
171 	SOC_DAPM_SINGLE("IN1_L P Switch", AIC32X4_LMICPGAPIN, 6, 1, 0),
172 	SOC_DAPM_SINGLE("IN2_L P Switch", AIC32X4_LMICPGAPIN, 4, 1, 0),
173 	SOC_DAPM_SINGLE("IN3_L P Switch", AIC32X4_LMICPGAPIN, 2, 1, 0),
174 };
175 
176 static const struct snd_kcontrol_new right_input_mixer_controls[] = {
177 	SOC_DAPM_SINGLE("IN1_R P Switch", AIC32X4_RMICPGAPIN, 6, 1, 0),
178 	SOC_DAPM_SINGLE("IN2_R P Switch", AIC32X4_RMICPGAPIN, 4, 1, 0),
179 	SOC_DAPM_SINGLE("IN3_R P Switch", AIC32X4_RMICPGAPIN, 2, 1, 0),
180 };
181 
182 static const struct snd_soc_dapm_widget aic32x4_dapm_widgets[] = {
183 	SND_SOC_DAPM_DAC("Left DAC", "Left Playback", AIC32X4_DACSETUP, 7, 0),
184 	SND_SOC_DAPM_MIXER("HPL Output Mixer", SND_SOC_NOPM, 0, 0,
185 			   &hpl_output_mixer_controls[0],
186 			   ARRAY_SIZE(hpl_output_mixer_controls)),
187 	SND_SOC_DAPM_PGA("HPL Power", AIC32X4_OUTPWRCTL, 5, 0, NULL, 0),
188 
189 	SND_SOC_DAPM_MIXER("LOL Output Mixer", SND_SOC_NOPM, 0, 0,
190 			   &lol_output_mixer_controls[0],
191 			   ARRAY_SIZE(lol_output_mixer_controls)),
192 	SND_SOC_DAPM_PGA("LOL Power", AIC32X4_OUTPWRCTL, 3, 0, NULL, 0),
193 
194 	SND_SOC_DAPM_DAC("Right DAC", "Right Playback", AIC32X4_DACSETUP, 6, 0),
195 	SND_SOC_DAPM_MIXER("HPR Output Mixer", SND_SOC_NOPM, 0, 0,
196 			   &hpr_output_mixer_controls[0],
197 			   ARRAY_SIZE(hpr_output_mixer_controls)),
198 	SND_SOC_DAPM_PGA("HPR Power", AIC32X4_OUTPWRCTL, 4, 0, NULL, 0),
199 	SND_SOC_DAPM_MIXER("LOR Output Mixer", SND_SOC_NOPM, 0, 0,
200 			   &lor_output_mixer_controls[0],
201 			   ARRAY_SIZE(lor_output_mixer_controls)),
202 	SND_SOC_DAPM_PGA("LOR Power", AIC32X4_OUTPWRCTL, 2, 0, NULL, 0),
203 	SND_SOC_DAPM_MIXER("Left Input Mixer", SND_SOC_NOPM, 0, 0,
204 			   &left_input_mixer_controls[0],
205 			   ARRAY_SIZE(left_input_mixer_controls)),
206 	SND_SOC_DAPM_MIXER("Right Input Mixer", SND_SOC_NOPM, 0, 0,
207 			   &right_input_mixer_controls[0],
208 			   ARRAY_SIZE(right_input_mixer_controls)),
209 	SND_SOC_DAPM_ADC("Left ADC", "Left Capture", AIC32X4_ADCSETUP, 7, 0),
210 	SND_SOC_DAPM_ADC("Right ADC", "Right Capture", AIC32X4_ADCSETUP, 6, 0),
211 	SND_SOC_DAPM_MICBIAS("Mic Bias", AIC32X4_MICBIAS, 6, 0),
212 
213 	SND_SOC_DAPM_OUTPUT("HPL"),
214 	SND_SOC_DAPM_OUTPUT("HPR"),
215 	SND_SOC_DAPM_OUTPUT("LOL"),
216 	SND_SOC_DAPM_OUTPUT("LOR"),
217 	SND_SOC_DAPM_INPUT("IN1_L"),
218 	SND_SOC_DAPM_INPUT("IN1_R"),
219 	SND_SOC_DAPM_INPUT("IN2_L"),
220 	SND_SOC_DAPM_INPUT("IN2_R"),
221 	SND_SOC_DAPM_INPUT("IN3_L"),
222 	SND_SOC_DAPM_INPUT("IN3_R"),
223 };
224 
225 static const struct snd_soc_dapm_route aic32x4_dapm_routes[] = {
226 	/* Left Output */
227 	{"HPL Output Mixer", "L_DAC Switch", "Left DAC"},
228 	{"HPL Output Mixer", "IN1_L Switch", "IN1_L"},
229 
230 	{"HPL Power", NULL, "HPL Output Mixer"},
231 	{"HPL", NULL, "HPL Power"},
232 
233 	{"LOL Output Mixer", "L_DAC Switch", "Left DAC"},
234 
235 	{"LOL Power", NULL, "LOL Output Mixer"},
236 	{"LOL", NULL, "LOL Power"},
237 
238 	/* Right Output */
239 	{"HPR Output Mixer", "R_DAC Switch", "Right DAC"},
240 	{"HPR Output Mixer", "IN1_R Switch", "IN1_R"},
241 
242 	{"HPR Power", NULL, "HPR Output Mixer"},
243 	{"HPR", NULL, "HPR Power"},
244 
245 	{"LOR Output Mixer", "R_DAC Switch", "Right DAC"},
246 
247 	{"LOR Power", NULL, "LOR Output Mixer"},
248 	{"LOR", NULL, "LOR Power"},
249 
250 	/* Left input */
251 	{"Left Input Mixer", "IN1_L P Switch", "IN1_L"},
252 	{"Left Input Mixer", "IN2_L P Switch", "IN2_L"},
253 	{"Left Input Mixer", "IN3_L P Switch", "IN3_L"},
254 
255 	{"Left ADC", NULL, "Left Input Mixer"},
256 
257 	/* Right Input */
258 	{"Right Input Mixer", "IN1_R P Switch", "IN1_R"},
259 	{"Right Input Mixer", "IN2_R P Switch", "IN2_R"},
260 	{"Right Input Mixer", "IN3_R P Switch", "IN3_R"},
261 
262 	{"Right ADC", NULL, "Right Input Mixer"},
263 };
264 
aic32x4_change_page(struct snd_soc_codec * codec,unsigned int new_page)265 static inline int aic32x4_change_page(struct snd_soc_codec *codec,
266 					unsigned int new_page)
267 {
268 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
269 	u8 data[2];
270 	int ret;
271 
272 	data[0] = 0x00;
273 	data[1] = new_page & 0xff;
274 
275 	ret = codec->hw_write(codec->control_data, data, 2);
276 	if (ret == 2) {
277 		aic32x4->page_no = new_page;
278 		return 0;
279 	} else {
280 		return ret;
281 	}
282 }
283 
aic32x4_write(struct snd_soc_codec * codec,unsigned int reg,unsigned int val)284 static int aic32x4_write(struct snd_soc_codec *codec, unsigned int reg,
285 				unsigned int val)
286 {
287 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
288 	unsigned int page = reg / 128;
289 	unsigned int fixed_reg = reg % 128;
290 	u8 data[2];
291 	int ret;
292 
293 	/* A write to AIC32X4_PSEL is really a non-explicit page change */
294 	if (reg == AIC32X4_PSEL)
295 		return aic32x4_change_page(codec, val);
296 
297 	if (aic32x4->page_no != page) {
298 		ret = aic32x4_change_page(codec, page);
299 		if (ret != 0)
300 			return ret;
301 	}
302 
303 	data[0] = fixed_reg & 0xff;
304 	data[1] = val & 0xff;
305 
306 	if (codec->hw_write(codec->control_data, data, 2) == 2)
307 		return 0;
308 	else
309 		return -EIO;
310 }
311 
aic32x4_read(struct snd_soc_codec * codec,unsigned int reg)312 static unsigned int aic32x4_read(struct snd_soc_codec *codec, unsigned int reg)
313 {
314 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
315 	unsigned int page = reg / 128;
316 	unsigned int fixed_reg = reg % 128;
317 	int ret;
318 
319 	if (aic32x4->page_no != page) {
320 		ret = aic32x4_change_page(codec, page);
321 		if (ret != 0)
322 			return ret;
323 	}
324 	return i2c_smbus_read_byte_data(codec->control_data, fixed_reg & 0xff);
325 }
326 
aic32x4_get_divs(int mclk,int rate)327 static inline int aic32x4_get_divs(int mclk, int rate)
328 {
329 	int i;
330 
331 	for (i = 0; i < ARRAY_SIZE(aic32x4_divs); i++) {
332 		if ((aic32x4_divs[i].rate == rate)
333 		    && (aic32x4_divs[i].mclk == mclk)) {
334 			return i;
335 		}
336 	}
337 	printk(KERN_ERR "aic32x4: master clock and sample rate is not supported\n");
338 	return -EINVAL;
339 }
340 
aic32x4_add_widgets(struct snd_soc_codec * codec)341 static int aic32x4_add_widgets(struct snd_soc_codec *codec)
342 {
343 	snd_soc_dapm_new_controls(&codec->dapm, aic32x4_dapm_widgets,
344 				  ARRAY_SIZE(aic32x4_dapm_widgets));
345 
346 	snd_soc_dapm_add_routes(&codec->dapm, aic32x4_dapm_routes,
347 				ARRAY_SIZE(aic32x4_dapm_routes));
348 
349 	snd_soc_dapm_new_widgets(&codec->dapm);
350 	return 0;
351 }
352 
aic32x4_set_dai_sysclk(struct snd_soc_dai * codec_dai,int clk_id,unsigned int freq,int dir)353 static int aic32x4_set_dai_sysclk(struct snd_soc_dai *codec_dai,
354 				  int clk_id, unsigned int freq, int dir)
355 {
356 	struct snd_soc_codec *codec = codec_dai->codec;
357 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
358 
359 	switch (freq) {
360 	case AIC32X4_FREQ_12000000:
361 	case AIC32X4_FREQ_24000000:
362 	case AIC32X4_FREQ_25000000:
363 		aic32x4->sysclk = freq;
364 		return 0;
365 	}
366 	printk(KERN_ERR "aic32x4: invalid frequency to set DAI system clock\n");
367 	return -EINVAL;
368 }
369 
aic32x4_set_dai_fmt(struct snd_soc_dai * codec_dai,unsigned int fmt)370 static int aic32x4_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
371 {
372 	struct snd_soc_codec *codec = codec_dai->codec;
373 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
374 	u8 iface_reg_1;
375 	u8 iface_reg_2;
376 	u8 iface_reg_3;
377 
378 	iface_reg_1 = snd_soc_read(codec, AIC32X4_IFACE1);
379 	iface_reg_1 = iface_reg_1 & ~(3 << 6 | 3 << 2);
380 	iface_reg_2 = snd_soc_read(codec, AIC32X4_IFACE2);
381 	iface_reg_2 = 0;
382 	iface_reg_3 = snd_soc_read(codec, AIC32X4_IFACE3);
383 	iface_reg_3 = iface_reg_3 & ~(1 << 3);
384 
385 	/* set master/slave audio interface */
386 	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
387 	case SND_SOC_DAIFMT_CBM_CFM:
388 		aic32x4->master = 1;
389 		iface_reg_1 |= AIC32X4_BCLKMASTER | AIC32X4_WCLKMASTER;
390 		break;
391 	case SND_SOC_DAIFMT_CBS_CFS:
392 		aic32x4->master = 0;
393 		break;
394 	default:
395 		printk(KERN_ERR "aic32x4: invalid DAI master/slave interface\n");
396 		return -EINVAL;
397 	}
398 
399 	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
400 	case SND_SOC_DAIFMT_I2S:
401 		break;
402 	case SND_SOC_DAIFMT_DSP_A:
403 		iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
404 		iface_reg_3 |= (1 << 3); /* invert bit clock */
405 		iface_reg_2 = 0x01; /* add offset 1 */
406 		break;
407 	case SND_SOC_DAIFMT_DSP_B:
408 		iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
409 		iface_reg_3 |= (1 << 3); /* invert bit clock */
410 		break;
411 	case SND_SOC_DAIFMT_RIGHT_J:
412 		iface_reg_1 |=
413 			(AIC32X4_RIGHT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
414 		break;
415 	case SND_SOC_DAIFMT_LEFT_J:
416 		iface_reg_1 |=
417 			(AIC32X4_LEFT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
418 		break;
419 	default:
420 		printk(KERN_ERR "aic32x4: invalid DAI interface format\n");
421 		return -EINVAL;
422 	}
423 
424 	snd_soc_write(codec, AIC32X4_IFACE1, iface_reg_1);
425 	snd_soc_write(codec, AIC32X4_IFACE2, iface_reg_2);
426 	snd_soc_write(codec, AIC32X4_IFACE3, iface_reg_3);
427 	return 0;
428 }
429 
aic32x4_hw_params(struct snd_pcm_substream * substream,struct snd_pcm_hw_params * params,struct snd_soc_dai * dai)430 static int aic32x4_hw_params(struct snd_pcm_substream *substream,
431 			     struct snd_pcm_hw_params *params,
432 			     struct snd_soc_dai *dai)
433 {
434 	struct snd_soc_codec *codec = dai->codec;
435 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
436 	u8 data;
437 	int i;
438 
439 	i = aic32x4_get_divs(aic32x4->sysclk, params_rate(params));
440 	if (i < 0) {
441 		printk(KERN_ERR "aic32x4: sampling rate not supported\n");
442 		return i;
443 	}
444 
445 	/* Use PLL as CODEC_CLKIN and DAC_MOD_CLK as BDIV_CLKIN */
446 	snd_soc_write(codec, AIC32X4_CLKMUX, AIC32X4_PLLCLKIN);
447 	snd_soc_write(codec, AIC32X4_IFACE3, AIC32X4_DACMOD2BCLK);
448 
449 	/* We will fix R value to 1 and will make P & J=K.D as varialble */
450 	data = snd_soc_read(codec, AIC32X4_PLLPR);
451 	data &= ~(7 << 4);
452 	snd_soc_write(codec, AIC32X4_PLLPR,
453 		      (data | (aic32x4_divs[i].p_val << 4) | 0x01));
454 
455 	snd_soc_write(codec, AIC32X4_PLLJ, aic32x4_divs[i].pll_j);
456 
457 	snd_soc_write(codec, AIC32X4_PLLDMSB, (aic32x4_divs[i].pll_d >> 8));
458 	snd_soc_write(codec, AIC32X4_PLLDLSB,
459 		      (aic32x4_divs[i].pll_d & 0xff));
460 
461 	/* NDAC divider value */
462 	data = snd_soc_read(codec, AIC32X4_NDAC);
463 	data &= ~(0x7f);
464 	snd_soc_write(codec, AIC32X4_NDAC, data | aic32x4_divs[i].ndac);
465 
466 	/* MDAC divider value */
467 	data = snd_soc_read(codec, AIC32X4_MDAC);
468 	data &= ~(0x7f);
469 	snd_soc_write(codec, AIC32X4_MDAC, data | aic32x4_divs[i].mdac);
470 
471 	/* DOSR MSB & LSB values */
472 	snd_soc_write(codec, AIC32X4_DOSRMSB, aic32x4_divs[i].dosr >> 8);
473 	snd_soc_write(codec, AIC32X4_DOSRLSB,
474 		      (aic32x4_divs[i].dosr & 0xff));
475 
476 	/* NADC divider value */
477 	data = snd_soc_read(codec, AIC32X4_NADC);
478 	data &= ~(0x7f);
479 	snd_soc_write(codec, AIC32X4_NADC, data | aic32x4_divs[i].nadc);
480 
481 	/* MADC divider value */
482 	data = snd_soc_read(codec, AIC32X4_MADC);
483 	data &= ~(0x7f);
484 	snd_soc_write(codec, AIC32X4_MADC, data | aic32x4_divs[i].madc);
485 
486 	/* AOSR value */
487 	snd_soc_write(codec, AIC32X4_AOSR, aic32x4_divs[i].aosr);
488 
489 	/* BCLK N divider */
490 	data = snd_soc_read(codec, AIC32X4_BCLKN);
491 	data &= ~(0x7f);
492 	snd_soc_write(codec, AIC32X4_BCLKN, data | aic32x4_divs[i].blck_N);
493 
494 	data = snd_soc_read(codec, AIC32X4_IFACE1);
495 	data = data & ~(3 << 4);
496 	switch (params_format(params)) {
497 	case SNDRV_PCM_FORMAT_S16_LE:
498 		break;
499 	case SNDRV_PCM_FORMAT_S20_3LE:
500 		data |= (AIC32X4_WORD_LEN_20BITS << AIC32X4_DOSRMSB_SHIFT);
501 		break;
502 	case SNDRV_PCM_FORMAT_S24_LE:
503 		data |= (AIC32X4_WORD_LEN_24BITS << AIC32X4_DOSRMSB_SHIFT);
504 		break;
505 	case SNDRV_PCM_FORMAT_S32_LE:
506 		data |= (AIC32X4_WORD_LEN_32BITS << AIC32X4_DOSRMSB_SHIFT);
507 		break;
508 	}
509 	snd_soc_write(codec, AIC32X4_IFACE1, data);
510 
511 	return 0;
512 }
513 
aic32x4_mute(struct snd_soc_dai * dai,int mute)514 static int aic32x4_mute(struct snd_soc_dai *dai, int mute)
515 {
516 	struct snd_soc_codec *codec = dai->codec;
517 	u8 dac_reg;
518 
519 	dac_reg = snd_soc_read(codec, AIC32X4_DACMUTE) & ~AIC32X4_MUTEON;
520 	if (mute)
521 		snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg | AIC32X4_MUTEON);
522 	else
523 		snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg);
524 	return 0;
525 }
526 
aic32x4_set_bias_level(struct snd_soc_codec * codec,enum snd_soc_bias_level level)527 static int aic32x4_set_bias_level(struct snd_soc_codec *codec,
528 				  enum snd_soc_bias_level level)
529 {
530 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
531 	u8 value;
532 
533 	switch (level) {
534 	case SND_SOC_BIAS_ON:
535 		if (aic32x4->master) {
536 			/* Switch on PLL */
537 			value = snd_soc_read(codec, AIC32X4_PLLPR);
538 			snd_soc_write(codec, AIC32X4_PLLPR,
539 				      (value | AIC32X4_PLLEN));
540 
541 			/* Switch on NDAC Divider */
542 			value = snd_soc_read(codec, AIC32X4_NDAC);
543 			snd_soc_write(codec, AIC32X4_NDAC,
544 				      value | AIC32X4_NDACEN);
545 
546 			/* Switch on MDAC Divider */
547 			value = snd_soc_read(codec, AIC32X4_MDAC);
548 			snd_soc_write(codec, AIC32X4_MDAC,
549 				      value | AIC32X4_MDACEN);
550 
551 			/* Switch on NADC Divider */
552 			value = snd_soc_read(codec, AIC32X4_NADC);
553 			snd_soc_write(codec, AIC32X4_NADC,
554 				      value | AIC32X4_MDACEN);
555 
556 			/* Switch on MADC Divider */
557 			value = snd_soc_read(codec, AIC32X4_MADC);
558 			snd_soc_write(codec, AIC32X4_MADC,
559 				      value | AIC32X4_MDACEN);
560 
561 			/* Switch on BCLK_N Divider */
562 			value = snd_soc_read(codec, AIC32X4_BCLKN);
563 			snd_soc_write(codec, AIC32X4_BCLKN,
564 				      value | AIC32X4_BCLKEN);
565 		}
566 		break;
567 	case SND_SOC_BIAS_PREPARE:
568 		break;
569 	case SND_SOC_BIAS_STANDBY:
570 		if (aic32x4->master) {
571 			/* Switch off PLL */
572 			value = snd_soc_read(codec, AIC32X4_PLLPR);
573 			snd_soc_write(codec, AIC32X4_PLLPR,
574 				      (value & ~AIC32X4_PLLEN));
575 
576 			/* Switch off NDAC Divider */
577 			value = snd_soc_read(codec, AIC32X4_NDAC);
578 			snd_soc_write(codec, AIC32X4_NDAC,
579 				      value & ~AIC32X4_NDACEN);
580 
581 			/* Switch off MDAC Divider */
582 			value = snd_soc_read(codec, AIC32X4_MDAC);
583 			snd_soc_write(codec, AIC32X4_MDAC,
584 				      value & ~AIC32X4_MDACEN);
585 
586 			/* Switch off NADC Divider */
587 			value = snd_soc_read(codec, AIC32X4_NADC);
588 			snd_soc_write(codec, AIC32X4_NADC,
589 				      value & ~AIC32X4_NDACEN);
590 
591 			/* Switch off MADC Divider */
592 			value = snd_soc_read(codec, AIC32X4_MADC);
593 			snd_soc_write(codec, AIC32X4_MADC,
594 				      value & ~AIC32X4_MDACEN);
595 			value = snd_soc_read(codec, AIC32X4_BCLKN);
596 
597 			/* Switch off BCLK_N Divider */
598 			snd_soc_write(codec, AIC32X4_BCLKN,
599 				      value & ~AIC32X4_BCLKEN);
600 		}
601 		break;
602 	case SND_SOC_BIAS_OFF:
603 		break;
604 	}
605 	codec->dapm.bias_level = level;
606 	return 0;
607 }
608 
609 #define AIC32X4_RATES	SNDRV_PCM_RATE_8000_48000
610 #define AIC32X4_FORMATS	(SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
611 			 | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
612 
613 static struct snd_soc_dai_ops aic32x4_ops = {
614 	.hw_params = aic32x4_hw_params,
615 	.digital_mute = aic32x4_mute,
616 	.set_fmt = aic32x4_set_dai_fmt,
617 	.set_sysclk = aic32x4_set_dai_sysclk,
618 };
619 
620 static struct snd_soc_dai_driver aic32x4_dai = {
621 	.name = "tlv320aic32x4-hifi",
622 	.playback = {
623 		     .stream_name = "Playback",
624 		     .channels_min = 1,
625 		     .channels_max = 2,
626 		     .rates = AIC32X4_RATES,
627 		     .formats = AIC32X4_FORMATS,},
628 	.capture = {
629 		    .stream_name = "Capture",
630 		    .channels_min = 1,
631 		    .channels_max = 2,
632 		    .rates = AIC32X4_RATES,
633 		    .formats = AIC32X4_FORMATS,},
634 	.ops = &aic32x4_ops,
635 	.symmetric_rates = 1,
636 };
637 
aic32x4_suspend(struct snd_soc_codec * codec,pm_message_t state)638 static int aic32x4_suspend(struct snd_soc_codec *codec, pm_message_t state)
639 {
640 	aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
641 	return 0;
642 }
643 
aic32x4_resume(struct snd_soc_codec * codec)644 static int aic32x4_resume(struct snd_soc_codec *codec)
645 {
646 	aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
647 	return 0;
648 }
649 
aic32x4_probe(struct snd_soc_codec * codec)650 static int aic32x4_probe(struct snd_soc_codec *codec)
651 {
652 	struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
653 	u32 tmp_reg;
654 
655 	codec->hw_write = (hw_write_t) i2c_master_send;
656 	codec->control_data = aic32x4->control_data;
657 
658 	snd_soc_write(codec, AIC32X4_RESET, 0x01);
659 
660 	/* Power platform configuration */
661 	if (aic32x4->power_cfg & AIC32X4_PWR_MICBIAS_2075_LDOIN) {
662 		snd_soc_write(codec, AIC32X4_MICBIAS, AIC32X4_MICBIAS_LDOIN |
663 						      AIC32X4_MICBIAS_2075V);
664 	}
665 	if (aic32x4->power_cfg & AIC32X4_PWR_AVDD_DVDD_WEAK_DISABLE) {
666 		snd_soc_write(codec, AIC32X4_PWRCFG, AIC32X4_AVDDWEAKDISABLE);
667 	}
668 	if (aic32x4->power_cfg & AIC32X4_PWR_AIC32X4_LDO_ENABLE) {
669 		snd_soc_write(codec, AIC32X4_LDOCTL, AIC32X4_LDOCTLEN);
670 	}
671 	tmp_reg = snd_soc_read(codec, AIC32X4_CMMODE);
672 	if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_LDOIN_RANGE_18_36) {
673 		tmp_reg |= AIC32X4_LDOIN_18_36;
674 	}
675 	if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_HP_LDOIN_POWERED) {
676 		tmp_reg |= AIC32X4_LDOIN2HP;
677 	}
678 	snd_soc_write(codec, AIC32X4_CMMODE, tmp_reg);
679 
680 	/* Do DACs need to be swapped? */
681 	if (aic32x4->swapdacs) {
682 		snd_soc_write(codec, AIC32X4_DACSETUP, AIC32X4_LDAC2RCHN | AIC32X4_RDAC2LCHN);
683 	} else {
684 		snd_soc_write(codec, AIC32X4_DACSETUP, AIC32X4_LDAC2LCHN | AIC32X4_RDAC2RCHN);
685 	}
686 
687 	/* Mic PGA routing */
688 	if (aic32x4->micpga_routing | AIC32X4_MICPGA_ROUTE_LMIC_IN2R_10K) {
689 		snd_soc_write(codec, AIC32X4_LMICPGANIN, AIC32X4_LMICPGANIN_IN2R_10K);
690 	}
691 	if (aic32x4->micpga_routing | AIC32X4_MICPGA_ROUTE_RMIC_IN1L_10K) {
692 		snd_soc_write(codec, AIC32X4_RMICPGANIN, AIC32X4_RMICPGANIN_IN1L_10K);
693 	}
694 
695 	aic32x4_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
696 	snd_soc_add_controls(codec, aic32x4_snd_controls,
697 			     ARRAY_SIZE(aic32x4_snd_controls));
698 	aic32x4_add_widgets(codec);
699 
700 	return 0;
701 }
702 
aic32x4_remove(struct snd_soc_codec * codec)703 static int aic32x4_remove(struct snd_soc_codec *codec)
704 {
705 	aic32x4_set_bias_level(codec, SND_SOC_BIAS_OFF);
706 	return 0;
707 }
708 
709 static struct snd_soc_codec_driver soc_codec_dev_aic32x4 = {
710 	.read = aic32x4_read,
711 	.write = aic32x4_write,
712 	.probe = aic32x4_probe,
713 	.remove = aic32x4_remove,
714 	.suspend = aic32x4_suspend,
715 	.resume = aic32x4_resume,
716 	.set_bias_level = aic32x4_set_bias_level,
717 };
718 
aic32x4_i2c_probe(struct i2c_client * i2c,const struct i2c_device_id * id)719 static __devinit int aic32x4_i2c_probe(struct i2c_client *i2c,
720 				      const struct i2c_device_id *id)
721 {
722 	struct aic32x4_pdata *pdata = i2c->dev.platform_data;
723 	struct aic32x4_priv *aic32x4;
724 	int ret;
725 
726 	aic32x4 = kzalloc(sizeof(struct aic32x4_priv), GFP_KERNEL);
727 	if (aic32x4 == NULL)
728 		return -ENOMEM;
729 
730 	aic32x4->control_data = i2c;
731 	i2c_set_clientdata(i2c, aic32x4);
732 
733 	if (pdata) {
734 		aic32x4->power_cfg = pdata->power_cfg;
735 		aic32x4->swapdacs = pdata->swapdacs;
736 		aic32x4->micpga_routing = pdata->micpga_routing;
737 	} else {
738 		aic32x4->power_cfg = 0;
739 		aic32x4->swapdacs = false;
740 		aic32x4->micpga_routing = 0;
741 	}
742 
743 	ret = snd_soc_register_codec(&i2c->dev,
744 			&soc_codec_dev_aic32x4, &aic32x4_dai, 1);
745 	if (ret < 0)
746 		kfree(aic32x4);
747 	return ret;
748 }
749 
aic32x4_i2c_remove(struct i2c_client * client)750 static __devexit int aic32x4_i2c_remove(struct i2c_client *client)
751 {
752 	snd_soc_unregister_codec(&client->dev);
753 	kfree(i2c_get_clientdata(client));
754 	return 0;
755 }
756 
757 static const struct i2c_device_id aic32x4_i2c_id[] = {
758 	{ "tlv320aic32x4", 0 },
759 	{ }
760 };
761 MODULE_DEVICE_TABLE(i2c, aic32x4_i2c_id);
762 
763 static struct i2c_driver aic32x4_i2c_driver = {
764 	.driver = {
765 		.name = "tlv320aic32x4",
766 		.owner = THIS_MODULE,
767 	},
768 	.probe =    aic32x4_i2c_probe,
769 	.remove =   __devexit_p(aic32x4_i2c_remove),
770 	.id_table = aic32x4_i2c_id,
771 };
772 
aic32x4_modinit(void)773 static int __init aic32x4_modinit(void)
774 {
775 	int ret = 0;
776 
777 	ret = i2c_add_driver(&aic32x4_i2c_driver);
778 	if (ret != 0) {
779 		printk(KERN_ERR "Failed to register aic32x4 I2C driver: %d\n",
780 		       ret);
781 	}
782 	return ret;
783 }
784 module_init(aic32x4_modinit);
785 
aic32x4_exit(void)786 static void __exit aic32x4_exit(void)
787 {
788 	i2c_del_driver(&aic32x4_i2c_driver);
789 }
790 module_exit(aic32x4_exit);
791 
792 MODULE_DESCRIPTION("ASoC tlv320aic32x4 codec driver");
793 MODULE_AUTHOR("Javier Martin <javier.martin@vista-silicon.com>");
794 MODULE_LICENSE("GPL");
795