Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / sound / soc / codecs / tlv320aic32x4.c
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/gpio.h>
32 #include <linux/of_gpio.h>
33 #include <linux/i2c.h>
34 #include <linux/cdev.h>
35 #include <linux/slab.h>
36 #include <linux/clk.h>
37 #include <linux/regulator/consumer.h>
38
39 #include <sound/tlv320aic32x4.h>
40 #include <sound/core.h>
41 #include <sound/pcm.h>
42 #include <sound/pcm_params.h>
43 #include <sound/soc.h>
44 #include <sound/soc-dapm.h>
45 #include <sound/initval.h>
46 #include <sound/tlv.h>
47
48 #include "tlv320aic32x4.h"
49
50 struct aic32x4_rate_divs {
51         u32 mclk;
52         u32 rate;
53         u8 p_val;
54         u8 pll_j;
55         u16 pll_d;
56         u16 dosr;
57         u8 ndac;
58         u8 mdac;
59         u8 aosr;
60         u8 nadc;
61         u8 madc;
62         u8 blck_N;
63 };
64
65 struct aic32x4_priv {
66         struct regmap *regmap;
67         u32 sysclk;
68         u32 power_cfg;
69         u32 micpga_routing;
70         bool swapdacs;
71         int rstn_gpio;
72         struct clk *mclk;
73
74         struct regulator *supply_ldo;
75         struct regulator *supply_iov;
76         struct regulator *supply_dv;
77         struct regulator *supply_av;
78 };
79
80 /* 0dB min, 0.5dB steps */
81 static DECLARE_TLV_DB_SCALE(tlv_step_0_5, 0, 50, 0);
82 /* -63.5dB min, 0.5dB steps */
83 static DECLARE_TLV_DB_SCALE(tlv_pcm, -6350, 50, 0);
84 /* -6dB min, 1dB steps */
85 static DECLARE_TLV_DB_SCALE(tlv_driver_gain, -600, 100, 0);
86 /* -12dB min, 0.5dB steps */
87 static DECLARE_TLV_DB_SCALE(tlv_adc_vol, -1200, 50, 0);
88
89 static const struct snd_kcontrol_new aic32x4_snd_controls[] = {
90         SOC_DOUBLE_R_S_TLV("PCM Playback Volume", AIC32X4_LDACVOL,
91                         AIC32X4_RDACVOL, 0, -0x7f, 0x30, 7, 0, tlv_pcm),
92         SOC_DOUBLE_R_S_TLV("HP Driver Gain Volume", AIC32X4_HPLGAIN,
93                         AIC32X4_HPRGAIN, 0, -0x6, 0x1d, 5, 0,
94                         tlv_driver_gain),
95         SOC_DOUBLE_R_S_TLV("LO Driver Gain Volume", AIC32X4_LOLGAIN,
96                         AIC32X4_LORGAIN, 0, -0x6, 0x1d, 5, 0,
97                         tlv_driver_gain),
98         SOC_DOUBLE_R("HP DAC Playback Switch", AIC32X4_HPLGAIN,
99                         AIC32X4_HPRGAIN, 6, 0x01, 1),
100         SOC_DOUBLE_R("LO DAC Playback Switch", AIC32X4_LOLGAIN,
101                         AIC32X4_LORGAIN, 6, 0x01, 1),
102         SOC_DOUBLE_R("Mic PGA Switch", AIC32X4_LMICPGAVOL,
103                         AIC32X4_RMICPGAVOL, 7, 0x01, 1),
104
105         SOC_SINGLE("ADCFGA Left Mute Switch", AIC32X4_ADCFGA, 7, 1, 0),
106         SOC_SINGLE("ADCFGA Right Mute Switch", AIC32X4_ADCFGA, 3, 1, 0),
107
108         SOC_DOUBLE_R_S_TLV("ADC Level Volume", AIC32X4_LADCVOL,
109                         AIC32X4_RADCVOL, 0, -0x18, 0x28, 6, 0, tlv_adc_vol),
110         SOC_DOUBLE_R_TLV("PGA Level Volume", AIC32X4_LMICPGAVOL,
111                         AIC32X4_RMICPGAVOL, 0, 0x5f, 0, tlv_step_0_5),
112
113         SOC_SINGLE("Auto-mute Switch", AIC32X4_DACMUTE, 4, 7, 0),
114
115         SOC_SINGLE("AGC Left Switch", AIC32X4_LAGC1, 7, 1, 0),
116         SOC_SINGLE("AGC Right Switch", AIC32X4_RAGC1, 7, 1, 0),
117         SOC_DOUBLE_R("AGC Target Level", AIC32X4_LAGC1, AIC32X4_RAGC1,
118                         4, 0x07, 0),
119         SOC_DOUBLE_R("AGC Gain Hysteresis", AIC32X4_LAGC1, AIC32X4_RAGC1,
120                         0, 0x03, 0),
121         SOC_DOUBLE_R("AGC Hysteresis", AIC32X4_LAGC2, AIC32X4_RAGC2,
122                         6, 0x03, 0),
123         SOC_DOUBLE_R("AGC Noise Threshold", AIC32X4_LAGC2, AIC32X4_RAGC2,
124                         1, 0x1F, 0),
125         SOC_DOUBLE_R("AGC Max PGA", AIC32X4_LAGC3, AIC32X4_RAGC3,
126                         0, 0x7F, 0),
127         SOC_DOUBLE_R("AGC Attack Time", AIC32X4_LAGC4, AIC32X4_RAGC4,
128                         3, 0x1F, 0),
129         SOC_DOUBLE_R("AGC Decay Time", AIC32X4_LAGC5, AIC32X4_RAGC5,
130                         3, 0x1F, 0),
131         SOC_DOUBLE_R("AGC Noise Debounce", AIC32X4_LAGC6, AIC32X4_RAGC6,
132                         0, 0x1F, 0),
133         SOC_DOUBLE_R("AGC Signal Debounce", AIC32X4_LAGC7, AIC32X4_RAGC7,
134                         0, 0x0F, 0),
135 };
136
137 static const struct aic32x4_rate_divs aic32x4_divs[] = {
138         /* 8k rate */
139         {AIC32X4_FREQ_12000000, 8000, 1, 7, 6800, 768, 5, 3, 128, 5, 18, 24},
140         {AIC32X4_FREQ_24000000, 8000, 2, 7, 6800, 768, 15, 1, 64, 45, 4, 24},
141         {AIC32X4_FREQ_25000000, 8000, 2, 7, 3728, 768, 15, 1, 64, 45, 4, 24},
142         /* 11.025k rate */
143         {AIC32X4_FREQ_12000000, 11025, 1, 7, 5264, 512, 8, 2, 128, 8, 8, 16},
144         {AIC32X4_FREQ_24000000, 11025, 2, 7, 5264, 512, 16, 1, 64, 32, 4, 16},
145         /* 16k rate */
146         {AIC32X4_FREQ_12000000, 16000, 1, 7, 6800, 384, 5, 3, 128, 5, 9, 12},
147         {AIC32X4_FREQ_24000000, 16000, 2, 7, 6800, 384, 15, 1, 64, 18, 5, 12},
148         {AIC32X4_FREQ_25000000, 16000, 2, 7, 3728, 384, 15, 1, 64, 18, 5, 12},
149         /* 22.05k rate */
150         {AIC32X4_FREQ_12000000, 22050, 1, 7, 5264, 256, 4, 4, 128, 4, 8, 8},
151         {AIC32X4_FREQ_24000000, 22050, 2, 7, 5264, 256, 16, 1, 64, 16, 4, 8},
152         {AIC32X4_FREQ_25000000, 22050, 2, 7, 2253, 256, 16, 1, 64, 16, 4, 8},
153         /* 32k rate */
154         {AIC32X4_FREQ_12000000, 32000, 1, 7, 1680, 192, 2, 7, 64, 2, 21, 6},
155         {AIC32X4_FREQ_24000000, 32000, 2, 7, 1680, 192, 7, 2, 64, 7, 6, 6},
156         /* 44.1k rate */
157         {AIC32X4_FREQ_12000000, 44100, 1, 7, 5264, 128, 2, 8, 128, 2, 8, 4},
158         {AIC32X4_FREQ_24000000, 44100, 2, 7, 5264, 128, 8, 2, 64, 8, 4, 4},
159         {AIC32X4_FREQ_25000000, 44100, 2, 7, 2253, 128, 8, 2, 64, 8, 4, 4},
160         /* 48k rate */
161         {AIC32X4_FREQ_12000000, 48000, 1, 8, 1920, 128, 2, 8, 128, 2, 8, 4},
162         {AIC32X4_FREQ_24000000, 48000, 2, 8, 1920, 128, 8, 2, 64, 8, 4, 4},
163         {AIC32X4_FREQ_25000000, 48000, 2, 7, 8643, 128, 8, 2, 64, 8, 4, 4}
164 };
165
166 static const struct snd_kcontrol_new hpl_output_mixer_controls[] = {
167         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_HPLROUTE, 3, 1, 0),
168         SOC_DAPM_SINGLE("IN1_L Switch", AIC32X4_HPLROUTE, 2, 1, 0),
169 };
170
171 static const struct snd_kcontrol_new hpr_output_mixer_controls[] = {
172         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_HPRROUTE, 3, 1, 0),
173         SOC_DAPM_SINGLE("IN1_R Switch", AIC32X4_HPRROUTE, 2, 1, 0),
174 };
175
176 static const struct snd_kcontrol_new lol_output_mixer_controls[] = {
177         SOC_DAPM_SINGLE("L_DAC Switch", AIC32X4_LOLROUTE, 3, 1, 0),
178 };
179
180 static const struct snd_kcontrol_new lor_output_mixer_controls[] = {
181         SOC_DAPM_SINGLE("R_DAC Switch", AIC32X4_LORROUTE, 3, 1, 0),
182 };
183
184 static const struct snd_kcontrol_new left_input_mixer_controls[] = {
185         SOC_DAPM_SINGLE("IN1_L P Switch", AIC32X4_LMICPGAPIN, 6, 1, 0),
186         SOC_DAPM_SINGLE("IN2_L P Switch", AIC32X4_LMICPGAPIN, 4, 1, 0),
187         SOC_DAPM_SINGLE("IN3_L P Switch", AIC32X4_LMICPGAPIN, 2, 1, 0),
188 };
189
190 static const struct snd_kcontrol_new right_input_mixer_controls[] = {
191         SOC_DAPM_SINGLE("IN1_R P Switch", AIC32X4_RMICPGAPIN, 6, 1, 0),
192         SOC_DAPM_SINGLE("IN2_R P Switch", AIC32X4_RMICPGAPIN, 4, 1, 0),
193         SOC_DAPM_SINGLE("IN3_R P Switch", AIC32X4_RMICPGAPIN, 2, 1, 0),
194 };
195
196 static const struct snd_soc_dapm_widget aic32x4_dapm_widgets[] = {
197         SND_SOC_DAPM_DAC("Left DAC", "Left Playback", AIC32X4_DACSETUP, 7, 0),
198         SND_SOC_DAPM_MIXER("HPL Output Mixer", SND_SOC_NOPM, 0, 0,
199                            &hpl_output_mixer_controls[0],
200                            ARRAY_SIZE(hpl_output_mixer_controls)),
201         SND_SOC_DAPM_PGA("HPL Power", AIC32X4_OUTPWRCTL, 5, 0, NULL, 0),
202
203         SND_SOC_DAPM_MIXER("LOL Output Mixer", SND_SOC_NOPM, 0, 0,
204                            &lol_output_mixer_controls[0],
205                            ARRAY_SIZE(lol_output_mixer_controls)),
206         SND_SOC_DAPM_PGA("LOL Power", AIC32X4_OUTPWRCTL, 3, 0, NULL, 0),
207
208         SND_SOC_DAPM_DAC("Right DAC", "Right Playback", AIC32X4_DACSETUP, 6, 0),
209         SND_SOC_DAPM_MIXER("HPR Output Mixer", SND_SOC_NOPM, 0, 0,
210                            &hpr_output_mixer_controls[0],
211                            ARRAY_SIZE(hpr_output_mixer_controls)),
212         SND_SOC_DAPM_PGA("HPR Power", AIC32X4_OUTPWRCTL, 4, 0, NULL, 0),
213         SND_SOC_DAPM_MIXER("LOR Output Mixer", SND_SOC_NOPM, 0, 0,
214                            &lor_output_mixer_controls[0],
215                            ARRAY_SIZE(lor_output_mixer_controls)),
216         SND_SOC_DAPM_PGA("LOR Power", AIC32X4_OUTPWRCTL, 2, 0, NULL, 0),
217         SND_SOC_DAPM_MIXER("Left Input Mixer", SND_SOC_NOPM, 0, 0,
218                            &left_input_mixer_controls[0],
219                            ARRAY_SIZE(left_input_mixer_controls)),
220         SND_SOC_DAPM_MIXER("Right Input Mixer", SND_SOC_NOPM, 0, 0,
221                            &right_input_mixer_controls[0],
222                            ARRAY_SIZE(right_input_mixer_controls)),
223         SND_SOC_DAPM_ADC("Left ADC", "Left Capture", AIC32X4_ADCSETUP, 7, 0),
224         SND_SOC_DAPM_ADC("Right ADC", "Right Capture", AIC32X4_ADCSETUP, 6, 0),
225         SND_SOC_DAPM_MICBIAS("Mic Bias", AIC32X4_MICBIAS, 6, 0),
226
227         SND_SOC_DAPM_OUTPUT("HPL"),
228         SND_SOC_DAPM_OUTPUT("HPR"),
229         SND_SOC_DAPM_OUTPUT("LOL"),
230         SND_SOC_DAPM_OUTPUT("LOR"),
231         SND_SOC_DAPM_INPUT("IN1_L"),
232         SND_SOC_DAPM_INPUT("IN1_R"),
233         SND_SOC_DAPM_INPUT("IN2_L"),
234         SND_SOC_DAPM_INPUT("IN2_R"),
235         SND_SOC_DAPM_INPUT("IN3_L"),
236         SND_SOC_DAPM_INPUT("IN3_R"),
237 };
238
239 static const struct snd_soc_dapm_route aic32x4_dapm_routes[] = {
240         /* Left Output */
241         {"HPL Output Mixer", "L_DAC Switch", "Left DAC"},
242         {"HPL Output Mixer", "IN1_L Switch", "IN1_L"},
243
244         {"HPL Power", NULL, "HPL Output Mixer"},
245         {"HPL", NULL, "HPL Power"},
246
247         {"LOL Output Mixer", "L_DAC Switch", "Left DAC"},
248
249         {"LOL Power", NULL, "LOL Output Mixer"},
250         {"LOL", NULL, "LOL Power"},
251
252         /* Right Output */
253         {"HPR Output Mixer", "R_DAC Switch", "Right DAC"},
254         {"HPR Output Mixer", "IN1_R Switch", "IN1_R"},
255
256         {"HPR Power", NULL, "HPR Output Mixer"},
257         {"HPR", NULL, "HPR Power"},
258
259         {"LOR Output Mixer", "R_DAC Switch", "Right DAC"},
260
261         {"LOR Power", NULL, "LOR Output Mixer"},
262         {"LOR", NULL, "LOR Power"},
263
264         /* Left input */
265         {"Left Input Mixer", "IN1_L P Switch", "IN1_L"},
266         {"Left Input Mixer", "IN2_L P Switch", "IN2_L"},
267         {"Left Input Mixer", "IN3_L P Switch", "IN3_L"},
268
269         {"Left ADC", NULL, "Left Input Mixer"},
270
271         /* Right Input */
272         {"Right Input Mixer", "IN1_R P Switch", "IN1_R"},
273         {"Right Input Mixer", "IN2_R P Switch", "IN2_R"},
274         {"Right Input Mixer", "IN3_R P Switch", "IN3_R"},
275
276         {"Right ADC", NULL, "Right Input Mixer"},
277 };
278
279 static const struct regmap_range_cfg aic32x4_regmap_pages[] = {
280         {
281                 .selector_reg = 0,
282                 .selector_mask  = 0xff,
283                 .window_start = 0,
284                 .window_len = 128,
285                 .range_min = 0,
286                 .range_max = AIC32X4_RMICPGAVOL,
287         },
288 };
289
290 static const struct regmap_config aic32x4_regmap = {
291         .reg_bits = 8,
292         .val_bits = 8,
293
294         .max_register = AIC32X4_RMICPGAVOL,
295         .ranges = aic32x4_regmap_pages,
296         .num_ranges = ARRAY_SIZE(aic32x4_regmap_pages),
297 };
298
299 static inline int aic32x4_get_divs(int mclk, int rate)
300 {
301         int i;
302
303         for (i = 0; i < ARRAY_SIZE(aic32x4_divs); i++) {
304                 if ((aic32x4_divs[i].rate == rate)
305                     && (aic32x4_divs[i].mclk == mclk)) {
306                         return i;
307                 }
308         }
309         printk(KERN_ERR "aic32x4: master clock and sample rate is not supported\n");
310         return -EINVAL;
311 }
312
313 static int aic32x4_set_dai_sysclk(struct snd_soc_dai *codec_dai,
314                                   int clk_id, unsigned int freq, int dir)
315 {
316         struct snd_soc_codec *codec = codec_dai->codec;
317         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
318
319         switch (freq) {
320         case AIC32X4_FREQ_12000000:
321         case AIC32X4_FREQ_24000000:
322         case AIC32X4_FREQ_25000000:
323                 aic32x4->sysclk = freq;
324                 return 0;
325         }
326         printk(KERN_ERR "aic32x4: invalid frequency to set DAI system clock\n");
327         return -EINVAL;
328 }
329
330 static int aic32x4_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
331 {
332         struct snd_soc_codec *codec = codec_dai->codec;
333         u8 iface_reg_1;
334         u8 iface_reg_2;
335         u8 iface_reg_3;
336
337         iface_reg_1 = snd_soc_read(codec, AIC32X4_IFACE1);
338         iface_reg_1 = iface_reg_1 & ~(3 << 6 | 3 << 2);
339         iface_reg_2 = snd_soc_read(codec, AIC32X4_IFACE2);
340         iface_reg_2 = 0;
341         iface_reg_3 = snd_soc_read(codec, AIC32X4_IFACE3);
342         iface_reg_3 = iface_reg_3 & ~(1 << 3);
343
344         /* set master/slave audio interface */
345         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
346         case SND_SOC_DAIFMT_CBM_CFM:
347                 iface_reg_1 |= AIC32X4_BCLKMASTER | AIC32X4_WCLKMASTER;
348                 break;
349         case SND_SOC_DAIFMT_CBS_CFS:
350                 break;
351         default:
352                 printk(KERN_ERR "aic32x4: invalid DAI master/slave interface\n");
353                 return -EINVAL;
354         }
355
356         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
357         case SND_SOC_DAIFMT_I2S:
358                 break;
359         case SND_SOC_DAIFMT_DSP_A:
360                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
361                 iface_reg_3 |= (1 << 3); /* invert bit clock */
362                 iface_reg_2 = 0x01; /* add offset 1 */
363                 break;
364         case SND_SOC_DAIFMT_DSP_B:
365                 iface_reg_1 |= (AIC32X4_DSP_MODE << AIC32X4_PLLJ_SHIFT);
366                 iface_reg_3 |= (1 << 3); /* invert bit clock */
367                 break;
368         case SND_SOC_DAIFMT_RIGHT_J:
369                 iface_reg_1 |=
370                         (AIC32X4_RIGHT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
371                 break;
372         case SND_SOC_DAIFMT_LEFT_J:
373                 iface_reg_1 |=
374                         (AIC32X4_LEFT_JUSTIFIED_MODE << AIC32X4_PLLJ_SHIFT);
375                 break;
376         default:
377                 printk(KERN_ERR "aic32x4: invalid DAI interface format\n");
378                 return -EINVAL;
379         }
380
381         snd_soc_write(codec, AIC32X4_IFACE1, iface_reg_1);
382         snd_soc_write(codec, AIC32X4_IFACE2, iface_reg_2);
383         snd_soc_write(codec, AIC32X4_IFACE3, iface_reg_3);
384         return 0;
385 }
386
387 static int aic32x4_hw_params(struct snd_pcm_substream *substream,
388                              struct snd_pcm_hw_params *params,
389                              struct snd_soc_dai *dai)
390 {
391         struct snd_soc_codec *codec = dai->codec;
392         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
393         u8 data;
394         int i;
395
396         i = aic32x4_get_divs(aic32x4->sysclk, params_rate(params));
397         if (i < 0) {
398                 printk(KERN_ERR "aic32x4: sampling rate not supported\n");
399                 return i;
400         }
401
402         /* Use PLL as CODEC_CLKIN and DAC_MOD_CLK as BDIV_CLKIN */
403         snd_soc_write(codec, AIC32X4_CLKMUX, AIC32X4_PLLCLKIN);
404         snd_soc_write(codec, AIC32X4_IFACE3, AIC32X4_DACMOD2BCLK);
405
406         /* We will fix R value to 1 and will make P & J=K.D as varialble */
407         data = snd_soc_read(codec, AIC32X4_PLLPR);
408         data &= ~(7 << 4);
409         snd_soc_write(codec, AIC32X4_PLLPR,
410                       (data | (aic32x4_divs[i].p_val << 4) | 0x01));
411
412         snd_soc_write(codec, AIC32X4_PLLJ, aic32x4_divs[i].pll_j);
413
414         snd_soc_write(codec, AIC32X4_PLLDMSB, (aic32x4_divs[i].pll_d >> 8));
415         snd_soc_write(codec, AIC32X4_PLLDLSB,
416                       (aic32x4_divs[i].pll_d & 0xff));
417
418         /* NDAC divider value */
419         data = snd_soc_read(codec, AIC32X4_NDAC);
420         data &= ~(0x7f);
421         snd_soc_write(codec, AIC32X4_NDAC, data | aic32x4_divs[i].ndac);
422
423         /* MDAC divider value */
424         data = snd_soc_read(codec, AIC32X4_MDAC);
425         data &= ~(0x7f);
426         snd_soc_write(codec, AIC32X4_MDAC, data | aic32x4_divs[i].mdac);
427
428         /* DOSR MSB & LSB values */
429         snd_soc_write(codec, AIC32X4_DOSRMSB, aic32x4_divs[i].dosr >> 8);
430         snd_soc_write(codec, AIC32X4_DOSRLSB,
431                       (aic32x4_divs[i].dosr & 0xff));
432
433         /* NADC divider value */
434         data = snd_soc_read(codec, AIC32X4_NADC);
435         data &= ~(0x7f);
436         snd_soc_write(codec, AIC32X4_NADC, data | aic32x4_divs[i].nadc);
437
438         /* MADC divider value */
439         data = snd_soc_read(codec, AIC32X4_MADC);
440         data &= ~(0x7f);
441         snd_soc_write(codec, AIC32X4_MADC, data | aic32x4_divs[i].madc);
442
443         /* AOSR value */
444         snd_soc_write(codec, AIC32X4_AOSR, aic32x4_divs[i].aosr);
445
446         /* BCLK N divider */
447         data = snd_soc_read(codec, AIC32X4_BCLKN);
448         data &= ~(0x7f);
449         snd_soc_write(codec, AIC32X4_BCLKN, data | aic32x4_divs[i].blck_N);
450
451         data = snd_soc_read(codec, AIC32X4_IFACE1);
452         data = data & ~(3 << 4);
453         switch (params_width(params)) {
454         case 16:
455                 break;
456         case 20:
457                 data |= (AIC32X4_WORD_LEN_20BITS << AIC32X4_DOSRMSB_SHIFT);
458                 break;
459         case 24:
460                 data |= (AIC32X4_WORD_LEN_24BITS << AIC32X4_DOSRMSB_SHIFT);
461                 break;
462         case 32:
463                 data |= (AIC32X4_WORD_LEN_32BITS << AIC32X4_DOSRMSB_SHIFT);
464                 break;
465         }
466         snd_soc_write(codec, AIC32X4_IFACE1, data);
467
468         if (params_channels(params) == 1) {
469                 data = AIC32X4_RDAC2LCHN | AIC32X4_LDAC2LCHN;
470         } else {
471                 if (aic32x4->swapdacs)
472                         data = AIC32X4_RDAC2LCHN | AIC32X4_LDAC2RCHN;
473                 else
474                         data = AIC32X4_LDAC2LCHN | AIC32X4_RDAC2RCHN;
475         }
476         snd_soc_update_bits(codec, AIC32X4_DACSETUP, AIC32X4_DAC_CHAN_MASK,
477                         data);
478
479         return 0;
480 }
481
482 static int aic32x4_mute(struct snd_soc_dai *dai, int mute)
483 {
484         struct snd_soc_codec *codec = dai->codec;
485         u8 dac_reg;
486
487         dac_reg = snd_soc_read(codec, AIC32X4_DACMUTE) & ~AIC32X4_MUTEON;
488         if (mute)
489                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg | AIC32X4_MUTEON);
490         else
491                 snd_soc_write(codec, AIC32X4_DACMUTE, dac_reg);
492         return 0;
493 }
494
495 static int aic32x4_set_bias_level(struct snd_soc_codec *codec,
496                                   enum snd_soc_bias_level level)
497 {
498         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
499         int ret;
500
501         switch (level) {
502         case SND_SOC_BIAS_ON:
503                 /* Switch on master clock */
504                 ret = clk_prepare_enable(aic32x4->mclk);
505                 if (ret) {
506                         dev_err(codec->dev, "Failed to enable master clock\n");
507                         return ret;
508                 }
509
510                 /* Switch on PLL */
511                 snd_soc_update_bits(codec, AIC32X4_PLLPR,
512                                     AIC32X4_PLLEN, AIC32X4_PLLEN);
513
514                 /* Switch on NDAC Divider */
515                 snd_soc_update_bits(codec, AIC32X4_NDAC,
516                                     AIC32X4_NDACEN, AIC32X4_NDACEN);
517
518                 /* Switch on MDAC Divider */
519                 snd_soc_update_bits(codec, AIC32X4_MDAC,
520                                     AIC32X4_MDACEN, AIC32X4_MDACEN);
521
522                 /* Switch on NADC Divider */
523                 snd_soc_update_bits(codec, AIC32X4_NADC,
524                                     AIC32X4_NADCEN, AIC32X4_NADCEN);
525
526                 /* Switch on MADC Divider */
527                 snd_soc_update_bits(codec, AIC32X4_MADC,
528                                     AIC32X4_MADCEN, AIC32X4_MADCEN);
529
530                 /* Switch on BCLK_N Divider */
531                 snd_soc_update_bits(codec, AIC32X4_BCLKN,
532                                     AIC32X4_BCLKEN, AIC32X4_BCLKEN);
533                 break;
534         case SND_SOC_BIAS_PREPARE:
535                 break;
536         case SND_SOC_BIAS_STANDBY:
537                 /* Switch off BCLK_N Divider */
538                 snd_soc_update_bits(codec, AIC32X4_BCLKN,
539                                     AIC32X4_BCLKEN, 0);
540
541                 /* Switch off MADC Divider */
542                 snd_soc_update_bits(codec, AIC32X4_MADC,
543                                     AIC32X4_MADCEN, 0);
544
545                 /* Switch off NADC Divider */
546                 snd_soc_update_bits(codec, AIC32X4_NADC,
547                                     AIC32X4_NADCEN, 0);
548
549                 /* Switch off MDAC Divider */
550                 snd_soc_update_bits(codec, AIC32X4_MDAC,
551                                     AIC32X4_MDACEN, 0);
552
553                 /* Switch off NDAC Divider */
554                 snd_soc_update_bits(codec, AIC32X4_NDAC,
555                                     AIC32X4_NDACEN, 0);
556
557                 /* Switch off PLL */
558                 snd_soc_update_bits(codec, AIC32X4_PLLPR,
559                                     AIC32X4_PLLEN, 0);
560
561                 /* Switch off master clock */
562                 clk_disable_unprepare(aic32x4->mclk);
563                 break;
564         case SND_SOC_BIAS_OFF:
565                 break;
566         }
567         codec->dapm.bias_level = level;
568         return 0;
569 }
570
571 #define AIC32X4_RATES   SNDRV_PCM_RATE_8000_48000
572 #define AIC32X4_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE \
573                          | SNDRV_PCM_FMTBIT_S24_3LE | SNDRV_PCM_FMTBIT_S32_LE)
574
575 static const struct snd_soc_dai_ops aic32x4_ops = {
576         .hw_params = aic32x4_hw_params,
577         .digital_mute = aic32x4_mute,
578         .set_fmt = aic32x4_set_dai_fmt,
579         .set_sysclk = aic32x4_set_dai_sysclk,
580 };
581
582 static struct snd_soc_dai_driver aic32x4_dai = {
583         .name = "tlv320aic32x4-hifi",
584         .playback = {
585                      .stream_name = "Playback",
586                      .channels_min = 1,
587                      .channels_max = 2,
588                      .rates = AIC32X4_RATES,
589                      .formats = AIC32X4_FORMATS,},
590         .capture = {
591                     .stream_name = "Capture",
592                     .channels_min = 1,
593                     .channels_max = 2,
594                     .rates = AIC32X4_RATES,
595                     .formats = AIC32X4_FORMATS,},
596         .ops = &aic32x4_ops,
597         .symmetric_rates = 1,
598 };
599
600 static int aic32x4_probe(struct snd_soc_codec *codec)
601 {
602         struct aic32x4_priv *aic32x4 = snd_soc_codec_get_drvdata(codec);
603         u32 tmp_reg;
604
605         if (gpio_is_valid(aic32x4->rstn_gpio)) {
606                 ndelay(10);
607                 gpio_set_value(aic32x4->rstn_gpio, 1);
608         }
609
610         snd_soc_write(codec, AIC32X4_RESET, 0x01);
611
612         /* Power platform configuration */
613         if (aic32x4->power_cfg & AIC32X4_PWR_MICBIAS_2075_LDOIN) {
614                 snd_soc_write(codec, AIC32X4_MICBIAS, AIC32X4_MICBIAS_LDOIN |
615                                                       AIC32X4_MICBIAS_2075V);
616         }
617         if (aic32x4->power_cfg & AIC32X4_PWR_AVDD_DVDD_WEAK_DISABLE)
618                 snd_soc_write(codec, AIC32X4_PWRCFG, AIC32X4_AVDDWEAKDISABLE);
619
620         tmp_reg = (aic32x4->power_cfg & AIC32X4_PWR_AIC32X4_LDO_ENABLE) ?
621                         AIC32X4_LDOCTLEN : 0;
622         snd_soc_write(codec, AIC32X4_LDOCTL, tmp_reg);
623
624         tmp_reg = snd_soc_read(codec, AIC32X4_CMMODE);
625         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_LDOIN_RANGE_18_36)
626                 tmp_reg |= AIC32X4_LDOIN_18_36;
627         if (aic32x4->power_cfg & AIC32X4_PWR_CMMODE_HP_LDOIN_POWERED)
628                 tmp_reg |= AIC32X4_LDOIN2HP;
629         snd_soc_write(codec, AIC32X4_CMMODE, tmp_reg);
630
631         /* Mic PGA routing */
632         if (aic32x4->micpga_routing & AIC32X4_MICPGA_ROUTE_LMIC_IN2R_10K)
633                 snd_soc_write(codec, AIC32X4_LMICPGANIN,
634                                 AIC32X4_LMICPGANIN_IN2R_10K);
635         else
636                 snd_soc_write(codec, AIC32X4_LMICPGANIN,
637                                 AIC32X4_LMICPGANIN_CM1L_10K);
638         if (aic32x4->micpga_routing & AIC32X4_MICPGA_ROUTE_RMIC_IN1L_10K)
639                 snd_soc_write(codec, AIC32X4_RMICPGANIN,
640                                 AIC32X4_RMICPGANIN_IN1L_10K);
641         else
642                 snd_soc_write(codec, AIC32X4_RMICPGANIN,
643                                 AIC32X4_RMICPGANIN_CM1R_10K);
644
645         /*
646          * Workaround: for an unknown reason, the ADC needs to be powered up
647          * and down for the first capture to work properly. It seems related to
648          * a HW BUG or some kind of behavior not documented in the datasheet.
649          */
650         tmp_reg = snd_soc_read(codec, AIC32X4_ADCSETUP);
651         snd_soc_write(codec, AIC32X4_ADCSETUP, tmp_reg |
652                                 AIC32X4_LADC_EN | AIC32X4_RADC_EN);
653         snd_soc_write(codec, AIC32X4_ADCSETUP, tmp_reg);
654
655         return 0;
656 }
657
658 static struct snd_soc_codec_driver soc_codec_dev_aic32x4 = {
659         .probe = aic32x4_probe,
660         .set_bias_level = aic32x4_set_bias_level,
661         .suspend_bias_off = true,
662
663         .controls = aic32x4_snd_controls,
664         .num_controls = ARRAY_SIZE(aic32x4_snd_controls),
665         .dapm_widgets = aic32x4_dapm_widgets,
666         .num_dapm_widgets = ARRAY_SIZE(aic32x4_dapm_widgets),
667         .dapm_routes = aic32x4_dapm_routes,
668         .num_dapm_routes = ARRAY_SIZE(aic32x4_dapm_routes),
669 };
670
671 static int aic32x4_parse_dt(struct aic32x4_priv *aic32x4,
672                 struct device_node *np)
673 {
674         aic32x4->swapdacs = false;
675         aic32x4->micpga_routing = 0;
676         aic32x4->rstn_gpio = of_get_named_gpio(np, "reset-gpios", 0);
677
678         return 0;
679 }
680
681 static void aic32x4_disable_regulators(struct aic32x4_priv *aic32x4)
682 {
683         regulator_disable(aic32x4->supply_iov);
684
685         if (!IS_ERR(aic32x4->supply_ldo))
686                 regulator_disable(aic32x4->supply_ldo);
687
688         if (!IS_ERR(aic32x4->supply_dv))
689                 regulator_disable(aic32x4->supply_dv);
690
691         if (!IS_ERR(aic32x4->supply_av))
692                 regulator_disable(aic32x4->supply_av);
693 }
694
695 static int aic32x4_setup_regulators(struct device *dev,
696                 struct aic32x4_priv *aic32x4)
697 {
698         int ret = 0;
699
700         aic32x4->supply_ldo = devm_regulator_get_optional(dev, "ldoin");
701         aic32x4->supply_iov = devm_regulator_get(dev, "iov");
702         aic32x4->supply_dv = devm_regulator_get_optional(dev, "dv");
703         aic32x4->supply_av = devm_regulator_get_optional(dev, "av");
704
705         /* Check if the regulator requirements are fulfilled */
706
707         if (IS_ERR(aic32x4->supply_iov)) {
708                 dev_err(dev, "Missing supply 'iov'\n");
709                 return PTR_ERR(aic32x4->supply_iov);
710         }
711
712         if (IS_ERR(aic32x4->supply_ldo)) {
713                 if (PTR_ERR(aic32x4->supply_ldo) == -EPROBE_DEFER)
714                         return -EPROBE_DEFER;
715
716                 if (IS_ERR(aic32x4->supply_dv)) {
717                         dev_err(dev, "Missing supply 'dv' or 'ldoin'\n");
718                         return PTR_ERR(aic32x4->supply_dv);
719                 }
720                 if (IS_ERR(aic32x4->supply_av)) {
721                         dev_err(dev, "Missing supply 'av' or 'ldoin'\n");
722                         return PTR_ERR(aic32x4->supply_av);
723                 }
724         } else {
725                 if (IS_ERR(aic32x4->supply_dv) &&
726                                 PTR_ERR(aic32x4->supply_dv) == -EPROBE_DEFER)
727                         return -EPROBE_DEFER;
728                 if (IS_ERR(aic32x4->supply_av) &&
729                                 PTR_ERR(aic32x4->supply_av) == -EPROBE_DEFER)
730                         return -EPROBE_DEFER;
731         }
732
733         ret = regulator_enable(aic32x4->supply_iov);
734         if (ret) {
735                 dev_err(dev, "Failed to enable regulator iov\n");
736                 return ret;
737         }
738
739         if (!IS_ERR(aic32x4->supply_ldo)) {
740                 ret = regulator_enable(aic32x4->supply_ldo);
741                 if (ret) {
742                         dev_err(dev, "Failed to enable regulator ldo\n");
743                         goto error_ldo;
744                 }
745         }
746
747         if (!IS_ERR(aic32x4->supply_dv)) {
748                 ret = regulator_enable(aic32x4->supply_dv);
749                 if (ret) {
750                         dev_err(dev, "Failed to enable regulator dv\n");
751                         goto error_dv;
752                 }
753         }
754
755         if (!IS_ERR(aic32x4->supply_av)) {
756                 ret = regulator_enable(aic32x4->supply_av);
757                 if (ret) {
758                         dev_err(dev, "Failed to enable regulator av\n");
759                         goto error_av;
760                 }
761         }
762
763         if (!IS_ERR(aic32x4->supply_ldo) && IS_ERR(aic32x4->supply_av))
764                 aic32x4->power_cfg |= AIC32X4_PWR_AIC32X4_LDO_ENABLE;
765
766         return 0;
767
768 error_av:
769         if (!IS_ERR(aic32x4->supply_dv))
770                 regulator_disable(aic32x4->supply_dv);
771
772 error_dv:
773         if (!IS_ERR(aic32x4->supply_ldo))
774                 regulator_disable(aic32x4->supply_ldo);
775
776 error_ldo:
777         regulator_disable(aic32x4->supply_iov);
778         return ret;
779 }
780
781 static int aic32x4_i2c_probe(struct i2c_client *i2c,
782                              const struct i2c_device_id *id)
783 {
784         struct aic32x4_pdata *pdata = i2c->dev.platform_data;
785         struct aic32x4_priv *aic32x4;
786         struct device_node *np = i2c->dev.of_node;
787         int ret;
788
789         aic32x4 = devm_kzalloc(&i2c->dev, sizeof(struct aic32x4_priv),
790                                GFP_KERNEL);
791         if (aic32x4 == NULL)
792                 return -ENOMEM;
793
794         aic32x4->regmap = devm_regmap_init_i2c(i2c, &aic32x4_regmap);
795         if (IS_ERR(aic32x4->regmap))
796                 return PTR_ERR(aic32x4->regmap);
797
798         i2c_set_clientdata(i2c, aic32x4);
799
800         if (pdata) {
801                 aic32x4->power_cfg = pdata->power_cfg;
802                 aic32x4->swapdacs = pdata->swapdacs;
803                 aic32x4->micpga_routing = pdata->micpga_routing;
804                 aic32x4->rstn_gpio = pdata->rstn_gpio;
805         } else if (np) {
806                 ret = aic32x4_parse_dt(aic32x4, np);
807                 if (ret) {
808                         dev_err(&i2c->dev, "Failed to parse DT node\n");
809                         return ret;
810                 }
811         } else {
812                 aic32x4->power_cfg = 0;
813                 aic32x4->swapdacs = false;
814                 aic32x4->micpga_routing = 0;
815                 aic32x4->rstn_gpio = -1;
816         }
817
818         aic32x4->mclk = devm_clk_get(&i2c->dev, "mclk");
819         if (IS_ERR(aic32x4->mclk)) {
820                 dev_err(&i2c->dev, "Failed getting the mclk. The current implementation does not support the usage of this codec without mclk\n");
821                 return PTR_ERR(aic32x4->mclk);
822         }
823
824         if (gpio_is_valid(aic32x4->rstn_gpio)) {
825                 ret = devm_gpio_request_one(&i2c->dev, aic32x4->rstn_gpio,
826                                 GPIOF_OUT_INIT_LOW, "tlv320aic32x4 rstn");
827                 if (ret != 0)
828                         return ret;
829         }
830
831         ret = aic32x4_setup_regulators(&i2c->dev, aic32x4);
832         if (ret) {
833                 dev_err(&i2c->dev, "Failed to setup regulators\n");
834                 return ret;
835         }
836
837         ret = snd_soc_register_codec(&i2c->dev,
838                         &soc_codec_dev_aic32x4, &aic32x4_dai, 1);
839         if (ret) {
840                 dev_err(&i2c->dev, "Failed to register codec\n");
841                 aic32x4_disable_regulators(aic32x4);
842                 return ret;
843         }
844
845         i2c_set_clientdata(i2c, aic32x4);
846
847         return 0;
848 }
849
850 static int aic32x4_i2c_remove(struct i2c_client *client)
851 {
852         struct aic32x4_priv *aic32x4 = i2c_get_clientdata(client);
853
854         aic32x4_disable_regulators(aic32x4);
855
856         snd_soc_unregister_codec(&client->dev);
857         return 0;
858 }
859
860 static const struct i2c_device_id aic32x4_i2c_id[] = {
861         { "tlv320aic32x4", 0 },
862         { }
863 };
864 MODULE_DEVICE_TABLE(i2c, aic32x4_i2c_id);
865
866 static const struct of_device_id aic32x4_of_id[] = {
867         { .compatible = "ti,tlv320aic32x4", },
868         { /* senitel */ }
869 };
870 MODULE_DEVICE_TABLE(of, aic32x4_of_id);
871
872 static struct i2c_driver aic32x4_i2c_driver = {
873         .driver = {
874                 .name = "tlv320aic32x4",
875                 .owner = THIS_MODULE,
876                 .of_match_table = aic32x4_of_id,
877         },
878         .probe =    aic32x4_i2c_probe,
879         .remove =   aic32x4_i2c_remove,
880         .id_table = aic32x4_i2c_id,
881 };
882
883 module_i2c_driver(aic32x4_i2c_driver);
884
885 MODULE_DESCRIPTION("ASoC tlv320aic32x4 codec driver");
886 MODULE_AUTHOR("Javier Martin <javier.martin@vista-silicon.com>");
887 MODULE_LICENSE("GPL");