asoc: codecs: rt5639: switch codec system clock
[linux-2.6.git] / sound / soc / codecs / rt5639.c
1 /*
2  * rt5639.c  --  RT5639 ALSA SoC audio codec driver
3  *
4  * Copyright (c) 2011-2013 REALTEK SEMICONDUCTOR CORP. All rights reserved.
5  * Author: Johnny Hsu <johnnyhsu@realtek.com>
6  *
7  * Copyright (c) 2013, NVIDIA CORPORATION.  All rights reserved.
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
14 #include <linux/module.h>
15 #include <linux/moduleparam.h>
16 #include <linux/init.h>
17 #include <linux/delay.h>
18 #include <linux/pm.h>
19 #include <linux/i2c.h>
20 #include <linux/platform_device.h>
21 #include <linux/spi/spi.h>
22 #include <sound/core.h>
23 #include <sound/pcm.h>
24 #include <sound/pcm_params.h>
25 #include <sound/soc.h>
26 #include <sound/soc-dapm.h>
27 #include <sound/initval.h>
28 #include <sound/tlv.h>
29
30 #define RTK_IOCTL
31 #ifdef RTK_IOCTL
32 #if defined(CONFIG_SND_HWDEP) || defined(CONFIG_SND_HWDEP_MODULE)
33 #include "rt56xx_ioctl.h"
34 #include "rt5639_ioctl.h"
35 #endif
36 #endif
37
38 #include "rt5639.h"
39
40 #define RT5639_REG_RW 0 /* for debug */
41 #define RT5639_DET_EXT_MIC 0
42 #define USE_ONEBIT_DEPOP 1 /* for one bit depop */
43 /* #define USE_EQ */
44 #define VERSION "0.8.5 alsa 1.0.24"
45
46 struct rt5639_init_reg {
47         u8 reg;
48         u16 val;
49 };
50
51 static struct rt5639_init_reg init_list[] = {
52         {RT5639_GEN_CTRL1       , 0x3f01},/* fa[12:13] = 1'b;
53                                              fa[8~11]=1; fa[0]=1 */
54         {RT5639_ADDA_CLK1       , 0x1114},/* 73[2] = 1'b */
55         {RT5639_MICBIAS         , 0x3030},/* 93[5:4] = 11'b */
56         {RT5639_CLS_D_OUT       , 0xa000},/* 8d[11] = 0'b */
57         {RT5639_CLS_D_OVCD      , 0x0334},/* 8c[8] = 1'b */
58         {RT5639_PRIV_INDEX      , 0x001d},/* PR1d[8] = 1'b; */
59         {RT5639_PRIV_DATA       , 0x0347},
60         {RT5639_PRIV_INDEX      , 0x003d},/* PR3d[12] = 0'b; PR3d[9] = 1'b */
61         {RT5639_PRIV_DATA       , 0x2600},
62         {RT5639_PRIV_INDEX      , 0x0012},/* PR12 = 0aa8'h */
63         {RT5639_PRIV_DATA       , 0x0aa8},
64         {RT5639_PRIV_INDEX      , 0x0014},/* PR14 = 8aaa'h */
65         {RT5639_PRIV_DATA       , 0x8aaa},
66         {RT5639_PRIV_INDEX      , 0x0020},/* PR20 = 6115'h */
67         {RT5639_PRIV_DATA       , 0x6115},
68         {RT5639_PRIV_INDEX      , 0x0023},/* PR23 = 0804'h */
69         {RT5639_PRIV_DATA       , 0x0804},
70         /*{RT5639_PRIV_INDEX    , 0x0015},*//* PR15 = ab00'h */
71         /*{RT5639_PRIV_DATA     , 0xab00},*/
72         /*playback*/
73         {RT5639_STO_DAC_MIXER   , 0x1414},/* Dig inf 1 -> Sto
74                                              DAC mixer -> DACL */
75         {RT5639_OUT_L3_MIXER    , 0x01fe},/* DACL1 -> OUTMIXL */
76         {RT5639_OUT_R3_MIXER    , 0x01fe},/* DACR1 -> OUTMIXR */
77         {RT5639_HP_VOL          , 0x8888},/* OUTMIX -> HPVOL */
78         {RT5639_HPO_MIXER       , 0xc000},/* HPVOL -> HPOLMIX */
79         /*{RT5639_HPO_MIXER     , 0xa000},*//* DAC1 -> HPOLMIX */
80         /*{RT5639_CHARGE_PUMP   , 0x0f00},*/
81         {RT5639_PRIV_INDEX      , 0x0090},
82         {RT5639_PRIV_DATA       , 0x2000},
83         {RT5639_PRIV_INDEX      , 0x0091},
84         {RT5639_PRIV_DATA       , 0x1000},
85         /*{RT5639_HP_CALIB_AMP_DET, 0x0420}*/
86         {RT5639_SPK_L_MIXER     , 0x0036},/* DACL1 -> SPKMIXL */
87         {RT5639_SPK_R_MIXER     , 0x0036},/* DACR1 -> SPKMIXR */
88         {RT5639_SPK_VOL         , 0x8b8b},/* SPKMIX -> SPKVOL */
89         {RT5639_SPO_CLSD_RATIO  , 0x0004},
90         {RT5639_SPO_L_MIXER     , 0xe800},/* SPKVOLL -> SPOLMIX */
91         {RT5639_SPO_R_MIXER     , 0x2800},/* SPKVOLR -> SPORMIX */
92         /*{RT5639_SPO_L_MIXER   , 0xb800},*//* DAC -> SPOLMIX */
93         /*{RT5639_SPO_R_MIXER   , 0x1800},*//* DAC -> SPORMIX */
94         /*{RT5639_I2S1_SDP      , 0xD000},*//* change IIS1 and IIS2 */
95         /*record*/
96         {RT5639_IN1_IN2         , 0x5080},/* IN1 boost 40db and
97                                              differential mode */
98         {RT5639_IN3_IN4         , 0x0500},/* IN2 boost 40db and
99                                              signal ended mode */
100         {RT5639_REC_L2_MIXER    , 0x007d},/* Mic1 -> RECMIXL */
101         {RT5639_REC_R2_MIXER    , 0x007d},/* Mic1 -> RECMIXR */
102         /*{RT5639_REC_L2_MIXER  , 0x006f},*//* Mic2 -> RECMIXL */
103         /*{RT5639_REC_R2_MIXER  , 0x006f},*//* Mic2 -> RECMIXR */
104         {RT5639_STO_ADC_MIXER   , 0x3020},/* ADC -> Sto ADC mixer */
105 #if RT5639_DET_EXT_MIC
106         {RT5639_MICBIAS         , 0x3800},/* enable MICBIAS short current */
107         {RT5639_GPIO_CTRL1      , 0x8400},/* set GPIO1 to IRQ */
108         {RT5639_GPIO_CTRL3      , 0x0004},/* set GPIO1 output */
109         {RT5639_IRQ_CTRL2       , 0x8000},/*set MICBIAS short current to IRQ */
110                                         /*( if sticky set regBE : 8800 ) */
111 #endif
112         {RT5639_JD_CTRL         , 0x6000},/* JD2 as jack detection source */
113 };
114 #define RT5639_INIT_REG_LEN ARRAY_SIZE(init_list)
115
116 static struct rt5639_init_reg irq_jd_init_list[] = {
117    {RT5639_GPIO_CTRL1  , 0x8400},/* set GPIO1 to IRQ */
118    {RT5639_GPIO_CTRL3  , 0x0004},/* set GPIO1 output */
119    {RT5639_IRQ_CTRL1   , 0x8000},/* enable JD IRQ and set active low */
120 };
121 #define RT5639_IRQ_JD_INIT_REG_LEN ARRAY_SIZE(irq_jd_init_list)
122
123 int rt5639_irq_jd_reg_init(struct snd_soc_codec *codec)
124 {
125    int i;
126
127    for (i = 0; i < RT5639_IRQ_JD_INIT_REG_LEN; i++)
128        snd_soc_write(codec, irq_jd_init_list[i].reg, irq_jd_init_list[i].val);
129
130    return 0;
131 }
132
133 static int rt5639_reg_init(struct snd_soc_codec *codec)
134 {
135         int i;
136
137         for (i = 0; i < RT5639_INIT_REG_LEN; i++)
138                 snd_soc_write(codec, init_list[i].reg, init_list[i].val);
139
140         return 0;
141 }
142
143 static int rt5639_index_sync(struct snd_soc_codec *codec)
144 {
145         int i;
146
147         for (i = 0; i < RT5639_INIT_REG_LEN; i++)
148                 if (RT5639_PRIV_INDEX == init_list[i].reg ||
149                         RT5639_PRIV_DATA == init_list[i].reg)
150                         snd_soc_write(codec, init_list[i].reg,
151                                         init_list[i].val);
152         return 0;
153 }
154
155 static const u16 rt5639_reg[RT5639_VENDOR_ID2 + 1] = {
156         [RT5639_RESET] = 0x000c,
157         [RT5639_SPK_VOL] = 0xc8c8,
158         [RT5639_HP_VOL] = 0xc8c8,
159         [RT5639_OUTPUT] = 0xc8c8,
160         [RT5639_MONO_OUT] = 0x8000,
161         [RT5639_INL_INR_VOL] = 0x0808,
162         [RT5639_DAC1_DIG_VOL] = 0xafaf,
163         [RT5639_DAC2_DIG_VOL] = 0xafaf,
164         [RT5639_ADC_DIG_VOL] = 0x2f2f,
165         [RT5639_ADC_DATA] = 0x2f2f,
166         [RT5639_STO_ADC_MIXER] = 0x7060,
167         [RT5639_MONO_ADC_MIXER] = 0x7070,
168         [RT5639_AD_DA_MIXER] = 0x8080,
169         [RT5639_STO_DAC_MIXER] = 0x5454,
170         [RT5639_MONO_DAC_MIXER] = 0x5454,
171         [RT5639_DIG_MIXER] = 0xaa00,
172         [RT5639_DSP_PATH2] = 0xa000,
173         [RT5639_REC_L2_MIXER] = 0x007f,
174         [RT5639_REC_R2_MIXER] = 0x007f,
175         [RT5639_HPO_MIXER] = 0xe000,
176         [RT5639_SPK_L_MIXER] = 0x003e,
177         [RT5639_SPK_R_MIXER] = 0x003e,
178         [RT5639_SPO_L_MIXER] = 0xf800,
179         [RT5639_SPO_R_MIXER] = 0x3800,
180         [RT5639_SPO_CLSD_RATIO] = 0x0004,
181         [RT5639_MONO_MIXER] = 0xfc00,
182         [RT5639_OUT_L3_MIXER] = 0x01ff,
183         [RT5639_OUT_R3_MIXER] = 0x01ff,
184         [RT5639_LOUT_MIXER] = 0xf000,
185         [RT5639_PWR_ANLG1] = 0x00c0,
186         [RT5639_I2S1_SDP] = 0x8000,
187         [RT5639_I2S2_SDP] = 0x8000,
188         [RT5639_I2S3_SDP] = 0x8000,
189         [RT5639_ADDA_CLK1] = 0x1110,
190         [RT5639_ADDA_CLK2] = 0x0c00,
191         [RT5639_DMIC] = 0x1d00,
192         [RT5639_ASRC_3] = 0x0008,
193         [RT5639_HP_OVCD] = 0x0600,
194         [RT5639_CLS_D_OVCD] = 0x0228,
195         [RT5639_CLS_D_OUT] = 0xa800,
196         [RT5639_DEPOP_M1] = 0x0004,
197         [RT5639_DEPOP_M2] = 0x1100,
198         [RT5639_DEPOP_M3] = 0x0646,
199         [RT5639_CHARGE_PUMP] = 0x0c00,
200         [RT5639_MICBIAS] = 0x3000,
201         [RT5639_EQ_CTRL1] = 0x2080,
202         [RT5639_DRC_AGC_1] = 0x2206,
203         [RT5639_DRC_AGC_2] = 0x1f00,
204         [RT5639_ANC_CTRL1] = 0x034b,
205         [RT5639_ANC_CTRL2] = 0x0066,
206         [RT5639_ANC_CTRL3] = 0x000b,
207         [RT5639_GPIO_CTRL1] = 0x0400,
208         [RT5639_DSP_CTRL3] = 0x2000,
209         [RT5639_BASE_BACK] = 0x0013,
210         [RT5639_MP3_PLUS1] = 0x0680,
211         [RT5639_MP3_PLUS2] = 0x1c17,
212         [RT5639_3D_HP] = 0x8c00,
213         [RT5639_ADJ_HPF] = 0xaa20,
214         [RT5639_HP_CALIB_AMP_DET] = 0x0400,
215         [RT5639_SV_ZCD1] = 0x0809,
216         [RT5639_VENDOR_ID1] = 0x10ec,
217         [RT5639_VENDOR_ID2] = 0x6231,
218         /* [RT5639_PV_DET_SPK_G] = 0xc000, */
219 };
220
221 static int rt5639_reset(struct snd_soc_codec *codec)
222 {
223         return snd_soc_write(codec, RT5639_RESET, 0);
224 }
225
226 /**
227  * rt5639_index_write - Write private register.
228  * @codec: SoC audio codec device.
229  * @reg: Private register index.
230  * @value: Private register Data.
231  *
232  * Modify private register for advanced setting. It can be written through
233  * private index (0x6a) and data (0x6c) register.
234  *
235  * Returns 0 for success or negative error code.
236  */
237 static int rt5639_index_write(struct snd_soc_codec *codec,
238                 unsigned int reg, unsigned int value)
239 {
240         int ret;
241
242         ret = snd_soc_write(codec, RT5639_PRIV_INDEX, reg);
243         if (ret < 0) {
244                 dev_err(codec->dev, "Failed to set private addr: %d\n", ret);
245                 goto err;
246         }
247         ret = snd_soc_write(codec, RT5639_PRIV_DATA, value);
248         if (ret < 0) {
249                 dev_err(codec->dev, "Failed to set private value: %d\n", ret);
250                 goto err;
251         }
252         return 0;
253
254 err:
255         return ret;
256 }
257
258 /**
259  * rt5639_index_read - Read private register.
260  * @codec: SoC audio codec device.
261  * @reg: Private register index.
262  *
263  * Read advanced setting from private register. It can be read through
264  * private index (0x6a) and data (0x6c) register.
265  *
266  * Returns private register value or negative error code.
267  */
268 static unsigned int rt5639_index_read(
269         struct snd_soc_codec *codec, unsigned int reg)
270 {
271         int ret;
272
273         ret = snd_soc_write(codec, RT5639_PRIV_INDEX, reg);
274         if (ret < 0) {
275                 dev_err(codec->dev, "Failed to set private addr: %d\n", ret);
276                 return ret;
277         }
278         return snd_soc_read(codec, RT5639_PRIV_DATA);
279 }
280
281 /**
282  * rt5639_index_update_bits - update private register bits
283  * @codec: audio codec
284  * @reg: Private register index.
285  * @mask: register mask
286  * @value: new value
287  *
288  * Writes new register value.
289  *
290  * Returns 1 for change, 0 for no change, or negative error code.
291  */
292 static int rt5639_index_update_bits(struct snd_soc_codec *codec,
293         unsigned int reg, unsigned int mask, unsigned int value)
294 {
295         unsigned int old, new;
296         int change, ret;
297
298         ret = rt5639_index_read(codec, reg);
299         if (ret < 0) {
300                 dev_err(codec->dev, "Failed to read private reg: %d\n", ret);
301                 goto err;
302         }
303
304         old = ret;
305         new = (old & ~mask) | (value & mask);
306         change = old != new;
307         if (change) {
308                 ret = rt5639_index_write(codec, reg, new);
309                 if (ret < 0) {
310                         dev_err(codec->dev,
311                                 "Failed to write private reg: %d\n", ret);
312                         goto err;
313                 }
314         }
315         return change;
316
317 err:
318         return ret;
319 }
320
321 static int rt5639_volatile_register(
322         struct snd_soc_codec *codec, unsigned int reg)
323 {
324         switch (reg) {
325         case RT5639_RESET:
326         case RT5639_PRIV_DATA:
327         case RT5639_ASRC_5:
328         case RT5639_EQ_CTRL1:
329         case RT5639_DRC_AGC_1:
330         case RT5639_ANC_CTRL1:
331         case RT5639_IRQ_CTRL2:
332         case RT5639_INT_IRQ_ST:
333         case RT5639_DSP_CTRL2:
334         case RT5639_DSP_CTRL3:
335         case RT5639_PGM_REG_ARR1:
336         case RT5639_PGM_REG_ARR3:
337         case RT5639_VENDOR_ID:
338         case RT5639_VENDOR_ID1:
339         case RT5639_VENDOR_ID2:
340                 return 1;
341         default:
342                 return 0;
343         }
344 }
345
346 static int rt5639_readable_register(
347         struct snd_soc_codec *codec, unsigned int reg)
348 {
349         switch (reg) {
350         case RT5639_RESET:
351         case RT5639_SPK_VOL:
352         case RT5639_HP_VOL:
353         case RT5639_OUTPUT:
354         case RT5639_MONO_OUT:
355         case RT5639_IN1_IN2:
356         case RT5639_IN3_IN4:
357         case RT5639_INL_INR_VOL:
358         case RT5639_DAC1_DIG_VOL:
359         case RT5639_DAC2_DIG_VOL:
360         case RT5639_DAC2_CTRL:
361         case RT5639_ADC_DIG_VOL:
362         case RT5639_ADC_DATA:
363         case RT5639_ADC_BST_VOL:
364         case RT5639_STO_ADC_MIXER:
365         case RT5639_MONO_ADC_MIXER:
366         case RT5639_AD_DA_MIXER:
367         case RT5639_STO_DAC_MIXER:
368         case RT5639_MONO_DAC_MIXER:
369         case RT5639_DIG_MIXER:
370         case RT5639_DSP_PATH1:
371         case RT5639_DSP_PATH2:
372         case RT5639_DIG_INF_DATA:
373         case RT5639_REC_L1_MIXER:
374         case RT5639_REC_L2_MIXER:
375         case RT5639_REC_R1_MIXER:
376         case RT5639_REC_R2_MIXER:
377         case RT5639_HPO_MIXER:
378         case RT5639_SPK_L_MIXER:
379         case RT5639_SPK_R_MIXER:
380         case RT5639_SPO_L_MIXER:
381         case RT5639_SPO_R_MIXER:
382         case RT5639_SPO_CLSD_RATIO:
383         case RT5639_MONO_MIXER:
384         case RT5639_OUT_L1_MIXER:
385         case RT5639_OUT_L2_MIXER:
386         case RT5639_OUT_L3_MIXER:
387         case RT5639_OUT_R1_MIXER:
388         case RT5639_OUT_R2_MIXER:
389         case RT5639_OUT_R3_MIXER:
390         case RT5639_LOUT_MIXER:
391         case RT5639_PWR_DIG1:
392         case RT5639_PWR_DIG2:
393         case RT5639_PWR_ANLG1:
394         case RT5639_PWR_ANLG2:
395         case RT5639_PWR_MIXER:
396         case RT5639_PWR_VOL:
397         case RT5639_PRIV_INDEX:
398         case RT5639_PRIV_DATA:
399         case RT5639_I2S1_SDP:
400         case RT5639_I2S2_SDP:
401         case RT5639_I2S3_SDP:
402         case RT5639_ADDA_CLK1:
403         case RT5639_ADDA_CLK2:
404         case RT5639_DMIC:
405         case RT5639_GLB_CLK:
406         case RT5639_PLL_CTRL1:
407         case RT5639_PLL_CTRL2:
408         case RT5639_ASRC_1:
409         case RT5639_ASRC_2:
410         case RT5639_ASRC_3:
411         case RT5639_ASRC_4:
412         case RT5639_ASRC_5:
413         case RT5639_HP_OVCD:
414         case RT5639_CLS_D_OVCD:
415         case RT5639_CLS_D_OUT:
416         case RT5639_DEPOP_M1:
417         case RT5639_DEPOP_M2:
418         case RT5639_DEPOP_M3:
419         case RT5639_CHARGE_PUMP:
420         case RT5639_PV_DET_SPK_G:
421         case RT5639_MICBIAS:
422         case RT5639_EQ_CTRL1:
423         case RT5639_EQ_CTRL2:
424         case RT5639_WIND_FILTER:
425         case RT5639_DRC_AGC_1:
426         case RT5639_DRC_AGC_2:
427         case RT5639_DRC_AGC_3:
428         case RT5639_SVOL_ZC:
429         case RT5639_ANC_CTRL1:
430         case RT5639_ANC_CTRL2:
431         case RT5639_ANC_CTRL3:
432         case RT5639_JD_CTRL:
433         case RT5639_ANC_JD:
434         case RT5639_IRQ_CTRL1:
435         case RT5639_IRQ_CTRL2:
436         case RT5639_INT_IRQ_ST:
437         case RT5639_GPIO_CTRL1:
438         case RT5639_GPIO_CTRL2:
439         case RT5639_GPIO_CTRL3:
440         case RT5639_DSP_CTRL1:
441         case RT5639_DSP_CTRL2:
442         case RT5639_DSP_CTRL3:
443         case RT5639_DSP_CTRL4:
444         case RT5639_PGM_REG_ARR1:
445         case RT5639_PGM_REG_ARR2:
446         case RT5639_PGM_REG_ARR3:
447         case RT5639_PGM_REG_ARR4:
448         case RT5639_PGM_REG_ARR5:
449         case RT5639_SCB_FUNC:
450         case RT5639_SCB_CTRL:
451         case RT5639_BASE_BACK:
452         case RT5639_MP3_PLUS1:
453         case RT5639_MP3_PLUS2:
454         case RT5639_3D_HP:
455         case RT5639_ADJ_HPF:
456         case RT5639_HP_CALIB_AMP_DET:
457         case RT5639_HP_CALIB2:
458         case RT5639_SV_ZCD1:
459         case RT5639_SV_ZCD2:
460         case RT5639_GEN_CTRL1:
461         case RT5639_GEN_CTRL2:
462         case RT5639_GEN_CTRL3:
463         case RT5639_VENDOR_ID:
464         case RT5639_VENDOR_ID1:
465         case RT5639_VENDOR_ID2:
466         case RT5639_DUMMY_PR3F:
467                 return 1;
468         default:
469                 return 0;
470         }
471 }
472
473 static void DC_Calibrate(struct snd_soc_codec *codec)
474 {
475         unsigned int sclk_src;
476
477         sclk_src = snd_soc_read(codec, RT5639_GLB_CLK) &
478                 RT5639_SCLK_SRC_MASK;
479
480         snd_soc_update_bits(codec, RT5639_PWR_ANLG2,
481                 RT5639_PWR_MB1, RT5639_PWR_MB1);
482         snd_soc_update_bits(codec, RT5639_DEPOP_M2,
483                 RT5639_DEPOP_MASK, RT5639_DEPOP_MAN);
484         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
485                 RT5639_HP_CP_MASK | RT5639_HP_SG_MASK | RT5639_HP_CB_MASK,
486                 RT5639_HP_CP_PU | RT5639_HP_SG_DIS | RT5639_HP_CB_PU);
487
488         snd_soc_update_bits(codec, RT5639_GLB_CLK,
489                 RT5639_SCLK_SRC_MASK, 0x2 << RT5639_SCLK_SRC_SFT);
490
491         rt5639_index_write(codec, RT5639_HP_DCC_INT1, 0x9f00);
492         snd_soc_update_bits(codec, RT5639_PWR_ANLG2,
493                 RT5639_PWR_MB1, 0);
494         snd_soc_update_bits(codec, RT5639_GLB_CLK,
495                 RT5639_SCLK_SRC_MASK, sclk_src);
496 }
497
498 /**
499  * rt5639_headset_detect - Detect headset.
500  * @codec: SoC audio codec device.
501  * @jack_insert: Jack insert or not.
502  *
503  * Detect whether is headset or not when jack inserted.
504  *
505  * Returns detect status.
506  */
507 int rt5639_headset_detect(struct snd_soc_codec *codec, int jack_insert)
508 {
509         int jack_type;
510         int sclk_src = 0;
511         int reg63, reg64;
512
513         if (jack_insert) {
514                 reg63 = snd_soc_read(codec, RT5639_PWR_ANLG1);
515                 reg64 = snd_soc_read(codec, RT5639_PWR_ANLG2);
516                 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level) {
517                         snd_soc_write(codec, RT5639_PWR_ANLG1, 0xa814);
518                         snd_soc_write(codec, RT5639_MICBIAS, 0x3830);
519                         snd_soc_write(codec, RT5639_GEN_CTRL1 , 0x3701);
520                         sclk_src = snd_soc_read(codec, RT5639_GLB_CLK) &
521                                 RT5639_SCLK_SRC_MASK;
522                         snd_soc_update_bits(codec, RT5639_GLB_CLK,
523                                 RT5639_SCLK_SRC_MASK,
524                                 0x3 << RT5639_SCLK_SRC_SFT);
525                 }
526                 snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
527                         RT5639_PWR_LDO2, RT5639_PWR_LDO2);
528                 snd_soc_update_bits(codec, RT5639_PWR_ANLG2,
529                         RT5639_PWR_MB1, RT5639_PWR_MB1);
530                 snd_soc_update_bits(codec, RT5639_MICBIAS,
531                         RT5639_MIC1_OVCD_MASK | RT5639_MIC1_OVTH_MASK |
532                         RT5639_PWR_CLK25M_MASK | RT5639_PWR_MB_MASK,
533                         RT5639_MIC1_OVCD_EN | RT5639_MIC1_OVTH_600UA |
534                         RT5639_PWR_MB_PU | RT5639_PWR_CLK25M_PU);
535                 snd_soc_update_bits(codec, RT5639_GEN_CTRL1,
536                         0x1, 0x1);
537                 msleep(500);
538
539                 dev_info(codec->dev, "%s RT5639_PWR_ANLG1(0x%x) = 0x%x\n",
540                         __func__, RT5639_PWR_ANLG1,
541                         snd_soc_read(codec, RT5639_PWR_ANLG1));
542                 dev_info(codec->dev, "%s RT5639_IRQ_CTRL2(0x%x) = 0x%x\n",
543                         __func__, RT5639_IRQ_CTRL2,
544                         snd_soc_read(codec, RT5639_IRQ_CTRL2));
545
546                 if (snd_soc_read(codec, RT5639_IRQ_CTRL2) & 0x8)
547                         jack_type = RT5639_HEADPHO_DET;
548                 else
549                         jack_type = RT5639_HEADSET_DET;
550                 snd_soc_update_bits(codec, RT5639_IRQ_CTRL2,
551                         RT5639_MB1_OC_CLR, 0);
552                 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level)
553                         snd_soc_update_bits(codec, RT5639_GLB_CLK,
554                                 RT5639_SCLK_SRC_MASK, sclk_src);
555                 snd_soc_write(codec, RT5639_PWR_ANLG1, reg63);
556                 snd_soc_write(codec, RT5639_PWR_ANLG2, reg64);
557         } else {
558                 snd_soc_update_bits(codec, RT5639_MICBIAS,
559                         RT5639_MIC1_OVCD_MASK,
560                         RT5639_MIC1_OVCD_DIS);
561
562                 jack_type = RT5639_NO_JACK;
563         }
564         dev_info(codec->dev, "%s jack_type = %d\n", __func__, jack_type);
565
566         return jack_type;
567 }
568 EXPORT_SYMBOL(rt5639_headset_detect);
569
570 static const char * const rt5639_dacr2_src[] = { "TxDC_R", "TxDP_R" };
571
572 static const SOC_ENUM_SINGLE_DECL(rt5639_dacr2_enum, RT5639_DUMMY_PR3F,
573         14, rt5639_dacr2_src);
574 static const struct snd_kcontrol_new rt5639_dacr2_mux =
575         SOC_DAPM_ENUM("Mono dacr source", rt5639_dacr2_enum);
576
577 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -4650, 150, 0);
578 static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -65625, 375, 0);
579 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -3450, 150, 0);
580 static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -17625, 375, 0);
581 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
582
583 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
584 static unsigned int bst_tlv[] = {
585         TLV_DB_RANGE_HEAD(7),
586         0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
587         1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
588         2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
589         3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
590         6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
591         7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
592         8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0),
593 };
594
595 static int rt5639_dmic_get(struct snd_kcontrol *kcontrol,
596                 struct snd_ctl_elem_value *ucontrol)
597 {
598         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
599         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
600
601         ucontrol->value.integer.value[0] = rt5639->dmic_en;
602
603         return 0;
604 }
605
606 static int rt5639_dmic_put(struct snd_kcontrol *kcontrol,
607                 struct snd_ctl_elem_value *ucontrol)
608 {
609         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
610         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
611
612         if (rt5639->dmic_en == ucontrol->value.integer.value[0])
613                 return 0;
614
615         rt5639->dmic_en = ucontrol->value.integer.value[0];
616         switch (rt5639->dmic_en) {
617         case RT5639_DMIC_DIS:
618                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
619                         RT5639_GP2_PIN_MASK | RT5639_GP3_PIN_MASK |
620                         RT5639_GP4_PIN_MASK,
621                         RT5639_GP2_PIN_GPIO2 | RT5639_GP3_PIN_GPIO3 |
622                         RT5639_GP4_PIN_GPIO4);
623                 snd_soc_update_bits(codec, RT5639_DMIC,
624                         RT5639_DMIC_1_DP_MASK | RT5639_DMIC_2_DP_MASK,
625                         RT5639_DMIC_1_DP_GPIO3 | RT5639_DMIC_2_DP_GPIO4);
626                 snd_soc_update_bits(codec, RT5639_DMIC,
627                         RT5639_DMIC_1_EN_MASK | RT5639_DMIC_2_EN_MASK,
628                         RT5639_DMIC_1_DIS | RT5639_DMIC_2_DIS);
629                 break;
630
631         case RT5639_DMIC1:
632                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
633                         RT5639_GP2_PIN_MASK | RT5639_GP3_PIN_MASK,
634                         RT5639_GP2_PIN_DMIC1_SCL | RT5639_GP3_PIN_DMIC1_SDA);
635                 snd_soc_update_bits(codec, RT5639_DMIC,
636                         RT5639_DMIC_1L_LH_MASK | RT5639_DMIC_1R_LH_MASK |
637                         RT5639_DMIC_1_DP_MASK,
638                         RT5639_DMIC_1L_LH_FALLING | RT5639_DMIC_1R_LH_RISING |
639                         RT5639_DMIC_1_DP_IN1P);
640                 snd_soc_update_bits(codec, RT5639_DMIC,
641                         RT5639_DMIC_1_EN_MASK, RT5639_DMIC_1_EN);
642                 break;
643
644         case RT5639_DMIC2:
645                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
646                         RT5639_GP2_PIN_MASK | RT5639_GP4_PIN_MASK,
647                         RT5639_GP2_PIN_DMIC1_SCL | RT5639_GP4_PIN_DMIC2_SDA);
648                 snd_soc_update_bits(codec, RT5639_DMIC,
649                         RT5639_DMIC_2L_LH_MASK | RT5639_DMIC_2R_LH_MASK |
650                         RT5639_DMIC_2_DP_MASK,
651                         RT5639_DMIC_2L_LH_FALLING | RT5639_DMIC_2R_LH_RISING |
652                         RT5639_DMIC_2_DP_IN1N);
653                 snd_soc_update_bits(codec, RT5639_DMIC,
654                         RT5639_DMIC_2_EN_MASK, RT5639_DMIC_2_EN);
655                 break;
656
657         default:
658                 return -EINVAL;
659         }
660
661         return 0;
662 }
663
664
665 /* IN1/IN2 Input Type */
666 static const char *rt5639_input_mode[] = {
667         "Single ended", "Differential"};
668
669 static const SOC_ENUM_SINGLE_DECL(
670         rt5639_in1_mode_enum, RT5639_IN1_IN2,
671         RT5639_IN_SFT1, rt5639_input_mode);
672
673 static const SOC_ENUM_SINGLE_DECL(
674         rt5639_in2_mode_enum, RT5639_IN3_IN4,
675         RT5639_IN_SFT2, rt5639_input_mode);
676
677 /* Interface data select */
678 static const char *rt5639_data_select[] = {
679         "Normal", "Swap", "left copy to right", "right copy to left"};
680
681 static const SOC_ENUM_SINGLE_DECL(rt5639_if1_dac_enum, RT5639_DIG_INF_DATA,
682                                 RT5639_IF1_DAC_SEL_SFT, rt5639_data_select);
683
684 static const SOC_ENUM_SINGLE_DECL(rt5639_if1_adc_enum, RT5639_DIG_INF_DATA,
685                                 RT5639_IF1_ADC_SEL_SFT, rt5639_data_select);
686
687 static const SOC_ENUM_SINGLE_DECL(rt5639_if2_dac_enum, RT5639_DIG_INF_DATA,
688                                 RT5639_IF2_DAC_SEL_SFT, rt5639_data_select);
689
690 static const SOC_ENUM_SINGLE_DECL(rt5639_if2_adc_enum, RT5639_DIG_INF_DATA,
691                                 RT5639_IF2_ADC_SEL_SFT, rt5639_data_select);
692
693 static const SOC_ENUM_SINGLE_DECL(rt5639_if3_dac_enum, RT5639_DIG_INF_DATA,
694                                 RT5639_IF3_DAC_SEL_SFT, rt5639_data_select);
695
696 static const SOC_ENUM_SINGLE_DECL(rt5639_if3_adc_enum, RT5639_DIG_INF_DATA,
697                                 RT5639_IF3_ADC_SEL_SFT, rt5639_data_select);
698
699 /* Class D speaker gain ratio */
700 static const char *rt5639_clsd_spk_ratio[] = {"1.66x", "1.83x", "1.94x", "2x",
701         "2.11x", "2.22x", "2.33x", "2.44x", "2.55x", "2.66x", "2.77x"};
702
703 static const SOC_ENUM_SINGLE_DECL(
704         rt5639_clsd_spk_ratio_enum, RT5639_CLS_D_OUT,
705         RT5639_CLSD_RATIO_SFT, rt5639_clsd_spk_ratio);
706
707 /* DMIC */
708 static const char *rt5639_dmic_mode[] = {"Disable", "DMIC1", "DMIC2"};
709
710 static const SOC_ENUM_SINGLE_DECL(rt5639_dmic_enum, 0, 0, rt5639_dmic_mode);
711
712
713
714 #ifdef RT5639_REG_RW
715 #define REGVAL_MAX 0xffff
716 static unsigned int regctl_addr;
717 static int rt5639_regctl_info(struct snd_kcontrol *kcontrol,
718                         struct snd_ctl_elem_info *uinfo)
719 {
720         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
721         uinfo->count = 2;
722         uinfo->value.integer.min = 0;
723         uinfo->value.integer.max = REGVAL_MAX;
724         return 0;
725 }
726
727 static int rt5639_regctl_get(struct snd_kcontrol *kcontrol,
728                         struct snd_ctl_elem_value *ucontrol)
729 {
730         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
731         ucontrol->value.integer.value[0] = regctl_addr;
732         ucontrol->value.integer.value[1] = snd_soc_read(codec, regctl_addr);
733         return 0;
734 }
735
736 static int rt5639_regctl_put(struct snd_kcontrol *kcontrol,
737                         struct snd_ctl_elem_value *ucontrol)
738 {
739         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
740         regctl_addr = ucontrol->value.integer.value[0];
741         if (ucontrol->value.integer.value[1] <= REGVAL_MAX)
742                 snd_soc_write(codec, regctl_addr, ucontrol->value.integer.value[1]);
743         return 0;
744 }
745 #endif
746
747
748 static int rt5639_vol_rescale_get(struct snd_kcontrol *kcontrol,
749                 struct snd_ctl_elem_value *ucontrol)
750 {
751         struct soc_mixer_control *mc =
752                 (struct soc_mixer_control *)kcontrol->private_value;
753         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
754         unsigned int val = snd_soc_read(codec, mc->reg);
755
756         ucontrol->value.integer.value[0] = RT5639_VOL_RSCL_MAX -
757                 ((val & RT5639_L_VOL_MASK) >> mc->shift);
758         ucontrol->value.integer.value[1] = RT5639_VOL_RSCL_MAX -
759                 (val & RT5639_R_VOL_MASK);
760
761         return 0;
762 }
763
764 static int rt5639_vol_rescale_put(struct snd_kcontrol *kcontrol,
765                 struct snd_ctl_elem_value *ucontrol)
766 {
767         struct soc_mixer_control *mc =
768                 (struct soc_mixer_control *)kcontrol->private_value;
769         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
770         unsigned int val, val2;
771
772         val = RT5639_VOL_RSCL_MAX - ucontrol->value.integer.value[0];
773         val2 = RT5639_VOL_RSCL_MAX - ucontrol->value.integer.value[1];
774         return snd_soc_update_bits_locked(codec, mc->reg, RT5639_L_VOL_MASK |
775                         RT5639_R_VOL_MASK, val << mc->shift | val2);
776 }
777
778
779 static const struct snd_kcontrol_new rt5639_snd_controls[] = {
780         /* Speaker Output Volume */
781         SOC_DOUBLE("Speaker Playback Switch", RT5639_SPK_VOL,
782                 RT5639_L_MUTE_SFT, RT5639_R_MUTE_SFT, 1, 1),
783         SOC_DOUBLE_EXT_TLV("Speaker Playback Volume", RT5639_SPK_VOL,
784                 RT5639_L_VOL_SFT, RT5639_R_VOL_SFT, RT5639_VOL_RSCL_RANGE, 0,
785                 rt5639_vol_rescale_get, rt5639_vol_rescale_put, out_vol_tlv),
786         /* Headphone Output Volume */
787         SOC_DOUBLE("HP Playback Switch", RT5639_HP_VOL,
788                 RT5639_L_MUTE_SFT, RT5639_R_MUTE_SFT, 1, 1),
789         SOC_DOUBLE_EXT_TLV("HP Playback Volume", RT5639_HP_VOL,
790                 RT5639_L_VOL_SFT, RT5639_R_VOL_SFT, RT5639_VOL_RSCL_RANGE, 0,
791                 rt5639_vol_rescale_get, rt5639_vol_rescale_put, out_vol_tlv),
792         /* OUTPUT Control */
793         SOC_DOUBLE("OUT Playback Switch", RT5639_OUTPUT,
794                 RT5639_L_MUTE_SFT, RT5639_R_MUTE_SFT, 1, 1),
795         SOC_DOUBLE("OUT Channel Switch", RT5639_OUTPUT,
796                 RT5639_VOL_L_SFT, RT5639_VOL_R_SFT, 1, 1),
797         SOC_DOUBLE_TLV("OUT Playback Volume", RT5639_OUTPUT,
798                 RT5639_L_VOL_SFT, RT5639_R_VOL_SFT, 39, 1, out_vol_tlv),
799         /* MONO Output Control */
800         SOC_SINGLE("Mono Playback Switch", RT5639_MONO_OUT,
801                                 RT5639_L_MUTE_SFT, 1, 1),
802         /* DAC Digital Volume */
803         SOC_DOUBLE("DAC2 Playback Switch", RT5639_DAC2_CTRL,
804                 RT5639_M_DAC_L2_VOL_SFT, RT5639_M_DAC_R2_VOL_SFT, 1, 1),
805         SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5639_DAC1_DIG_VOL,
806                         RT5639_L_VOL_SFT, RT5639_R_VOL_SFT,
807                         175, 0, dac_vol_tlv),
808         SOC_DOUBLE_TLV("Mono DAC Playback Volume", RT5639_DAC2_DIG_VOL,
809                         RT5639_L_VOL_SFT, RT5639_R_VOL_SFT,
810                         175, 0, dac_vol_tlv),
811         /* IN1/IN2 Control */
812         SOC_ENUM("IN1 Mode Control",  rt5639_in1_mode_enum),
813         SOC_SINGLE_TLV("IN1 Boost", RT5639_IN1_IN2,
814                 RT5639_BST_SFT1, 8, 0, bst_tlv),
815         SOC_ENUM("IN2 Mode Control", rt5639_in2_mode_enum),
816         SOC_SINGLE_TLV("IN2 Boost", RT5639_IN3_IN4,
817                 RT5639_BST_SFT2, 8, 0, bst_tlv),
818         /* INL/INR Volume Control */
819         SOC_DOUBLE_TLV("IN Capture Volume", RT5639_INL_INR_VOL,
820                         RT5639_INL_VOL_SFT, RT5639_INR_VOL_SFT,
821                         31, 1, in_vol_tlv),
822         /* ADC Digital Volume Control */
823         SOC_DOUBLE("ADC Capture Switch", RT5639_ADC_DIG_VOL,
824                 RT5639_L_MUTE_SFT, RT5639_R_MUTE_SFT, 1, 1),
825         SOC_DOUBLE_TLV("ADC Capture Volume", RT5639_ADC_DIG_VOL,
826                         RT5639_L_VOL_SFT, RT5639_R_VOL_SFT,
827                         127, 0, adc_vol_tlv),
828         SOC_DOUBLE_TLV("Mono ADC Capture Volume", RT5639_ADC_DATA,
829                         RT5639_L_VOL_SFT, RT5639_R_VOL_SFT,
830                         127, 0, adc_vol_tlv),
831         /* ADC Boost Volume Control */
832         SOC_DOUBLE_TLV("ADC Boost Gain", RT5639_ADC_BST_VOL,
833                         RT5639_ADC_L_BST_SFT, RT5639_ADC_R_BST_SFT,
834                         3, 0, adc_bst_tlv),
835         /* Class D speaker gain ratio */
836         SOC_ENUM("Class D SPK Ratio Control", rt5639_clsd_spk_ratio_enum),
837         /* DMIC */
838         SOC_ENUM_EXT("DMIC Switch", rt5639_dmic_enum,
839                 rt5639_dmic_get, rt5639_dmic_put),
840
841         SOC_ENUM("ADC IF1 Data Switch", rt5639_if1_adc_enum),
842         SOC_ENUM("DAC IF1 Data Switch", rt5639_if1_dac_enum),
843         SOC_ENUM("ADC IF2 Data Switch", rt5639_if2_adc_enum),
844         SOC_ENUM("DAC IF2 Data Switch", rt5639_if2_dac_enum),
845 #ifdef RT5639_REG_RW
846         {
847                 .iface = SNDRV_CTL_ELEM_IFACE_MIXER,
848                 .name = "Register Control",
849                 .info = rt5639_regctl_info,
850                 .get = rt5639_regctl_get,
851                 .put = rt5639_regctl_put,
852         },
853 #endif
854 };
855
856 /**
857  * set_dmic_clk - Set parameter of dmic.
858  *
859  * @w: DAPM widget.
860  * @kcontrol: The kcontrol of this widget.
861  * @event: Event id.
862  *
863  * Choose dmic clock between 1MHz and 3MHz.
864  * It is better for clock to approximate 3MHz.
865  */
866 static int set_dmic_clk(struct snd_soc_dapm_widget *w,
867         struct snd_kcontrol *kcontrol, int event)
868 {
869         struct snd_soc_codec *codec = w->codec;
870         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
871         int div[] = {2, 3, 4, 6, 12}, idx = -EINVAL, i, rate, red, bound, temp;
872
873         rate = rt5639->lrck[rt5639->aif_pu] << 8;
874         red = 3000000 * 12;
875         for (i = 0; i < ARRAY_SIZE(div); i++) {
876                 bound = div[i] * 3000000;
877                 if (rate > bound)
878                         continue;
879                 temp = bound - rate;
880                 if (temp < red) {
881                         red = temp;
882                         idx = i;
883                 }
884         }
885         if (idx < 0)
886                 dev_err(codec->dev, "Failed to set DMIC clock\n");
887         else
888                 snd_soc_update_bits(codec, RT5639_DMIC, RT5639_DMIC_CLK_MASK,
889                                         idx << RT5639_DMIC_CLK_SFT);
890         return idx;
891 }
892
893 static int check_sysclk1_source(struct snd_soc_dapm_widget *source,
894                          struct snd_soc_dapm_widget *sink)
895 {
896         unsigned int val;
897
898         val = snd_soc_read(source->codec, RT5639_GLB_CLK);
899         val &= RT5639_SCLK_SRC_MASK;
900         if (val == RT5639_SCLK_SRC_PLL1)
901                 return 1;
902         else
903                 return 0;
904 }
905
906 /* Digital Mixer */
907 static const struct snd_kcontrol_new rt5639_sto_adc_l_mix[] = {
908         SOC_DAPM_SINGLE("ADC1 Switch", RT5639_STO_ADC_MIXER,
909                         RT5639_M_ADC_L1_SFT, 1, 1),
910         SOC_DAPM_SINGLE("ADC2 Switch", RT5639_STO_ADC_MIXER,
911                         RT5639_M_ADC_L2_SFT, 1, 1),
912 };
913
914 static const struct snd_kcontrol_new rt5639_sto_adc_r_mix[] = {
915         SOC_DAPM_SINGLE("ADC1 Switch", RT5639_STO_ADC_MIXER,
916                         RT5639_M_ADC_R1_SFT, 1, 1),
917         SOC_DAPM_SINGLE("ADC2 Switch", RT5639_STO_ADC_MIXER,
918                         RT5639_M_ADC_R2_SFT, 1, 1),
919 };
920
921 static const struct snd_kcontrol_new rt5639_mono_adc_l_mix[] = {
922         SOC_DAPM_SINGLE("ADC1 Switch", RT5639_MONO_ADC_MIXER,
923                         RT5639_M_MONO_ADC_L1_SFT, 1, 1),
924         SOC_DAPM_SINGLE("ADC2 Switch", RT5639_MONO_ADC_MIXER,
925                         RT5639_M_MONO_ADC_L2_SFT, 1, 1),
926 };
927
928 static const struct snd_kcontrol_new rt5639_mono_adc_r_mix[] = {
929         SOC_DAPM_SINGLE("ADC1 Switch", RT5639_MONO_ADC_MIXER,
930                         RT5639_M_MONO_ADC_R1_SFT, 1, 1),
931         SOC_DAPM_SINGLE("ADC2 Switch", RT5639_MONO_ADC_MIXER,
932                         RT5639_M_MONO_ADC_R2_SFT, 1, 1),
933 };
934
935 static const struct snd_kcontrol_new rt5639_dac_l_mix[] = {
936         SOC_DAPM_SINGLE("Stereo ADC Switch", RT5639_AD_DA_MIXER,
937                         RT5639_M_ADCMIX_L_SFT, 1, 1),
938         SOC_DAPM_SINGLE("INF1 Switch", RT5639_AD_DA_MIXER,
939                         RT5639_M_IF1_DAC_L_SFT, 1, 1),
940 };
941
942 static const struct snd_kcontrol_new rt5639_dac_r_mix[] = {
943         SOC_DAPM_SINGLE("Stereo ADC Switch", RT5639_AD_DA_MIXER,
944                         RT5639_M_ADCMIX_R_SFT, 1, 1),
945         SOC_DAPM_SINGLE("INF1 Switch", RT5639_AD_DA_MIXER,
946                         RT5639_M_IF1_DAC_R_SFT, 1, 1),
947 };
948
949 static const struct snd_kcontrol_new rt5639_sto_dac_l_mix[] = {
950         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_STO_DAC_MIXER,
951                         RT5639_M_DAC_L1_SFT, 1, 1),
952         SOC_DAPM_SINGLE("DAC L2 Switch", RT5639_STO_DAC_MIXER,
953                         RT5639_M_DAC_L2_SFT, 1, 1),
954         SOC_DAPM_SINGLE("ANC Switch", RT5639_STO_DAC_MIXER,
955                         RT5639_M_ANC_DAC_L_SFT, 1, 1),
956 };
957
958 static const struct snd_kcontrol_new rt5639_sto_dac_r_mix[] = {
959         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_STO_DAC_MIXER,
960                         RT5639_M_DAC_R1_SFT, 1, 1),
961         SOC_DAPM_SINGLE("DAC R2 Switch", RT5639_STO_DAC_MIXER,
962                         RT5639_M_DAC_R2_SFT, 1, 1),
963         SOC_DAPM_SINGLE("ANC Switch", RT5639_STO_DAC_MIXER,
964                         RT5639_M_ANC_DAC_R_SFT, 1, 1),
965 };
966
967 static const struct snd_kcontrol_new rt5639_mono_dac_l_mix[] = {
968         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_MONO_DAC_MIXER,
969                         RT5639_M_DAC_L1_MONO_L_SFT, 1, 1),
970         SOC_DAPM_SINGLE("DAC L2 Switch", RT5639_MONO_DAC_MIXER,
971                         RT5639_M_DAC_L2_MONO_L_SFT, 1, 1),
972         SOC_DAPM_SINGLE("DAC R2 Switch", RT5639_MONO_DAC_MIXER,
973                         RT5639_M_DAC_R2_MONO_L_SFT, 1, 1),
974 };
975
976 static const struct snd_kcontrol_new rt5639_mono_dac_r_mix[] = {
977         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_MONO_DAC_MIXER,
978                         RT5639_M_DAC_R1_MONO_R_SFT, 1, 1),
979         SOC_DAPM_SINGLE("DAC R2 Switch", RT5639_MONO_DAC_MIXER,
980                         RT5639_M_DAC_R2_MONO_R_SFT, 1, 1),
981         SOC_DAPM_SINGLE("DAC L2 Switch", RT5639_MONO_DAC_MIXER,
982                         RT5639_M_DAC_L2_MONO_R_SFT, 1, 1),
983 };
984
985 static const struct snd_kcontrol_new rt5639_dig_l_mix[] = {
986         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_DIG_MIXER,
987                         RT5639_M_STO_L_DAC_L_SFT, 1, 1),
988         SOC_DAPM_SINGLE("DAC L2 Switch", RT5639_DIG_MIXER,
989                         RT5639_M_DAC_L2_DAC_L_SFT, 1, 1),
990 };
991
992 static const struct snd_kcontrol_new rt5639_dig_r_mix[] = {
993         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_DIG_MIXER,
994                         RT5639_M_STO_R_DAC_R_SFT, 1, 1),
995         SOC_DAPM_SINGLE("DAC R2 Switch", RT5639_DIG_MIXER,
996                         RT5639_M_DAC_R2_DAC_R_SFT, 1, 1),
997 };
998
999 /* Analog Input Mixer */
1000 static const struct snd_kcontrol_new rt5639_rec_l_mix[] = {
1001         SOC_DAPM_SINGLE("HPOL Switch", RT5639_REC_L2_MIXER,
1002                         RT5639_M_HP_L_RM_L_SFT, 1, 1),
1003         SOC_DAPM_SINGLE("INL Switch", RT5639_REC_L2_MIXER,
1004                         RT5639_M_IN_L_RM_L_SFT, 1, 1),
1005         SOC_DAPM_SINGLE("BST3 Switch", RT5639_REC_L2_MIXER,
1006                         RT5639_M_BST2_RM_L_SFT, 1, 1),
1007         SOC_DAPM_SINGLE("BST2 Switch", RT5639_REC_L2_MIXER,
1008                         RT5639_M_BST4_RM_L_SFT, 1, 1),
1009         SOC_DAPM_SINGLE("BST1 Switch", RT5639_REC_L2_MIXER,
1010                         RT5639_M_BST1_RM_L_SFT, 1, 1),
1011         SOC_DAPM_SINGLE("OUT MIXL Switch", RT5639_REC_L2_MIXER,
1012                         RT5639_M_OM_L_RM_L_SFT, 1, 1),
1013 };
1014
1015 static const struct snd_kcontrol_new rt5639_rec_r_mix[] = {
1016         SOC_DAPM_SINGLE("HPOR Switch", RT5639_REC_R2_MIXER,
1017                         RT5639_M_HP_R_RM_R_SFT, 1, 1),
1018         SOC_DAPM_SINGLE("INR Switch", RT5639_REC_R2_MIXER,
1019                         RT5639_M_IN_R_RM_R_SFT, 1, 1),
1020         SOC_DAPM_SINGLE("BST3 Switch", RT5639_REC_R2_MIXER,
1021                         RT5639_M_BST2_RM_R_SFT, 1, 1),
1022         SOC_DAPM_SINGLE("BST2 Switch", RT5639_REC_R2_MIXER,
1023                         RT5639_M_BST4_RM_R_SFT, 1, 1),
1024         SOC_DAPM_SINGLE("BST1 Switch", RT5639_REC_R2_MIXER,
1025                         RT5639_M_BST1_RM_R_SFT, 1, 1),
1026         SOC_DAPM_SINGLE("OUT MIXR Switch", RT5639_REC_R2_MIXER,
1027                         RT5639_M_OM_R_RM_R_SFT, 1, 1),
1028 };
1029
1030 /* Analog Output Mixer */
1031 static const struct snd_kcontrol_new rt5639_spk_l_mix[] = {
1032         SOC_DAPM_SINGLE("REC MIXL Switch", RT5639_SPK_L_MIXER,
1033                         RT5639_M_RM_L_SM_L_SFT, 1, 1),
1034         SOC_DAPM_SINGLE("INL Switch", RT5639_SPK_L_MIXER,
1035                         RT5639_M_IN_L_SM_L_SFT, 1, 1),
1036         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_SPK_L_MIXER,
1037                         RT5639_M_DAC_L1_SM_L_SFT, 1, 1),
1038         SOC_DAPM_SINGLE("OUT MIXL Switch", RT5639_SPK_L_MIXER,
1039                         RT5639_M_OM_L_SM_L_SFT, 1, 1),
1040 };
1041
1042 static const struct snd_kcontrol_new rt5639_spk_r_mix[] = {
1043         SOC_DAPM_SINGLE("REC MIXR Switch", RT5639_SPK_R_MIXER,
1044                         RT5639_M_RM_R_SM_R_SFT, 1, 1),
1045         SOC_DAPM_SINGLE("INR Switch", RT5639_SPK_R_MIXER,
1046                         RT5639_M_IN_R_SM_R_SFT, 1, 1),
1047         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_SPK_R_MIXER,
1048                         RT5639_M_DAC_R1_SM_R_SFT, 1, 1),
1049         SOC_DAPM_SINGLE("OUT MIXR Switch", RT5639_SPK_R_MIXER,
1050                         RT5639_M_OM_R_SM_R_SFT, 1, 1),
1051 };
1052
1053 static const struct snd_kcontrol_new rt5639_out_l_mix[] = {
1054         SOC_DAPM_SINGLE("SPK MIXL Switch", RT5639_OUT_L3_MIXER,
1055                         RT5639_M_SM_L_OM_L_SFT, 1, 1),
1056         SOC_DAPM_SINGLE("BST3 Switch", RT5639_OUT_L3_MIXER,
1057                         RT5639_M_BST2_OM_L_SFT, 1, 1),
1058         SOC_DAPM_SINGLE("BST1 Switch", RT5639_OUT_L3_MIXER,
1059                         RT5639_M_BST1_OM_L_SFT, 1, 1),
1060         SOC_DAPM_SINGLE("INL Switch", RT5639_OUT_L3_MIXER,
1061                         RT5639_M_IN_L_OM_L_SFT, 1, 1),
1062         SOC_DAPM_SINGLE("REC MIXL Switch", RT5639_OUT_L3_MIXER,
1063                         RT5639_M_RM_L_OM_L_SFT, 1, 1),
1064         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_OUT_L3_MIXER,
1065                         RT5639_M_DAC_L1_OM_L_SFT, 1, 1),
1066 };
1067
1068 static const struct snd_kcontrol_new rt5639_out_r_mix[] = {
1069         SOC_DAPM_SINGLE("SPK MIXR Switch", RT5639_OUT_R3_MIXER,
1070                         RT5639_M_SM_L_OM_R_SFT, 1, 1),
1071         SOC_DAPM_SINGLE("BST3 Switch", RT5639_OUT_R3_MIXER,
1072                         RT5639_M_BST2_OM_R_SFT, 1, 1),
1073         SOC_DAPM_SINGLE("BST2 Switch", RT5639_OUT_R3_MIXER,
1074                         RT5639_M_BST4_OM_R_SFT, 1, 1),
1075         SOC_DAPM_SINGLE("BST1 Switch", RT5639_OUT_R3_MIXER,
1076                         RT5639_M_BST1_OM_R_SFT, 1, 1),
1077         SOC_DAPM_SINGLE("INR Switch", RT5639_OUT_R3_MIXER,
1078                         RT5639_M_IN_R_OM_R_SFT, 1, 1),
1079         SOC_DAPM_SINGLE("REC MIXR Switch", RT5639_OUT_R3_MIXER,
1080                         RT5639_M_RM_R_OM_R_SFT, 1, 1),
1081         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_OUT_R3_MIXER,
1082                         RT5639_M_DAC_R1_OM_R_SFT, 1, 1),
1083 };
1084
1085 static const struct snd_kcontrol_new rt5639_spo_l_mix[] = {
1086         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_SPO_L_MIXER,
1087                         RT5639_M_DAC_R1_SPM_L_SFT, 1, 1),
1088         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_SPO_L_MIXER,
1089                         RT5639_M_DAC_L1_SPM_L_SFT, 1, 1),
1090         SOC_DAPM_SINGLE("SPKVOL R Switch", RT5639_SPO_L_MIXER,
1091                         RT5639_M_SV_R_SPM_L_SFT, 1, 1),
1092         SOC_DAPM_SINGLE("SPKVOL L Switch", RT5639_SPO_L_MIXER,
1093                         RT5639_M_SV_L_SPM_L_SFT, 1, 1),
1094         SOC_DAPM_SINGLE("BST1 Switch", RT5639_SPO_L_MIXER,
1095                         RT5639_M_BST1_SPM_L_SFT, 1, 1),
1096 };
1097
1098 static const struct snd_kcontrol_new rt5639_spo_r_mix[] = {
1099         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_SPO_R_MIXER,
1100                         RT5639_M_DAC_R1_SPM_R_SFT, 1, 1),
1101         SOC_DAPM_SINGLE("SPKVOL R Switch", RT5639_SPO_R_MIXER,
1102                         RT5639_M_SV_R_SPM_R_SFT, 1, 1),
1103         SOC_DAPM_SINGLE("BST1 Switch", RT5639_SPO_R_MIXER,
1104                         RT5639_M_BST1_SPM_R_SFT, 1, 1),
1105 };
1106
1107 static const struct snd_kcontrol_new rt5639_hpo_mix[] = {
1108         SOC_DAPM_SINGLE("DAC1 Switch", RT5639_HPO_MIXER,
1109                         RT5639_M_DAC1_HM_SFT, 1, 1),
1110         SOC_DAPM_SINGLE("HPVOL Switch", RT5639_HPO_MIXER,
1111                         RT5639_M_HPVOL_HM_SFT, 1, 1),
1112 };
1113
1114 static const struct snd_kcontrol_new rt5639_lout_mix[] = {
1115         SOC_DAPM_SINGLE("DAC L1 Switch", RT5639_LOUT_MIXER,
1116                         RT5639_M_DAC_L1_LM_SFT, 1, 1),
1117         SOC_DAPM_SINGLE("DAC R1 Switch", RT5639_LOUT_MIXER,
1118                         RT5639_M_DAC_R1_LM_SFT, 1, 1),
1119         SOC_DAPM_SINGLE("OUTVOL L Switch", RT5639_LOUT_MIXER,
1120                         RT5639_M_OV_L_LM_SFT, 1, 1),
1121         SOC_DAPM_SINGLE("OUTVOL R Switch", RT5639_LOUT_MIXER,
1122                         RT5639_M_OV_R_LM_SFT, 1, 1),
1123 };
1124
1125
1126 /* INL/R source */
1127 static const char *rt5639_inl_src[] = {"IN2P", "MonoP"};
1128
1129 static const SOC_ENUM_SINGLE_DECL(
1130         rt5639_inl_enum, RT5639_INL_INR_VOL,
1131         RT5639_INL_SEL_SFT, rt5639_inl_src);
1132
1133 static const struct snd_kcontrol_new rt5639_inl_mux =
1134         SOC_DAPM_ENUM("INL source", rt5639_inl_enum);
1135
1136 static const char *rt5639_inr_src[] = {"IN2N", "MonoN"};
1137
1138 static const SOC_ENUM_SINGLE_DECL(
1139         rt5639_inr_enum, RT5639_INL_INR_VOL,
1140         RT5639_INR_SEL_SFT, rt5639_inr_src);
1141
1142 static const struct snd_kcontrol_new rt5639_inr_mux =
1143         SOC_DAPM_ENUM("INR source", rt5639_inr_enum);
1144
1145 /* Stereo ADC source */
1146 static const char *rt5639_stereo_adc1_src[] = {"DIG MIX", "ADC"};
1147
1148 static const SOC_ENUM_SINGLE_DECL(
1149         rt5639_stereo_adc1_enum, RT5639_STO_ADC_MIXER,
1150         RT5639_ADC_1_SRC_SFT, rt5639_stereo_adc1_src);
1151
1152 static const struct snd_kcontrol_new rt5639_sto_adc_l1_mux =
1153         SOC_DAPM_ENUM("Stereo ADC L1 source", rt5639_stereo_adc1_enum);
1154
1155 static const struct snd_kcontrol_new rt5639_sto_adc_r1_mux =
1156         SOC_DAPM_ENUM("Stereo ADC R1 source", rt5639_stereo_adc1_enum);
1157
1158 static const char *rt5639_stereo_adc2_src[] = {"DMIC1", "DMIC2", "DIG MIX"};
1159
1160 static const SOC_ENUM_SINGLE_DECL(
1161         rt5639_stereo_adc2_enum, RT5639_STO_ADC_MIXER,
1162         RT5639_ADC_2_SRC_SFT, rt5639_stereo_adc2_src);
1163
1164 static const struct snd_kcontrol_new rt5639_sto_adc_l2_mux =
1165         SOC_DAPM_ENUM("Stereo ADC L2 source", rt5639_stereo_adc2_enum);
1166
1167 static const struct snd_kcontrol_new rt5639_sto_adc_r2_mux =
1168         SOC_DAPM_ENUM("Stereo ADC R2 source", rt5639_stereo_adc2_enum);
1169
1170 /* Mono ADC source */
1171 static const char *rt5639_mono_adc_l1_src[] = {"Mono DAC MIXL", "ADCL"};
1172
1173 static const SOC_ENUM_SINGLE_DECL(
1174         rt5639_mono_adc_l1_enum, RT5639_MONO_ADC_MIXER,
1175         RT5639_MONO_ADC_L1_SRC_SFT, rt5639_mono_adc_l1_src);
1176
1177 static const struct snd_kcontrol_new rt5639_mono_adc_l1_mux =
1178         SOC_DAPM_ENUM("Mono ADC1 left source", rt5639_mono_adc_l1_enum);
1179
1180 static const char *rt5639_mono_adc_l2_src[] =
1181         {"DMIC L1", "DMIC L2", "Mono DAC MIXL"};
1182
1183 static const SOC_ENUM_SINGLE_DECL(
1184         rt5639_mono_adc_l2_enum, RT5639_MONO_ADC_MIXER,
1185         RT5639_MONO_ADC_L2_SRC_SFT, rt5639_mono_adc_l2_src);
1186
1187 static const struct snd_kcontrol_new rt5639_mono_adc_l2_mux =
1188         SOC_DAPM_ENUM("Mono ADC2 left source", rt5639_mono_adc_l2_enum);
1189
1190 static const char *rt5639_mono_adc_r1_src[] = {"Mono DAC MIXR", "ADCR"};
1191
1192 static const SOC_ENUM_SINGLE_DECL(
1193         rt5639_mono_adc_r1_enum, RT5639_MONO_ADC_MIXER,
1194         RT5639_MONO_ADC_R1_SRC_SFT, rt5639_mono_adc_r1_src);
1195
1196 static const struct snd_kcontrol_new rt5639_mono_adc_r1_mux =
1197         SOC_DAPM_ENUM("Mono ADC1 right source", rt5639_mono_adc_r1_enum);
1198
1199 static const char *rt5639_mono_adc_r2_src[] =
1200         {"DMIC R1", "DMIC R2", "Mono DAC MIXR"};
1201
1202 static const SOC_ENUM_SINGLE_DECL(
1203         rt5639_mono_adc_r2_enum, RT5639_MONO_ADC_MIXER,
1204         RT5639_MONO_ADC_R2_SRC_SFT, rt5639_mono_adc_r2_src);
1205
1206 static const struct snd_kcontrol_new rt5639_mono_adc_r2_mux =
1207         SOC_DAPM_ENUM("Mono ADC2 right source", rt5639_mono_adc_r2_enum);
1208
1209 /* DAC2 channel source */
1210 static const char *rt5639_dac_l2_src[] = {"IF2", "IF3", "TxDC", "Base L/R"};
1211
1212 static const SOC_ENUM_SINGLE_DECL(rt5639_dac_l2_enum, RT5639_DSP_PATH2,
1213                                 RT5639_DAC_L2_SEL_SFT, rt5639_dac_l2_src);
1214
1215 static const struct snd_kcontrol_new rt5639_dac_l2_mux =
1216         SOC_DAPM_ENUM("DAC2 left channel source", rt5639_dac_l2_enum);
1217
1218 static const char *rt5639_dac_r2_src[] = {"IF2", "IF3", "TxDC"};
1219
1220 static const SOC_ENUM_SINGLE_DECL(
1221         rt5639_dac_r2_enum, RT5639_DSP_PATH2,
1222         RT5639_DAC_R2_SEL_SFT, rt5639_dac_r2_src);
1223
1224 static const struct snd_kcontrol_new rt5639_dac_r2_mux =
1225         SOC_DAPM_ENUM("DAC2 right channel source", rt5639_dac_r2_enum);
1226
1227 /* Interface 2  ADC channel source */
1228 static const char *rt5639_if2_adc_l_src[] = {"TxDP", "Mono ADC MIXL"};
1229
1230 static const SOC_ENUM_SINGLE_DECL(rt5639_if2_adc_l_enum, RT5639_DSP_PATH2,
1231                         RT5639_IF2_ADC_L_SEL_SFT, rt5639_if2_adc_l_src);
1232
1233 static const struct snd_kcontrol_new rt5639_if2_adc_l_mux =
1234         SOC_DAPM_ENUM("IF2 ADC left channel source", rt5639_if2_adc_l_enum);
1235
1236 static const char *rt5639_if2_adc_r_src[] = {"TxDP", "Mono ADC MIXR"};
1237
1238 static const SOC_ENUM_SINGLE_DECL(rt5639_if2_adc_r_enum, RT5639_DSP_PATH2,
1239                         RT5639_IF2_ADC_R_SEL_SFT, rt5639_if2_adc_r_src);
1240
1241 static const struct snd_kcontrol_new rt5639_if2_adc_r_mux =
1242         SOC_DAPM_ENUM("IF2 ADC right channel source", rt5639_if2_adc_r_enum);
1243
1244 /* digital interface and iis interface map */
1245 static const char *rt5639_dai_iis_map[] = {"1:1|2:2|3:3", "1:1|2:3|3:2",
1246         "1:3|2:1|3:2", "1:3|2:2|3:1", "1:2|2:3|3:1",
1247         "1:2|2:1|3:3", "1:1|2:1|3:3", "1:2|2:2|3:3"};
1248
1249 static const SOC_ENUM_SINGLE_DECL(
1250         rt5639_dai_iis_map_enum, RT5639_I2S1_SDP,
1251         RT5639_I2S_IF_SFT, rt5639_dai_iis_map);
1252
1253 static const struct snd_kcontrol_new rt5639_dai_mux =
1254         SOC_DAPM_ENUM("DAI select", rt5639_dai_iis_map_enum);
1255
1256 /* SDI select */
1257 static const char *rt5639_sdi_sel[] = {"IF1", "IF2"};
1258
1259 static const SOC_ENUM_SINGLE_DECL(
1260         rt5639_sdi_sel_enum, RT5639_I2S2_SDP,
1261         RT5639_I2S2_SDI_SFT, rt5639_sdi_sel);
1262
1263 static const struct snd_kcontrol_new rt5639_sdi_mux =
1264         SOC_DAPM_ENUM("SDI select", rt5639_sdi_sel_enum);
1265
1266 static int rt5639_adc_event(struct snd_soc_dapm_widget *w,
1267         struct snd_kcontrol *kcontrol, int event)
1268 {
1269         struct snd_soc_codec *codec = w->codec;
1270
1271         switch (event) {
1272         case SND_SOC_DAPM_POST_PMU:
1273                 rt5639_index_update_bits(codec,
1274                         RT5639_CHOP_DAC_ADC, 0x1000, 0x1000);
1275                 break;
1276
1277         case SND_SOC_DAPM_POST_PMD:
1278                 rt5639_index_update_bits(codec,
1279                         RT5639_CHOP_DAC_ADC, 0x1000, 0x0000);
1280                 break;
1281
1282         default:
1283                 return 0;
1284         }
1285
1286         return 0;
1287 }
1288
1289 static int rt5639_mono_adcl_event(struct snd_soc_dapm_widget *w,
1290         struct snd_kcontrol *kcontrol, int event)
1291 {
1292         struct snd_soc_codec *codec = w->codec;
1293
1294         switch (event) {
1295         case SND_SOC_DAPM_POST_PMU:
1296                 snd_soc_update_bits(codec, RT5639_GEN_CTRL1,
1297                         RT5639_M_MAMIX_L, 0);
1298                 break;
1299         case SND_SOC_DAPM_PRE_PMD:
1300                 snd_soc_update_bits(codec, RT5639_GEN_CTRL1,
1301                         RT5639_M_MAMIX_L,
1302                         RT5639_M_MAMIX_L);
1303                 break;
1304
1305         default:
1306                 return 0;
1307         }
1308
1309         return 0;
1310 }
1311
1312 static int rt5639_mono_adcr_event(struct snd_soc_dapm_widget *w,
1313         struct snd_kcontrol *kcontrol, int event)
1314 {
1315         struct snd_soc_codec *codec = w->codec;
1316
1317         switch (event) {
1318         case SND_SOC_DAPM_POST_PMU:
1319                 snd_soc_update_bits(codec, RT5639_GEN_CTRL1,
1320                         RT5639_M_MAMIX_R, 0);
1321                 break;
1322         case SND_SOC_DAPM_PRE_PMD:
1323                 snd_soc_update_bits(codec, RT5639_GEN_CTRL1,
1324                         RT5639_M_MAMIX_R,
1325                         RT5639_M_MAMIX_R);
1326                 break;
1327
1328         default:
1329                 return 0;
1330         }
1331
1332         return 0;
1333 }
1334
1335 static int rt5639_spk_event(struct snd_soc_dapm_widget *w,
1336                 struct snd_kcontrol *kcontrol, int event)
1337 {
1338         struct snd_soc_codec *codec = w->codec;
1339
1340         switch (event) {
1341         case SND_SOC_DAPM_POST_PMU:
1342 #ifdef USE_EQ
1343                 rt5639_update_eqmode(codec, SPK);
1344 #endif
1345                 snd_soc_update_bits(codec, RT5639_PWR_DIG1,
1346                         RT5639_PWR_CLS_D, RT5639_PWR_CLS_D);
1347                 rt5639_index_update_bits(codec,
1348                         RT5639_CLSD_INT_REG1, 0xf000, 0xf000);
1349                 snd_soc_update_bits(codec, RT5639_SPK_VOL,
1350                         RT5639_L_MUTE | RT5639_R_MUTE, 0);
1351                 break;
1352
1353         case SND_SOC_DAPM_PRE_PMD:
1354                 snd_soc_update_bits(codec, RT5639_SPK_VOL,
1355                         RT5639_L_MUTE | RT5639_R_MUTE,
1356                         RT5639_L_MUTE | RT5639_R_MUTE);
1357                 rt5639_index_update_bits(codec,
1358                         RT5639_CLSD_INT_REG1, 0xf000, 0x0000);
1359                 snd_soc_update_bits(codec, RT5639_PWR_DIG1,
1360                         RT5639_PWR_CLS_D, 0);
1361                 break;
1362
1363         default:
1364                 return 0;
1365         }
1366
1367         return 0;
1368 }
1369
1370 static int rt5639_set_dmic1_event(struct snd_soc_dapm_widget *w,
1371         struct snd_kcontrol *kcontrol, int event)
1372 {
1373         struct snd_soc_codec *codec = w->codec;
1374
1375         switch (event) {
1376         case SND_SOC_DAPM_PRE_PMU:
1377                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
1378                         RT5639_GP2_PIN_MASK | RT5639_GP3_PIN_MASK,
1379                         RT5639_GP2_PIN_DMIC1_SCL | RT5639_GP3_PIN_DMIC1_SDA);
1380                 snd_soc_update_bits(codec, RT5639_DMIC,
1381                         RT5639_DMIC_1L_LH_MASK | RT5639_DMIC_1R_LH_MASK |
1382                         RT5639_DMIC_1_DP_MASK,
1383                         RT5639_DMIC_1L_LH_FALLING | RT5639_DMIC_1R_LH_RISING |
1384                         RT5639_DMIC_1_DP_IN1P);
1385                 snd_soc_update_bits(codec, RT5639_DMIC,
1386                         RT5639_DMIC_1_EN_MASK, RT5639_DMIC_1_EN);
1387         default:
1388                 return 0;
1389         }
1390
1391         return 0;
1392 }
1393
1394 static int rt5639_set_dmic2_event(struct snd_soc_dapm_widget *w,
1395         struct snd_kcontrol *kcontrol, int event)
1396 {
1397         struct snd_soc_codec *codec = w->codec;
1398
1399         switch (event) {
1400         case SND_SOC_DAPM_PRE_PMU:
1401                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
1402                         RT5639_GP2_PIN_MASK | RT5639_GP4_PIN_MASK,
1403                         RT5639_GP2_PIN_DMIC1_SCL | RT5639_GP4_PIN_DMIC2_SDA);
1404                 snd_soc_update_bits(codec, RT5639_DMIC,
1405                         RT5639_DMIC_2L_LH_MASK | RT5639_DMIC_2R_LH_MASK |
1406                         RT5639_DMIC_2_DP_MASK,
1407                         RT5639_DMIC_2L_LH_FALLING | RT5639_DMIC_2R_LH_RISING |
1408                         RT5639_DMIC_2_DP_IN1N);
1409                 snd_soc_update_bits(codec, RT5639_DMIC,
1410                         RT5639_DMIC_2_EN_MASK, RT5639_DMIC_2_EN);
1411         default:
1412                 return 0;
1413         }
1414
1415         return 0;
1416 }
1417
1418 #if USE_ONEBIT_DEPOP
1419 static void hp_amp_power(struct snd_soc_codec *codec, int on)
1420 {
1421         static int hp_amp_power_count;
1422         dev_info(codec->dev,
1423                 "one bit hp_amp_power on=%d hp_amp_power_count=%d\n",
1424                 on, hp_amp_power_count);
1425
1426         if (on) {
1427                 if (hp_amp_power_count <= 0) {
1428                         /* depop parameters */
1429                         rt5639_index_update_bits(codec, RT5639_CHPUMP_INT_REG1,
1430                                 0x0700, 0x0200);
1431                         snd_soc_update_bits(codec, RT5639_DEPOP_M2,
1432                                 RT5639_DEPOP_MASK, RT5639_DEPOP_MAN);
1433                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1434                                 RT5639_HP_CP_MASK | RT5639_HP_SG_MASK
1435                                 | RT5639_HP_CB_MASK, RT5639_HP_CP_PU
1436                                 | RT5639_HP_SG_DIS | RT5639_HP_CB_PU);
1437                         /* headphone amp power on */
1438                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1439                                 RT5639_PWR_FV1 | RT5639_PWR_FV2, 0);
1440                         msleep(5);
1441
1442                         snd_soc_update_bits(codec, RT5639_PWR_VOL,
1443                                 RT5639_PWR_HV_L | RT5639_PWR_HV_R,
1444                                 RT5639_PWR_HV_L | RT5639_PWR_HV_R);
1445                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1446                                 RT5639_PWR_HP_L | RT5639_PWR_HP_R
1447                                 | RT5639_PWR_HA, RT5639_PWR_HP_L
1448                                 | RT5639_PWR_HP_R | RT5639_PWR_HA);
1449                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1450                                 RT5639_PWR_FV1 | RT5639_PWR_FV2 ,
1451                                 RT5639_PWR_FV1 | RT5639_PWR_FV2);
1452                         snd_soc_update_bits(codec, RT5639_DEPOP_M2,
1453                                 RT5639_DEPOP_MASK | RT5639_DIG_DP_MASK,
1454                                 RT5639_DEPOP_AUTO | RT5639_DIG_DP_EN);
1455                         snd_soc_update_bits(codec, RT5639_CHARGE_PUMP,
1456                                 RT5639_PM_HP_MASK, RT5639_PM_HP_HV);
1457                         snd_soc_update_bits(codec, RT5639_DEPOP_M3,
1458                                 RT5639_CP_FQ1_MASK | RT5639_CP_FQ2_MASK
1459                                 | RT5639_CP_FQ3_MASK,
1460                                 (RT5639_CP_FQ_192_KHZ << RT5639_CP_FQ1_SFT) |
1461                                 (RT5639_CP_FQ_24_KHZ << RT5639_CP_FQ2_SFT) |
1462                                 (RT5639_CP_FQ_192_KHZ << RT5639_CP_FQ3_SFT));
1463                         rt5639_index_write(codec, RT5639_MAMP_INT_REG2, 0x1c00);
1464                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1465                                 RT5639_HP_CP_MASK | RT5639_HP_SG_MASK,
1466                                 RT5639_HP_CP_PD | RT5639_HP_SG_EN);
1467                         rt5639_index_update_bits(codec, RT5639_CHPUMP_INT_REG1,
1468                                                 0x0700, 0x0400);
1469                 }
1470                 hp_amp_power_count++;
1471         } else {
1472                 hp_amp_power_count--;
1473                 if (hp_amp_power_count <= 0) {
1474                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1475                                 RT5639_HP_CB_MASK, RT5639_HP_CB_PD);
1476                         msleep(30);
1477                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1478                                 RT5639_PWR_HP_L | RT5639_PWR_HP_R
1479                                 | RT5639_PWR_HA, 0);
1480                         snd_soc_write(codec, RT5639_DEPOP_M2, 0x3100);
1481                 }
1482         }
1483 }
1484
1485 static void rt5639_pmu_depop(struct snd_soc_codec *codec)
1486 {
1487         hp_amp_power(codec, 1);
1488         /* headphone unmute sequence */
1489         msleep(5);
1490         snd_soc_update_bits(codec, RT5639_HP_VOL,
1491                 RT5639_L_MUTE | RT5639_R_MUTE, 0);
1492         msleep(65);
1493         /*snd_soc_update_bits(codec, RT5639_HP_CALIB_AMP_DET,
1494                 RT5639_HPD_PS_MASK, RT5639_HPD_PS_EN);*/
1495 }
1496
1497 static void rt5639_pmd_depop(struct snd_soc_codec *codec)
1498 {
1499         snd_soc_update_bits(codec, RT5639_DEPOP_M3,
1500                 RT5639_CP_FQ1_MASK | RT5639_CP_FQ2_MASK | RT5639_CP_FQ3_MASK,
1501                 (RT5639_CP_FQ_96_KHZ << RT5639_CP_FQ1_SFT) |
1502                 (RT5639_CP_FQ_12_KHZ << RT5639_CP_FQ2_SFT) |
1503                 (RT5639_CP_FQ_96_KHZ << RT5639_CP_FQ3_SFT));
1504         rt5639_index_write(codec, RT5639_MAMP_INT_REG2, 0x7c00);
1505         /*snd_soc_update_bits(codec, RT5639_HP_CALIB_AMP_DET,
1506                 RT5639_HPD_PS_MASK, RT5639_HPD_PS_DIS); */
1507         snd_soc_update_bits(codec, RT5639_HP_VOL,
1508                 RT5639_L_MUTE | RT5639_R_MUTE,
1509                 RT5639_L_MUTE | RT5639_R_MUTE);
1510         msleep(50);
1511         hp_amp_power(codec, 0);
1512 }
1513
1514 #else /*seq*/
1515 static void hp_amp_power(struct snd_soc_codec *codec, int on)
1516 {
1517         static int hp_amp_power_count;
1518         dev_info(codec->dev, "hp_amp_power on=%d hp_amp_power_count=%d\n",
1519                 on, hp_amp_power_count);
1520
1521         if (on) {
1522                 if (hp_amp_power_count <= 0) {
1523                         /* depop parameters */
1524                         rt5639_index_update_bits(codec, RT5639_CHPUMP_INT_REG1,
1525                                 0x0700, 0x0200);
1526                         snd_soc_update_bits(codec, RT5639_DEPOP_M2,
1527                                 RT5639_DEPOP_MASK, RT5639_DEPOP_MAN);
1528                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1529                                 RT5639_HP_CP_MASK | RT5639_HP_SG_MASK
1530                                 | RT5639_HP_CB_MASK,
1531                                 RT5639_HP_CP_PU | RT5639_HP_SG_DIS
1532                                 | RT5639_HP_CB_PU);
1533                         /* headphone amp power on */
1534                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1535                                 RT5639_PWR_FV1 | RT5639_PWR_FV2 , 0);
1536                         snd_soc_update_bits(codec, RT5639_PWR_VOL,
1537                                 RT5639_PWR_HV_L | RT5639_PWR_HV_R,
1538                                 RT5639_PWR_HV_L | RT5639_PWR_HV_R);
1539                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1540                                 RT5639_PWR_HP_L | RT5639_PWR_HP_R
1541                                 | RT5639_PWR_HA,
1542                                 RT5639_PWR_HP_L | RT5639_PWR_HP_R
1543                                 | RT5639_PWR_HA);
1544                         msleep(5);
1545                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1546                                 RT5639_PWR_FV1 | RT5639_PWR_FV2,
1547                                 RT5639_PWR_FV1 | RT5639_PWR_FV2);
1548
1549                         snd_soc_update_bits(codec, RT5639_CHARGE_PUMP,
1550                                 RT5639_PM_HP_MASK, RT5639_PM_HP_HV);
1551                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1552                                 RT5639_HP_CO_MASK | RT5639_HP_SG_MASK,
1553                                 RT5639_HP_CO_EN | RT5639_HP_SG_EN);
1554                         rt5639_index_update_bits(codec, RT5639_CHPUMP_INT_REG1,
1555                                 0x0700, 0x0400);
1556                 }
1557                 hp_amp_power_count++;
1558         } else {
1559                 hp_amp_power_count--;
1560                 if (hp_amp_power_count <= 0) {
1561                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1562                                 RT5639_HP_SG_MASK | RT5639_HP_L_SMT_MASK |
1563                                 RT5639_HP_R_SMT_MASK, RT5639_HP_SG_DIS |
1564                                 RT5639_HP_L_SMT_DIS | RT5639_HP_R_SMT_DIS);
1565                         /* headphone amp power down */
1566                         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1567                                 RT5639_SMT_TRIG_MASK | RT5639_HP_CD_PD_MASK |
1568                                 RT5639_HP_CO_MASK | RT5639_HP_CP_MASK |
1569                                 RT5639_HP_SG_MASK | RT5639_HP_CB_MASK,
1570                                 RT5639_SMT_TRIG_DIS | RT5639_HP_CD_PD_EN |
1571                                 RT5639_HP_CO_DIS | RT5639_HP_CP_PD |
1572                                 RT5639_HP_SG_EN | RT5639_HP_CB_PD);
1573                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1574                                 RT5639_PWR_HP_L | RT5639_PWR_HP_R
1575                                 | RT5639_PWR_HA,
1576                                 0);
1577                 }
1578         }
1579 }
1580
1581 static void rt5639_pmu_depop(struct snd_soc_codec *codec)
1582 {
1583         hp_amp_power(codec, 1);
1584         /* headphone unmute sequence */
1585         snd_soc_update_bits(codec, RT5639_DEPOP_M3,
1586                 RT5639_CP_FQ1_MASK | RT5639_CP_FQ2_MASK | RT5639_CP_FQ3_MASK,
1587                 (RT5639_CP_FQ_192_KHZ << RT5639_CP_FQ1_SFT) |
1588                 (RT5639_CP_FQ_12_KHZ << RT5639_CP_FQ2_SFT) |
1589                 (RT5639_CP_FQ_192_KHZ << RT5639_CP_FQ3_SFT));
1590         rt5639_index_write(codec, RT5639_MAMP_INT_REG2, 0xfc00);
1591         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1592                 RT5639_SMT_TRIG_MASK, RT5639_SMT_TRIG_EN);
1593         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1594                 RT5639_RSTN_MASK, RT5639_RSTN_EN);
1595         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1596                 RT5639_RSTN_MASK | RT5639_HP_L_SMT_MASK | RT5639_HP_R_SMT_MASK,
1597                 RT5639_RSTN_DIS | RT5639_HP_L_SMT_EN | RT5639_HP_R_SMT_EN);
1598         snd_soc_update_bits(codec, RT5639_HP_VOL,
1599                 RT5639_L_MUTE | RT5639_R_MUTE, 0);
1600         msleep(40);
1601         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1602                 RT5639_HP_SG_MASK | RT5639_HP_L_SMT_MASK |
1603                 RT5639_HP_R_SMT_MASK, RT5639_HP_SG_DIS |
1604                 RT5639_HP_L_SMT_DIS | RT5639_HP_R_SMT_DIS);
1605
1606 }
1607
1608 static void rt5639_pmd_depop(struct snd_soc_codec *codec)
1609 {
1610         /* headphone mute sequence */
1611         snd_soc_update_bits(codec, RT5639_DEPOP_M3,
1612                 RT5639_CP_FQ1_MASK | RT5639_CP_FQ2_MASK | RT5639_CP_FQ3_MASK,
1613                 (RT5639_CP_FQ_96_KHZ << RT5639_CP_FQ1_SFT) |
1614                 (RT5639_CP_FQ_12_KHZ << RT5639_CP_FQ2_SFT) |
1615                 (RT5639_CP_FQ_96_KHZ << RT5639_CP_FQ3_SFT));
1616         rt5639_index_write(codec, RT5639_MAMP_INT_REG2, 0xfc00);
1617         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1618                 RT5639_HP_SG_MASK, RT5639_HP_SG_EN);
1619         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1620                 RT5639_RSTP_MASK, RT5639_RSTP_EN);
1621         snd_soc_update_bits(codec, RT5639_DEPOP_M1,
1622                 RT5639_RSTP_MASK | RT5639_HP_L_SMT_MASK |
1623                 RT5639_HP_R_SMT_MASK, RT5639_RSTP_DIS |
1624                 RT5639_HP_L_SMT_EN | RT5639_HP_R_SMT_EN);
1625
1626         snd_soc_update_bits(codec, RT5639_HP_VOL,
1627                 RT5639_L_MUTE | RT5639_R_MUTE, RT5639_L_MUTE | RT5639_R_MUTE);
1628         msleep(30);
1629
1630         hp_amp_power(codec, 0);
1631 }
1632 #endif
1633
1634 static int rt5639_hp_event(struct snd_soc_dapm_widget *w,
1635         struct snd_kcontrol *kcontrol, int event)
1636 {
1637         struct snd_soc_codec *codec = w->codec;
1638
1639         switch (event) {
1640         case SND_SOC_DAPM_POST_PMU:
1641 #ifdef USE_EQ
1642                 rt5639_update_eqmode(codec, HP);
1643 #endif
1644                 rt5639_pmu_depop(codec);
1645                 break;
1646
1647         case SND_SOC_DAPM_PRE_PMD:
1648                 rt5639_pmd_depop(codec);
1649                 break;
1650
1651         default:
1652                 return 0;
1653         }
1654
1655         return 0;
1656 }
1657
1658
1659 static int rt5639_lout_event(struct snd_soc_dapm_widget *w,
1660         struct snd_kcontrol *kcontrol, int event)
1661 {
1662         struct snd_soc_codec *codec = w->codec;
1663
1664         switch (event) {
1665         case SND_SOC_DAPM_POST_PMU:
1666                 hp_amp_power(codec, 1);
1667                 snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1668                         RT5639_PWR_LM, RT5639_PWR_LM);
1669                 snd_soc_update_bits(codec, RT5639_OUTPUT,
1670                         RT5639_L_MUTE | RT5639_R_MUTE, 0);
1671                 break;
1672
1673         case SND_SOC_DAPM_PRE_PMD:
1674                 snd_soc_update_bits(codec, RT5639_OUTPUT,
1675                         RT5639_L_MUTE | RT5639_R_MUTE,
1676                         RT5639_L_MUTE | RT5639_R_MUTE);
1677                 snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
1678                         RT5639_PWR_LM, 0);
1679                 hp_amp_power(codec, 0);
1680                 break;
1681
1682         default:
1683                 return 0;
1684         }
1685
1686         return 0;
1687 }
1688
1689 static int rt5639_index_sync_event(struct snd_soc_dapm_widget *w,
1690         struct snd_kcontrol *kcontrol, int event)
1691 {
1692         struct snd_soc_codec *codec = w->codec;
1693
1694         switch (event) {
1695         case SND_SOC_DAPM_PRE_PMU:
1696                 rt5639_index_write(codec, RT5639_MIXER_INT_REG,
1697                         snd_soc_read(codec, RT5639_DUMMY_PR3F));
1698
1699                 break;
1700         default:
1701                 return 0;
1702         }
1703
1704         return 0;
1705 }
1706
1707 static int rt5639_dac1_event(struct snd_soc_dapm_widget *w,
1708         struct snd_kcontrol *kcontrol, int event)
1709 {
1710 #ifdef USE_EQ
1711         struct snd_soc_codec *codec = w->codec;
1712 #endif
1713
1714         switch (event) {
1715         case SND_SOC_DAPM_PRE_PMD:
1716 #ifdef USE_EQ
1717                 rt5639_update_eqmode(codec, NORMAL);
1718 #endif
1719                 break;
1720         default:
1721                 return 0;
1722         }
1723
1724         return 0;
1725 }
1726
1727 static const struct snd_soc_dapm_widget rt5639_dapm_widgets[] = {
1728         SND_SOC_DAPM_SUPPLY("PLL1", RT5639_PWR_ANLG2,
1729                         RT5639_PWR_PLL_BIT, 0, NULL, 0),
1730         /* Input Side */
1731         /* micbias */
1732         SND_SOC_DAPM_SUPPLY("LDO2", RT5639_PWR_ANLG1,
1733                         RT5639_PWR_LDO2_BIT, 0, NULL, 0),
1734         SND_SOC_DAPM_MICBIAS("micbias1", RT5639_PWR_ANLG2,
1735                         RT5639_PWR_MB1_BIT, 0),
1736         SND_SOC_DAPM_MICBIAS("micbias2", RT5639_PWR_ANLG2,
1737                         RT5639_PWR_MB2_BIT, 0),
1738         /* Input Lines */
1739         SND_SOC_DAPM_INPUT("DMIC1"),
1740         SND_SOC_DAPM_INPUT("DMIC2"),
1741
1742         SND_SOC_DAPM_INPUT("IN1P"),
1743         SND_SOC_DAPM_INPUT("IN1N"),
1744         SND_SOC_DAPM_INPUT("IN2P"),
1745         SND_SOC_DAPM_INPUT("IN2N"),
1746         SND_SOC_DAPM_INPUT("IN3P"),
1747         SND_SOC_DAPM_INPUT("IN3N"),
1748         SND_SOC_DAPM_PGA_E("DMIC L1", SND_SOC_NOPM, 0, 0, NULL, 0,
1749                 rt5639_set_dmic1_event, SND_SOC_DAPM_PRE_PMU),
1750         SND_SOC_DAPM_PGA_E("DMIC R1", SND_SOC_NOPM, 0, 0, NULL, 0,
1751                 rt5639_set_dmic1_event, SND_SOC_DAPM_PRE_PMU),
1752         SND_SOC_DAPM_PGA_E("DMIC L2", SND_SOC_NOPM, 0, 0, NULL, 0,
1753                 rt5639_set_dmic2_event, SND_SOC_DAPM_PRE_PMU),
1754         SND_SOC_DAPM_PGA_E("DMIC R2", SND_SOC_NOPM, 0, 0, NULL, 0,
1755                 rt5639_set_dmic2_event, SND_SOC_DAPM_PRE_PMU),
1756         SND_SOC_DAPM_SUPPLY("DMIC CLK", SND_SOC_NOPM, 0, 0,
1757                 set_dmic_clk, SND_SOC_DAPM_PRE_PMU),
1758         /* Boost */
1759         SND_SOC_DAPM_PGA("BST1", RT5639_PWR_ANLG2,
1760                 RT5639_PWR_BST1_BIT, 0, NULL, 0),
1761         SND_SOC_DAPM_PGA("BST2", RT5639_PWR_ANLG2,
1762                 RT5639_PWR_BST4_BIT, 0, NULL, 0),
1763         SND_SOC_DAPM_PGA("BST3", RT5639_PWR_ANLG2,
1764                 RT5639_PWR_BST2_BIT, 0, NULL, 0),
1765
1766         /* Input Volume */
1767         SND_SOC_DAPM_PGA("INL VOL", RT5639_PWR_VOL,
1768                 RT5639_PWR_IN_L_BIT, 0, NULL, 0),
1769         SND_SOC_DAPM_PGA("INR VOL", RT5639_PWR_VOL,
1770                 RT5639_PWR_IN_R_BIT, 0, NULL, 0),
1771         /* IN Mux */
1772         SND_SOC_DAPM_MUX("INL Mux", SND_SOC_NOPM, 0, 0, &rt5639_inl_mux),
1773         SND_SOC_DAPM_MUX("INR Mux", SND_SOC_NOPM, 0, 0, &rt5639_inr_mux),
1774         /* REC Mixer */
1775         SND_SOC_DAPM_MIXER("RECMIXL", RT5639_PWR_MIXER, RT5639_PWR_RM_L_BIT, 0,
1776                         rt5639_rec_l_mix, ARRAY_SIZE(rt5639_rec_l_mix)),
1777         SND_SOC_DAPM_MIXER("RECMIXR", RT5639_PWR_MIXER, RT5639_PWR_RM_R_BIT, 0,
1778                         rt5639_rec_r_mix, ARRAY_SIZE(rt5639_rec_r_mix)),
1779         /* ADCs */
1780         SND_SOC_DAPM_ADC("ADC L", NULL, SND_SOC_NOPM,
1781                 0, 0),
1782         SND_SOC_DAPM_ADC("ADC R", NULL, SND_SOC_NOPM,
1783                 0, 0),
1784
1785         SND_SOC_DAPM_SUPPLY("ADC L power", RT5639_PWR_DIG1,
1786                         RT5639_PWR_ADC_L_BIT, 0, NULL, 0),
1787         SND_SOC_DAPM_SUPPLY("ADC R power", RT5639_PWR_DIG1,
1788                         RT5639_PWR_ADC_R_BIT, 0, NULL, 0),
1789         SND_SOC_DAPM_SUPPLY("ADC clock", SND_SOC_NOPM, 0, 0, rt5639_adc_event,
1790                         SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
1791         /* ADC Mux */
1792         SND_SOC_DAPM_MUX("Stereo ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1793                                 &rt5639_sto_adc_l2_mux),
1794         SND_SOC_DAPM_MUX("Stereo ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1795                                 &rt5639_sto_adc_r2_mux),
1796         SND_SOC_DAPM_MUX("Stereo ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1797                                 &rt5639_sto_adc_l1_mux),
1798         SND_SOC_DAPM_MUX("Stereo ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1799                                 &rt5639_sto_adc_r1_mux),
1800         SND_SOC_DAPM_MUX("Mono ADC L2 Mux", SND_SOC_NOPM, 0, 0,
1801                                 &rt5639_mono_adc_l2_mux),
1802         SND_SOC_DAPM_MUX("Mono ADC L1 Mux", SND_SOC_NOPM, 0, 0,
1803                                 &rt5639_mono_adc_l1_mux),
1804         SND_SOC_DAPM_MUX("Mono ADC R1 Mux", SND_SOC_NOPM, 0, 0,
1805                                 &rt5639_mono_adc_r1_mux),
1806         SND_SOC_DAPM_MUX("Mono ADC R2 Mux", SND_SOC_NOPM, 0, 0,
1807                                 &rt5639_mono_adc_r2_mux),
1808         /* ADC Mixer */
1809         SND_SOC_DAPM_SUPPLY("stereo filter", RT5639_PWR_DIG2,
1810                 RT5639_PWR_ADC_SF_BIT, 0, NULL, 0),
1811         SND_SOC_DAPM_MIXER("Stereo ADC MIXL", SND_SOC_NOPM, 0, 0,
1812                 rt5639_sto_adc_l_mix, ARRAY_SIZE(rt5639_sto_adc_l_mix)),
1813         SND_SOC_DAPM_MIXER("Stereo ADC MIXR", SND_SOC_NOPM, 0, 0,
1814                 rt5639_sto_adc_r_mix, ARRAY_SIZE(rt5639_sto_adc_r_mix)),
1815         SND_SOC_DAPM_SUPPLY("mono left filter", RT5639_PWR_DIG2,
1816                 RT5639_PWR_ADC_MF_L_BIT, 0, NULL, 0),
1817         SND_SOC_DAPM_MIXER_E("Mono ADC MIXL", SND_SOC_NOPM, 0, 0,
1818                 rt5639_mono_adc_l_mix, ARRAY_SIZE(rt5639_mono_adc_l_mix),
1819                 rt5639_mono_adcl_event,
1820                 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1821         SND_SOC_DAPM_SUPPLY("mono right filter", RT5639_PWR_DIG2,
1822                 RT5639_PWR_ADC_MF_R_BIT, 0, NULL, 0),
1823         SND_SOC_DAPM_MIXER_E("Mono ADC MIXR", SND_SOC_NOPM, 0, 0,
1824                 rt5639_mono_adc_r_mix, ARRAY_SIZE(rt5639_mono_adc_r_mix),
1825                 rt5639_mono_adcr_event,
1826                 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1827
1828         /* IF2 Mux */
1829         SND_SOC_DAPM_MUX("IF2 ADC L Mux", SND_SOC_NOPM, 0, 0,
1830                                 &rt5639_if2_adc_l_mux),
1831         SND_SOC_DAPM_MUX("IF2 ADC R Mux", SND_SOC_NOPM, 0, 0,
1832                                 &rt5639_if2_adc_r_mux),
1833
1834         /* Digital Interface */
1835         SND_SOC_DAPM_SUPPLY("I2S1", RT5639_PWR_DIG1,
1836                 RT5639_PWR_I2S1_BIT, 0, NULL, 0),
1837         SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1838         SND_SOC_DAPM_PGA("IF1 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1839         SND_SOC_DAPM_PGA("IF1 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1840         SND_SOC_DAPM_PGA("IF1 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1841         SND_SOC_DAPM_PGA("IF1 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1842         SND_SOC_DAPM_PGA("IF1 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1843         SND_SOC_DAPM_SUPPLY("I2S2", RT5639_PWR_DIG1,
1844                 RT5639_PWR_I2S2_BIT, 0, NULL, 0),
1845         SND_SOC_DAPM_PGA("IF2 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1846         SND_SOC_DAPM_PGA("IF2 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1847         SND_SOC_DAPM_PGA("IF2 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1848         SND_SOC_DAPM_PGA("IF2 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1849         SND_SOC_DAPM_PGA("IF2 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1850         SND_SOC_DAPM_PGA("IF2 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1851         SND_SOC_DAPM_SUPPLY("I2S3", RT5639_PWR_DIG1,
1852                 RT5639_PWR_I2S3_BIT, 0, NULL, 0),
1853         SND_SOC_DAPM_PGA("IF3 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
1854         SND_SOC_DAPM_PGA("IF3 DAC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1855         SND_SOC_DAPM_PGA("IF3 DAC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1856         SND_SOC_DAPM_PGA("IF3 ADC", SND_SOC_NOPM, 0, 0, NULL, 0),
1857         SND_SOC_DAPM_PGA("IF3 ADC L", SND_SOC_NOPM, 0, 0, NULL, 0),
1858         SND_SOC_DAPM_PGA("IF3 ADC R", SND_SOC_NOPM, 0, 0, NULL, 0),
1859
1860         /* Digital Interface Select */
1861         SND_SOC_DAPM_MUX("DAI1 RX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1862         SND_SOC_DAPM_MUX("DAI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1863         SND_SOC_DAPM_MUX("DAI1 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1864         SND_SOC_DAPM_MUX("DAI1 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1865         SND_SOC_DAPM_MUX("SDI1 TX Mux", SND_SOC_NOPM, 0, 0, &rt5639_sdi_mux),
1866
1867         SND_SOC_DAPM_MUX("DAI2 RX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1868         SND_SOC_DAPM_MUX("DAI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1869         SND_SOC_DAPM_MUX("DAI2 IF1 Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1870         SND_SOC_DAPM_MUX("DAI2 IF2 Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1871         SND_SOC_DAPM_MUX("SDI2 TX Mux", SND_SOC_NOPM, 0, 0, &rt5639_sdi_mux),
1872
1873         SND_SOC_DAPM_MUX("DAI3 RX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1874         SND_SOC_DAPM_MUX("DAI3 TX Mux", SND_SOC_NOPM, 0, 0, &rt5639_dai_mux),
1875
1876         /* Audio Interface */
1877         SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
1878         SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
1879         SND_SOC_DAPM_AIF_IN("AIF2RX", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0),
1880         SND_SOC_DAPM_AIF_OUT("AIF2TX", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0),
1881         SND_SOC_DAPM_AIF_IN("AIF3RX", "AIF3 Playback", 0, SND_SOC_NOPM, 0, 0),
1882         SND_SOC_DAPM_AIF_OUT("AIF3TX", "AIF3 Capture", 0, SND_SOC_NOPM, 0, 0),
1883
1884         /* Audio DSP */
1885         SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM, 0, 0, NULL, 0),
1886
1887         /* ANC */
1888         SND_SOC_DAPM_PGA("ANC", SND_SOC_NOPM, 0, 0, NULL, 0),
1889
1890         /* Output Side */
1891         /* DAC mixer before sound effect  */
1892         SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM, 0, 0,
1893                 rt5639_dac_l_mix, ARRAY_SIZE(rt5639_dac_l_mix)),
1894         SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM, 0, 0,
1895                 rt5639_dac_r_mix, ARRAY_SIZE(rt5639_dac_r_mix)),
1896
1897         /* DAC2 channel Mux */
1898         SND_SOC_DAPM_MUX("DAC L2 Mux", SND_SOC_NOPM, 0, 0,
1899                                 &rt5639_dac_l2_mux),
1900         SND_SOC_DAPM_MUX("DAC R2 Mux", SND_SOC_NOPM, 0, 0,
1901                                 &rt5639_dac_r2_mux),
1902         SND_SOC_DAPM_PGA("DAC L2 Volume", RT5639_PWR_DIG1,
1903                         RT5639_PWR_DAC_L2_BIT, 0, NULL, 0),
1904         SND_SOC_DAPM_PGA("DAC R2 Volume", RT5639_PWR_DIG1,
1905                         RT5639_PWR_DAC_R2_BIT, 0, NULL, 0),
1906
1907         /* DAC Mixer */
1908         SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
1909                 rt5639_sto_dac_l_mix, ARRAY_SIZE(rt5639_sto_dac_l_mix)),
1910         SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
1911                 rt5639_sto_dac_r_mix, ARRAY_SIZE(rt5639_sto_dac_r_mix)),
1912         SND_SOC_DAPM_MIXER("Mono DAC MIXL", SND_SOC_NOPM, 0, 0,
1913                 rt5639_mono_dac_l_mix, ARRAY_SIZE(rt5639_mono_dac_l_mix)),
1914         SND_SOC_DAPM_MIXER("Mono DAC MIXR", SND_SOC_NOPM, 0, 0,
1915                 rt5639_mono_dac_r_mix, ARRAY_SIZE(rt5639_mono_dac_r_mix)),
1916         SND_SOC_DAPM_MIXER("DIG MIXL", SND_SOC_NOPM, 0, 0,
1917                 rt5639_dig_l_mix, ARRAY_SIZE(rt5639_dig_l_mix)),
1918         SND_SOC_DAPM_MIXER("DIG MIXR", SND_SOC_NOPM, 0, 0,
1919                 rt5639_dig_r_mix, ARRAY_SIZE(rt5639_dig_r_mix)),
1920         SND_SOC_DAPM_MUX_E("Mono dacr Mux", SND_SOC_NOPM, 0, 0,
1921                 &rt5639_dacr2_mux, rt5639_index_sync_event,
1922                 SND_SOC_DAPM_PRE_PMU),
1923
1924         /* DACs */
1925         SND_SOC_DAPM_DAC_E("DAC L1", NULL, RT5639_PWR_DIG1,
1926                         RT5639_PWR_DAC_L1_BIT, 0, rt5639_dac1_event,
1927                         SND_SOC_DAPM_PRE_PMD),
1928         SND_SOC_DAPM_DAC_E("DAC R1", NULL, RT5639_PWR_DIG1,
1929                         RT5639_PWR_DAC_R1_BIT, 0, rt5639_dac1_event,
1930                         SND_SOC_DAPM_PRE_PMD),
1931
1932         /* SPK/OUT Mixer */
1933         SND_SOC_DAPM_MIXER("SPK MIXL", RT5639_PWR_MIXER, RT5639_PWR_SM_L_BIT,
1934                 0, rt5639_spk_l_mix, ARRAY_SIZE(rt5639_spk_l_mix)),
1935         SND_SOC_DAPM_MIXER("SPK MIXR", RT5639_PWR_MIXER, RT5639_PWR_SM_R_BIT,
1936                 0, rt5639_spk_r_mix, ARRAY_SIZE(rt5639_spk_r_mix)),
1937         SND_SOC_DAPM_MIXER("OUT MIXL", RT5639_PWR_MIXER, RT5639_PWR_OM_L_BIT,
1938                 0, rt5639_out_l_mix, ARRAY_SIZE(rt5639_out_l_mix)),
1939         SND_SOC_DAPM_MIXER("OUT MIXR", RT5639_PWR_MIXER, RT5639_PWR_OM_R_BIT,
1940                 0, rt5639_out_r_mix, ARRAY_SIZE(rt5639_out_r_mix)),
1941         /* Ouput Volume */
1942         SND_SOC_DAPM_PGA("SPKVOL L", RT5639_PWR_VOL,
1943                 RT5639_PWR_SV_L_BIT, 0, NULL, 0),
1944         SND_SOC_DAPM_PGA("SPKVOL R", RT5639_PWR_VOL,
1945                 RT5639_PWR_SV_R_BIT, 0, NULL, 0),
1946         SND_SOC_DAPM_PGA("OUTVOL L", RT5639_PWR_VOL,
1947                 RT5639_PWR_OV_L_BIT, 0, NULL, 0),
1948         SND_SOC_DAPM_PGA("OUTVOL R", RT5639_PWR_VOL,
1949                 RT5639_PWR_OV_R_BIT, 0, NULL, 0),
1950         SND_SOC_DAPM_PGA("HPOVOL L", RT5639_PWR_VOL,
1951                 RT5639_PWR_HV_L_BIT, 0, NULL, 0),
1952         SND_SOC_DAPM_PGA("HPOVOL R", RT5639_PWR_VOL,
1953                 RT5639_PWR_HV_R_BIT, 0, NULL, 0),
1954         SND_SOC_DAPM_PGA("DAC 1", SND_SOC_NOPM,
1955                 0, 0, NULL, 0),
1956         SND_SOC_DAPM_PGA("HPOVOL", SND_SOC_NOPM,
1957                 0, 0, NULL, 0),
1958         /* SPO/HPO/LOUT/Mono Mixer */
1959         SND_SOC_DAPM_MIXER("SPOL MIX", SND_SOC_NOPM, 0,
1960                 0, rt5639_spo_l_mix, ARRAY_SIZE(rt5639_spo_l_mix)),
1961         SND_SOC_DAPM_MIXER("SPOR MIX", SND_SOC_NOPM, 0,
1962                 0, rt5639_spo_r_mix, ARRAY_SIZE(rt5639_spo_r_mix)),
1963         SND_SOC_DAPM_MIXER("HPO MIX", SND_SOC_NOPM, 0, 0,
1964                 rt5639_hpo_mix, ARRAY_SIZE(rt5639_hpo_mix)),
1965         SND_SOC_DAPM_MIXER("LOUT MIX", SND_SOC_NOPM, 0, 0,
1966                 rt5639_lout_mix, ARRAY_SIZE(rt5639_lout_mix)),
1967
1968         SND_SOC_DAPM_PGA_S("HP amp", 1, SND_SOC_NOPM, 0, 0,
1969                 rt5639_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1970         SND_SOC_DAPM_PGA_S("SPK amp", 1, SND_SOC_NOPM, 0, 0,
1971                 rt5639_spk_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1972         SND_SOC_DAPM_PGA_S("LOUT amp", 1, SND_SOC_NOPM, 0, 0,
1973                 rt5639_lout_event,
1974                 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
1975
1976         /* Output Lines */
1977         SND_SOC_DAPM_OUTPUT("SPOLP"),
1978         SND_SOC_DAPM_OUTPUT("SPOLN"),
1979         SND_SOC_DAPM_OUTPUT("SPORP"),
1980         SND_SOC_DAPM_OUTPUT("SPORN"),
1981         SND_SOC_DAPM_OUTPUT("HPOL"),
1982         SND_SOC_DAPM_OUTPUT("HPOR"),
1983         SND_SOC_DAPM_OUTPUT("LOUTL"),
1984         SND_SOC_DAPM_OUTPUT("LOUTR"),
1985 };
1986
1987 static const struct snd_soc_dapm_route rt5639_dapm_routes[] = {
1988         {"IN1P", NULL, "LDO2"},
1989         {"IN2P", NULL, "LDO2"},
1990         {"IN3P", NULL, "LDO2"},
1991
1992         {"DMIC L1", NULL, "DMIC1"},
1993         {"DMIC R1", NULL, "DMIC1"},
1994         {"DMIC L2", NULL, "DMIC2"},
1995         {"DMIC R2", NULL, "DMIC2"},
1996
1997         {"BST1", NULL, "IN1P"},
1998         {"BST1", NULL, "IN1N"},
1999         {"BST2", NULL, "IN2P"},
2000         {"BST2", NULL, "IN2N"},
2001         {"BST3", NULL, "IN3P"},
2002         {"BST3", NULL, "IN3N"},
2003
2004         {"INL VOL", NULL, "IN2P"},
2005         {"INR VOL", NULL, "IN2N"},
2006
2007         {"RECMIXL", "HPOL Switch", "HPOL"},
2008         {"RECMIXL", "INL Switch", "INL VOL"},
2009         {"RECMIXL", "BST3 Switch", "BST3"},
2010         {"RECMIXL", "BST2 Switch", "BST2"},
2011         {"RECMIXL", "BST1 Switch", "BST1"},
2012         {"RECMIXL", "OUT MIXL Switch", "OUT MIXL"},
2013
2014         {"RECMIXR", "HPOR Switch", "HPOR"},
2015         {"RECMIXR", "INR Switch", "INR VOL"},
2016         {"RECMIXR", "BST3 Switch", "BST3"},
2017         {"RECMIXR", "BST2 Switch", "BST2"},
2018         {"RECMIXR", "BST1 Switch", "BST1"},
2019         {"RECMIXR", "OUT MIXR Switch", "OUT MIXR"},
2020
2021         {"ADC L", NULL, "RECMIXL"},
2022         {"ADC L", NULL, "ADC L power"},
2023         {"ADC L", NULL, "ADC clock"},
2024         {"ADC R", NULL, "RECMIXR"},
2025         {"ADC R", NULL, "ADC R power"},
2026         {"ADC R", NULL, "ADC clock"},
2027
2028         {"DMIC L1", NULL, "DMIC CLK"},
2029         {"DMIC R1", NULL, "DMIC CLK"},
2030         {"DMIC L2", NULL, "DMIC CLK"},
2031         {"DMIC R2", NULL, "DMIC CLK"},
2032
2033         {"Stereo ADC L2 Mux", "DMIC1", "DMIC L1"},
2034         {"Stereo ADC L2 Mux", "DMIC2", "DMIC L2"},
2035         {"Stereo ADC L2 Mux", "DIG MIX", "DIG MIXL"},
2036         {"Stereo ADC L1 Mux", "ADC", "ADC L"},
2037         {"Stereo ADC L1 Mux", "DIG MIX", "DIG MIXL"},
2038
2039         {"Stereo ADC R1 Mux", "ADC", "ADC R"},
2040         {"Stereo ADC R1 Mux", "DIG MIX", "DIG MIXR"},
2041         {"Stereo ADC R2 Mux", "DMIC1", "DMIC R1"},
2042         {"Stereo ADC R2 Mux", "DMIC2", "DMIC R2"},
2043         {"Stereo ADC R2 Mux", "DIG MIX", "DIG MIXR"},
2044
2045         {"Mono ADC L2 Mux", "DMIC L1", "DMIC L1"},
2046         {"Mono ADC L2 Mux", "DMIC L2", "DMIC L2"},
2047         {"Mono ADC L2 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
2048         {"Mono ADC L1 Mux", "Mono DAC MIXL", "Mono DAC MIXL"},
2049         {"Mono ADC L1 Mux", "ADCL", "ADC L"},
2050
2051         {"Mono ADC R1 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
2052         {"Mono ADC R1 Mux", "ADCR", "ADC R"},
2053         {"Mono ADC R2 Mux", "DMIC R1", "DMIC R1"},
2054         {"Mono ADC R2 Mux", "DMIC R2", "DMIC R2"},
2055         {"Mono ADC R2 Mux", "Mono DAC MIXR", "Mono DAC MIXR"},
2056
2057         {"Stereo ADC MIXL", "ADC1 Switch", "Stereo ADC L1 Mux"},
2058         {"Stereo ADC MIXL", "ADC2 Switch", "Stereo ADC L2 Mux"},
2059         {"Stereo ADC MIXL", NULL, "stereo filter"},
2060         {"stereo filter", NULL, "PLL1", check_sysclk1_source},
2061
2062         {"Stereo ADC MIXR", "ADC1 Switch", "Stereo ADC R1 Mux"},
2063         {"Stereo ADC MIXR", "ADC2 Switch", "Stereo ADC R2 Mux"},
2064         {"Stereo ADC MIXR", NULL, "stereo filter"},
2065         {"stereo filter", NULL, "PLL1", check_sysclk1_source},
2066
2067         {"Mono ADC MIXL", "ADC1 Switch", "Mono ADC L1 Mux"},
2068         {"Mono ADC MIXL", "ADC2 Switch", "Mono ADC L2 Mux"},
2069         {"Mono ADC MIXL", NULL, "mono left filter"},
2070         {"mono left filter", NULL, "PLL1", check_sysclk1_source},
2071
2072         {"Mono ADC MIXR", "ADC1 Switch", "Mono ADC R1 Mux"},
2073         {"Mono ADC MIXR", "ADC2 Switch", "Mono ADC R2 Mux"},
2074         {"Mono ADC MIXR", NULL, "mono right filter"},
2075         {"mono right filter", NULL, "PLL1", check_sysclk1_source},
2076
2077         {"IF2 ADC L Mux", "Mono ADC MIXL", "Mono ADC MIXL"},
2078         {"IF2 ADC R Mux", "Mono ADC MIXR", "Mono ADC MIXR"},
2079
2080         {"IF2 ADC L", NULL, "IF2 ADC L Mux"},
2081         {"IF2 ADC R", NULL, "IF2 ADC R Mux"},
2082         {"IF3 ADC L", NULL, "Mono ADC MIXL"},
2083         {"IF3 ADC R", NULL, "Mono ADC MIXR"},
2084         {"IF1 ADC L", NULL, "Stereo ADC MIXL"},
2085         {"IF1 ADC R", NULL, "Stereo ADC MIXR"},
2086
2087         {"IF1 ADC", NULL, "I2S1"},
2088         {"IF1 ADC", NULL, "IF1 ADC L"},
2089         {"IF1 ADC", NULL, "IF1 ADC R"},
2090         {"IF2 ADC", NULL, "I2S2"},
2091         {"IF2 ADC", NULL, "IF2 ADC L"},
2092         {"IF2 ADC", NULL, "IF2 ADC R"},
2093         {"IF3 ADC", NULL, "I2S3"},
2094         {"IF3 ADC", NULL, "IF3 ADC L"},
2095         {"IF3 ADC", NULL, "IF3 ADC R"},
2096
2097         {"DAI1 TX Mux", "1:1|2:2|3:3", "IF1 ADC"},
2098         {"DAI1 TX Mux", "1:1|2:3|3:2", "IF1 ADC"},
2099         {"DAI1 TX Mux", "1:3|2:1|3:2", "IF2 ADC"},
2100         {"DAI1 TX Mux", "1:2|2:1|3:3", "IF2 ADC"},
2101         {"DAI1 TX Mux", "1:3|2:2|3:1", "IF3 ADC"},
2102         {"DAI1 TX Mux", "1:2|2:3|3:1", "IF3 ADC"},
2103         {"DAI1 IF1 Mux", "1:1|2:1|3:3", "IF1 ADC"},
2104         {"DAI1 IF2 Mux", "1:1|2:1|3:3", "IF2 ADC"},
2105         {"SDI1 TX Mux", "IF1", "DAI1 IF1 Mux"},
2106         {"SDI1 TX Mux", "IF2", "DAI1 IF2 Mux"},
2107
2108         {"DAI2 TX Mux", "1:2|2:3|3:1", "IF1 ADC"},
2109         {"DAI2 TX Mux", "1:2|2:1|3:3", "IF1 ADC"},
2110         {"DAI2 TX Mux", "1:1|2:2|3:3", "IF2 ADC"},
2111         {"DAI2 TX Mux", "1:3|2:2|3:1", "IF2 ADC"},
2112         {"DAI2 TX Mux", "1:1|2:3|3:2", "IF3 ADC"},
2113         {"DAI2 TX Mux", "1:3|2:1|3:2", "IF3 ADC"},
2114         {"DAI2 IF1 Mux", "1:2|2:2|3:3", "IF1 ADC"},
2115         {"DAI2 IF2 Mux", "1:2|2:2|3:3", "IF2 ADC"},
2116         {"SDI2 TX Mux", "IF1", "DAI2 IF1 Mux"},
2117         {"SDI2 TX Mux", "IF2", "DAI2 IF2 Mux"},
2118
2119         {"DAI3 TX Mux", "1:3|2:1|3:2", "IF1 ADC"},
2120         {"DAI3 TX Mux", "1:3|2:2|3:1", "IF1 ADC"},
2121         {"DAI3 TX Mux", "1:1|2:3|3:2", "IF2 ADC"},
2122         {"DAI3 TX Mux", "1:2|2:3|3:1", "IF2 ADC"},
2123         {"DAI3 TX Mux", "1:1|2:2|3:3", "IF3 ADC"},
2124         {"DAI3 TX Mux", "1:2|2:1|3:3", "IF3 ADC"},
2125         {"DAI3 TX Mux", "1:1|2:1|3:3", "IF3 ADC"},
2126         {"DAI3 TX Mux", "1:2|2:2|3:3", "IF3 ADC"},
2127
2128         {"AIF1TX", NULL, "DAI1 TX Mux"},
2129         {"AIF1TX", NULL, "SDI1 TX Mux"},
2130         {"AIF2TX", NULL, "DAI2 TX Mux"},
2131         {"AIF2TX", NULL, "SDI2 TX Mux"},
2132         {"AIF3TX", NULL, "DAI3 TX Mux"},
2133
2134         {"DAI1 RX Mux", "1:1|2:2|3:3", "AIF1RX"},
2135         {"DAI1 RX Mux", "1:1|2:3|3:2", "AIF1RX"},
2136         {"DAI1 RX Mux", "1:1|2:1|3:3", "AIF1RX"},
2137         {"DAI1 RX Mux", "1:2|2:3|3:1", "AIF2RX"},
2138         {"DAI1 RX Mux", "1:2|2:1|3:3", "AIF2RX"},
2139         {"DAI1 RX Mux", "1:2|2:2|3:3", "AIF2RX"},
2140         {"DAI1 RX Mux", "1:3|2:1|3:2", "AIF3RX"},
2141         {"DAI1 RX Mux", "1:3|2:2|3:1", "AIF3RX"},
2142
2143         {"DAI2 RX Mux", "1:3|2:1|3:2", "AIF1RX"},
2144         {"DAI2 RX Mux", "1:2|2:1|3:3", "AIF1RX"},
2145         {"DAI2 RX Mux", "1:1|2:1|3:3", "AIF1RX"},
2146         {"DAI2 RX Mux", "1:1|2:2|3:3", "AIF2RX"},
2147         {"DAI2 RX Mux", "1:3|2:2|3:1", "AIF2RX"},
2148         {"DAI2 RX Mux", "1:2|2:2|3:3", "AIF2RX"},
2149         {"DAI2 RX Mux", "1:1|2:3|3:2", "AIF3RX"},
2150         {"DAI2 RX Mux", "1:2|2:3|3:1", "AIF3RX"},
2151
2152         {"DAI3 RX Mux", "1:3|2:2|3:1", "AIF1RX"},
2153         {"DAI3 RX Mux", "1:2|2:3|3:1", "AIF1RX"},
2154         {"DAI3 RX Mux", "1:1|2:3|3:2", "AIF2RX"},
2155         {"DAI3 RX Mux", "1:3|2:1|3:2", "AIF2RX"},
2156         {"DAI3 RX Mux", "1:1|2:2|3:3", "AIF3RX"},
2157         {"DAI3 RX Mux", "1:2|2:1|3:3", "AIF3RX"},
2158         {"DAI3 RX Mux", "1:1|2:1|3:3", "AIF3RX"},
2159         {"DAI3 RX Mux", "1:2|2:2|3:3", "AIF3RX"},
2160
2161         {"IF1 DAC", NULL, "I2S1"},
2162         {"IF1 DAC", NULL, "DAI1 RX Mux"},
2163         {"IF2 DAC", NULL, "I2S2"},
2164         {"IF2 DAC", NULL, "DAI2 RX Mux"},
2165         {"IF3 DAC", NULL, "I2S3"},
2166         {"IF3 DAC", NULL, "DAI3 RX Mux"},
2167
2168         {"IF1 DAC L", NULL, "IF1 DAC"},
2169         {"IF1 DAC R", NULL, "IF1 DAC"},
2170         {"IF2 DAC L", NULL, "IF2 DAC"},
2171         {"IF2 DAC R", NULL, "IF2 DAC"},
2172         {"IF3 DAC L", NULL, "IF3 DAC"},
2173         {"IF3 DAC R", NULL, "IF3 DAC"},
2174
2175         {"DAC MIXL", "Stereo ADC Switch", "Stereo ADC MIXL"},
2176         {"DAC MIXL", "INF1 Switch", "IF1 DAC L"},
2177         {"DAC MIXR", "Stereo ADC Switch", "Stereo ADC MIXR"},
2178         {"DAC MIXR", "INF1 Switch", "IF1 DAC R"},
2179
2180         {"ANC", NULL, "Stereo ADC MIXL"},
2181         {"ANC", NULL, "Stereo ADC MIXR"},
2182
2183         {"Audio DSP", NULL, "DAC MIXL"},
2184         {"Audio DSP", NULL, "DAC MIXR"},
2185
2186         {"DAC L2 Mux", "IF2", "IF2 DAC L"},
2187         {"DAC L2 Mux", "IF3", "IF3 DAC L"},
2188         {"DAC L2 Mux", "Base L/R", "Audio DSP"},
2189         {"DAC L2 Volume", NULL, "DAC L2 Mux"},
2190
2191         {"DAC R2 Mux", "IF2", "IF2 DAC R"},
2192         {"DAC R2 Mux", "IF3", "IF3 DAC R"},
2193         {"DAC R2 Volume", NULL, "Mono dacr Mux"},
2194         {"Mono dacr Mux", "TxDC_R", "DAC R2 Mux"},
2195         {"Mono dacr Mux", "TxDP_R", "IF2 ADC R Mux"},
2196
2197         {"Stereo DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
2198         {"Stereo DAC MIXL", "DAC L2 Switch", "DAC L2 Volume"},
2199         {"Stereo DAC MIXL", "ANC Switch", "ANC"},
2200         {"Stereo DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
2201         {"Stereo DAC MIXR", "DAC R2 Switch", "DAC R2 Volume"},
2202         {"Stereo DAC MIXR", "ANC Switch", "ANC"},
2203
2204         {"Mono DAC MIXL", "DAC L1 Switch", "DAC MIXL"},
2205         {"Mono DAC MIXL", "DAC L2 Switch", "DAC L2 Volume"},
2206         {"Mono DAC MIXL", "DAC R2 Switch", "DAC R2 Volume"},
2207         {"Mono DAC MIXR", "DAC R1 Switch", "DAC MIXR"},
2208         {"Mono DAC MIXR", "DAC R2 Switch", "DAC R2 Volume"},
2209         {"Mono DAC MIXR", "DAC L2 Switch", "DAC L2 Volume"},
2210
2211         {"DIG MIXL", "DAC L1 Switch", "DAC MIXL"},
2212         {"DIG MIXL", "DAC L2 Switch", "DAC L2 Volume"},
2213         {"DIG MIXR", "DAC R1 Switch", "DAC MIXR"},
2214         {"DIG MIXR", "DAC R2 Switch", "DAC R2 Volume"},
2215
2216         {"DAC L1", NULL, "Stereo DAC MIXL"},
2217         {"DAC L1", NULL, "PLL1", check_sysclk1_source},
2218         {"DAC R1", NULL, "Stereo DAC MIXR"},
2219         {"DAC R1", NULL, "PLL1", check_sysclk1_source},
2220
2221         {"SPK MIXL", "REC MIXL Switch", "RECMIXL"},
2222         {"SPK MIXL", "INL Switch", "INL VOL"},
2223         {"SPK MIXL", "DAC L1 Switch", "DAC L1"},
2224         {"SPK MIXL", "OUT MIXL Switch", "OUT MIXL"},
2225         {"SPK MIXR", "REC MIXR Switch", "RECMIXR"},
2226         {"SPK MIXR", "INR Switch", "INR VOL"},
2227         {"SPK MIXR", "DAC R1 Switch", "DAC R1"},
2228         {"SPK MIXR", "OUT MIXR Switch", "OUT MIXR"},
2229
2230         {"OUT MIXL", "BST3 Switch", "BST3"},
2231         {"OUT MIXL", "BST1 Switch", "BST1"},
2232         {"OUT MIXL", "INL Switch", "INL VOL"},
2233         {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
2234         {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
2235
2236         {"OUT MIXR", "BST3 Switch", "BST3"},
2237         {"OUT MIXR", "BST2 Switch", "BST2"},
2238         {"OUT MIXR", "BST1 Switch", "BST1"},
2239         {"OUT MIXR", "INR Switch", "INR VOL"},
2240         {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
2241         {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
2242
2243         {"SPKVOL L", NULL, "SPK MIXL"},
2244         {"SPKVOL R", NULL, "SPK MIXR"},
2245         {"HPOVOL L", NULL, "OUT MIXL"},
2246         {"HPOVOL R", NULL, "OUT MIXR"},
2247         {"OUTVOL L", NULL, "OUT MIXL"},
2248         {"OUTVOL R", NULL, "OUT MIXR"},
2249
2250         {"SPOL MIX", "DAC R1 Switch", "DAC R1"},
2251         {"SPOL MIX", "DAC L1 Switch", "DAC L1"},
2252         {"SPOL MIX", "SPKVOL R Switch", "SPKVOL R"},
2253         {"SPOL MIX", "SPKVOL L Switch", "SPKVOL L"},
2254         {"SPOL MIX", "BST1 Switch", "BST1"},
2255         {"SPOR MIX", "DAC R1 Switch", "DAC R1"},
2256         {"SPOR MIX", "SPKVOL R Switch", "SPKVOL R"},
2257         {"SPOR MIX", "BST1 Switch", "BST1"},
2258
2259         {"DAC 1", NULL, "DAC L1"},
2260         {"DAC 1", NULL, "DAC R1"},
2261         {"HPOVOL", NULL, "HPOVOL L"},
2262         {"HPOVOL", NULL, "HPOVOL R"},
2263         {"HPO MIX", "DAC1 Switch", "DAC 1"},
2264         {"HPO MIX", "HPVOL Switch", "HPOVOL"},
2265
2266         {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
2267         {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
2268         {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
2269         {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
2270
2271         {"SPK amp", NULL, "SPOL MIX"},
2272         {"SPK amp", NULL, "SPOR MIX"},
2273         {"SPOLP", NULL, "SPK amp"},
2274         {"SPOLN", NULL, "SPK amp"},
2275         {"SPORP", NULL, "SPK amp"},
2276         {"SPORN", NULL, "SPK amp"},
2277
2278         {"HP amp", NULL, "HPO MIX"},
2279         {"HPOL", NULL, "HP amp"},
2280         {"HPOR", NULL, "HP amp"},
2281
2282         {"LOUT amp", NULL, "LOUT MIX"},
2283         {"LOUTL", NULL, "LOUT amp"},
2284         {"LOUTR", NULL, "LOUT amp"},
2285 };
2286
2287 static int get_sdp_info(struct snd_soc_codec *codec, int dai_id)
2288 {
2289         int ret = 0, val;
2290
2291         if (codec == NULL)
2292                 return -EINVAL;
2293
2294         val = snd_soc_read(codec, RT5639_I2S1_SDP);
2295         val = (val & RT5639_I2S_IF_MASK) >> RT5639_I2S_IF_SFT;
2296         switch (dai_id) {
2297         case RT5639_AIF1:
2298                 if (val == RT5639_IF_123 || val == RT5639_IF_132 ||
2299                         val == RT5639_IF_113)
2300                         ret |= RT5639_U_IF1;
2301                 if (val == RT5639_IF_312 || val == RT5639_IF_213 ||
2302                         val == RT5639_IF_113)
2303                         ret |= RT5639_U_IF2;
2304                 if (val == RT5639_IF_321 || val == RT5639_IF_231)
2305                         ret |= RT5639_U_IF3;
2306                 break;
2307
2308         case RT5639_AIF2:
2309                 if (val == RT5639_IF_231 || val == RT5639_IF_213 ||
2310                         val == RT5639_IF_223)
2311                         ret |= RT5639_U_IF1;
2312                 if (val == RT5639_IF_123 || val == RT5639_IF_321 ||
2313                         val == RT5639_IF_223)
2314                         ret |= RT5639_U_IF2;
2315                 if (val == RT5639_IF_132 || val == RT5639_IF_312)
2316                         ret |= RT5639_U_IF3;
2317                 break;
2318
2319         default:
2320                 ret = -EINVAL;
2321                 break;
2322         }
2323
2324         return ret;
2325 }
2326
2327 static int get_clk_info(int sclk, int rate)
2328 {
2329         int i, pd[] = {1, 2, 3, 4, 6, 8, 12, 16};
2330
2331         if (sclk <= 0 || rate <= 0)
2332                 return -EINVAL;
2333
2334         rate = rate << 8;
2335         for (i = 0; i < ARRAY_SIZE(pd); i++)
2336                 if (sclk == rate * pd[i])
2337                         return i;
2338
2339         return -EINVAL;
2340 }
2341
2342 static int rt5639_hw_params(struct snd_pcm_substream *substream,
2343         struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
2344 {
2345         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2346         struct snd_soc_codec *codec = rtd->codec;
2347         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2348         unsigned int val_len = 0, val_clk, mask_clk, dai_sel;
2349         int pre_div, bclk_ms, frame_size;
2350
2351         rt5639->lrck[dai->id] = params_rate(params);
2352         pre_div = get_clk_info(rt5639->sysclk, rt5639->lrck[dai->id]);
2353         if (pre_div < 0) {
2354                 dev_err(codec->dev, "Unsupported clock setting\n");
2355                 return -EINVAL;
2356         }
2357         frame_size = snd_soc_params_to_frame_size(params);
2358         if (frame_size < 0) {
2359                 dev_err(codec->dev, "Unsupported frame size: %d\n", frame_size);
2360                 return -EINVAL;
2361         }
2362         bclk_ms = frame_size > 32 ? 1 : 0;
2363         rt5639->bclk[dai->id] = rt5639->lrck[dai->id] * (32 << bclk_ms);
2364
2365         dev_dbg(dai->dev, "bclk is %dHz and lrck is %dHz\n",
2366                 rt5639->bclk[dai->id], rt5639->lrck[dai->id]);
2367         dev_dbg(dai->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
2368                                 bclk_ms, pre_div, dai->id);
2369
2370         switch (params_format(params)) {
2371         case SNDRV_PCM_FORMAT_S16_LE:
2372                 break;
2373         case SNDRV_PCM_FORMAT_S20_3LE:
2374                 val_len |= RT5639_I2S_DL_20;
2375                 break;
2376         case SNDRV_PCM_FORMAT_S24_LE:
2377                 val_len |= RT5639_I2S_DL_24;
2378                 break;
2379         case SNDRV_PCM_FORMAT_S8:
2380                 val_len |= RT5639_I2S_DL_8;
2381                 break;
2382         default:
2383                 return -EINVAL;
2384         }
2385
2386         dai_sel = get_sdp_info(codec, dai->id);
2387         dai_sel |= (RT5639_U_IF1 | RT5639_U_IF2);
2388         if (dai_sel < 0) {
2389                 dev_err(codec->dev, "Failed to get sdp info: %d\n", dai_sel);
2390                 return -EINVAL;
2391         }
2392         if (dai_sel & RT5639_U_IF1) {
2393                 mask_clk = RT5639_I2S_BCLK_MS1_MASK | RT5639_I2S_PD1_MASK;
2394                 val_clk = bclk_ms << RT5639_I2S_BCLK_MS1_SFT |
2395                         pre_div << RT5639_I2S_PD1_SFT;
2396                 snd_soc_update_bits(codec, RT5639_I2S1_SDP,
2397                         RT5639_I2S_DL_MASK, val_len);
2398                 snd_soc_update_bits(codec, RT5639_ADDA_CLK1, mask_clk, val_clk);
2399         }
2400         if (dai_sel & RT5639_U_IF2) {
2401                 mask_clk = RT5639_I2S_BCLK_MS2_MASK | RT5639_I2S_PD2_MASK;
2402                 val_clk = bclk_ms << RT5639_I2S_BCLK_MS2_SFT |
2403                         pre_div << RT5639_I2S_PD2_SFT;
2404                 snd_soc_update_bits(codec, RT5639_I2S2_SDP,
2405                         RT5639_I2S_DL_MASK, val_len);
2406                 snd_soc_update_bits(codec, RT5639_ADDA_CLK1, mask_clk, val_clk);
2407         }
2408
2409         return 0;
2410 }
2411
2412 static int rt5639_prepare(struct snd_pcm_substream *substream,
2413                                 struct snd_soc_dai *dai)
2414 {
2415         struct snd_soc_pcm_runtime *rtd = substream->private_data;
2416         struct snd_soc_codec *codec = rtd->codec;
2417         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2418
2419         rt5639->aif_pu = dai->id;
2420         return 0;
2421 }
2422
2423 static int rt5639_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2424 {
2425         struct snd_soc_codec *codec = dai->codec;
2426         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2427         unsigned int reg_val = 0, dai_sel;
2428
2429         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2430         case SND_SOC_DAIFMT_CBM_CFM:
2431                 rt5639->master[dai->id] = 1;
2432                 break;
2433         case SND_SOC_DAIFMT_CBS_CFS:
2434                 reg_val |= RT5639_I2S_MS_S;
2435                 rt5639->master[dai->id] = 0;
2436                 break;
2437         default:
2438                 return -EINVAL;
2439         }
2440
2441         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2442         case SND_SOC_DAIFMT_NB_NF:
2443                 break;
2444         case SND_SOC_DAIFMT_IB_NF:
2445                 reg_val |= RT5639_I2S_BP_INV;
2446                 break;
2447         default:
2448                 return -EINVAL;
2449         }
2450
2451         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2452         case SND_SOC_DAIFMT_I2S:
2453                 break;
2454         case SND_SOC_DAIFMT_LEFT_J:
2455                 reg_val |= RT5639_I2S_DF_LEFT;
2456                 break;
2457         case SND_SOC_DAIFMT_DSP_A:
2458                 reg_val |= RT5639_I2S_DF_PCM_A;
2459                 break;
2460         case SND_SOC_DAIFMT_DSP_B:
2461                 reg_val |= RT5639_I2S_DF_PCM_B;
2462                 break;
2463         default:
2464                 return -EINVAL;
2465         }
2466
2467         dai_sel = get_sdp_info(codec, dai->id);
2468         if (dai_sel < 0) {
2469                 dev_err(codec->dev, "Failed to get sdp info: %d\n", dai_sel);
2470                 return -EINVAL;
2471         }
2472         if (dai_sel & RT5639_U_IF1) {
2473                 snd_soc_update_bits(codec, RT5639_I2S1_SDP,
2474                         RT5639_I2S_MS_MASK | RT5639_I2S_BP_MASK |
2475                         RT5639_I2S_DF_MASK, reg_val);
2476         }
2477         if (dai_sel & RT5639_U_IF2) {
2478                 snd_soc_update_bits(codec, RT5639_I2S2_SDP,
2479                         RT5639_I2S_MS_MASK | RT5639_I2S_BP_MASK |
2480                         RT5639_I2S_DF_MASK, reg_val);
2481         }
2482
2483         return 0;
2484 }
2485
2486 static int rt5639_set_dai_sysclk(struct snd_soc_dai *dai,
2487                 int clk_id, unsigned int freq, int dir)
2488 {
2489         struct snd_soc_codec *codec = dai->codec;
2490         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2491         unsigned int reg_val = 0;
2492
2493         if (freq == rt5639->sysclk && clk_id == rt5639->sysclk_src)
2494                 return 0;
2495
2496         switch (clk_id) {
2497         case RT5639_SCLK_S_MCLK:
2498                 reg_val |= RT5639_SCLK_SRC_MCLK;
2499                 break;
2500         case RT5639_SCLK_S_PLL1:
2501                 reg_val |= RT5639_SCLK_SRC_PLL1;
2502                 break;
2503         case RT5639_SCLK_S_RCCLK:
2504                 reg_val |= RT5639_SCLK_SRC_RCCLK;
2505                 break;
2506         default:
2507                 dev_err(codec->dev, "Invalid clock id (%d)\n", clk_id);
2508                 return -EINVAL;
2509         }
2510         snd_soc_update_bits(codec, RT5639_GLB_CLK,
2511                 RT5639_SCLK_SRC_MASK, reg_val);
2512         rt5639->sysclk = freq;
2513         rt5639->sysclk_src = clk_id;
2514
2515         dev_dbg(dai->dev, "Sysclk is %dHz and clock id is %d\n", freq, clk_id);
2516
2517         return 0;
2518 }
2519
2520 /**
2521  * rt5639_pll_calc - Calcualte PLL M/N/K code.
2522  * @freq_in: external clock provided to codec.
2523  * @freq_out: target clock which codec works on.
2524  * @pll_code: Pointer to structure with M, N, K and bypass flag.
2525  *
2526  * Calcualte M/N/K code to configure PLL for codec. And K is assigned to 2
2527  * which make calculation more efficiently.
2528  *
2529  * Returns 0 for success or negative error code.
2530  */
2531 static int rt5639_pll_calc(const unsigned int freq_in,
2532         const unsigned int freq_out, struct rt5639_pll_code *pll_code)
2533 {
2534         int max_n = RT5639_PLL_N_MAX, max_m = RT5639_PLL_M_MAX;
2535         int k, n = 0, m = 0, red, n_t, m_t, pll_out, in_t, out_t;
2536         int red_t = abs(freq_out - freq_in);
2537         bool bypass = false;
2538
2539         if (RT5639_PLL_INP_MAX < freq_in || RT5639_PLL_INP_MIN > freq_in)
2540                 return -EINVAL;
2541
2542         k = 100000000 / freq_out - 2;
2543         if (k > RT5639_PLL_K_MAX)
2544                 k = RT5639_PLL_K_MAX;
2545         for (n_t = 0; n_t <= max_n; n_t++) {
2546                 in_t = freq_in / (k + 2);
2547                 pll_out = freq_out / (n_t + 2);
2548                 if (in_t < 0)
2549                         continue;
2550                 if (in_t == pll_out) {
2551                         bypass = true;
2552                         n = n_t;
2553                         goto code_find;
2554                 }
2555
2556                 red = abs(in_t - pll_out);
2557
2558                 if (red < red_t) {
2559                         bypass = true;
2560                         n = n_t;
2561                         m = m_t;
2562                         if (red == 0)
2563                                 goto code_find;
2564                         red_t = red;
2565                 }
2566                 for (m_t = 0; m_t <= max_m; m_t++) {
2567                         out_t = in_t / (m_t + 2);
2568                         red = abs(out_t - pll_out);
2569                         if (red < red_t) {
2570                                 bypass = false;
2571                                 n = n_t;
2572                                 m = m_t;
2573                                 if (red == 0)
2574                                         goto code_find;
2575                                 red_t = red;
2576                         }
2577                 }
2578         }
2579         pr_debug("Only get approximation about PLL\n");
2580
2581 code_find:
2582
2583         pll_code->m_bp = bypass;
2584         pll_code->m_code = m;
2585         pll_code->n_code = n;
2586         pll_code->k_code = k;
2587         return 0;
2588 }
2589
2590 static int rt5639_set_dai_pll(struct snd_soc_dai *dai, int pll_id, int source,
2591                         unsigned int freq_in, unsigned int freq_out)
2592 {
2593         struct snd_soc_codec *codec = dai->codec;
2594         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2595         struct rt5639_pll_code pll_code;
2596         int ret, dai_sel;
2597
2598         if (source == rt5639->pll_src && freq_in == rt5639->pll_in &&
2599             freq_out == rt5639->pll_out)
2600                 return 0;
2601
2602         if (!freq_in || !freq_out) {
2603                 dev_dbg(codec->dev, "PLL disabled\n");
2604
2605                 rt5639->pll_in = 0;
2606                 rt5639->pll_out = 0;
2607                 snd_soc_update_bits(codec, RT5639_GLB_CLK,
2608                         RT5639_SCLK_SRC_MASK, RT5639_SCLK_SRC_MCLK);
2609                 return 0;
2610         }
2611
2612         switch (source) {
2613         case RT5639_PLL1_S_MCLK:
2614                 snd_soc_update_bits(codec, RT5639_GLB_CLK,
2615                         RT5639_PLL1_SRC_MASK, RT5639_PLL1_SRC_MCLK);
2616                 break;
2617         case RT5639_PLL1_S_BCLK1:
2618         case RT5639_PLL1_S_BCLK2:
2619                 dai_sel = get_sdp_info(codec, dai->id);
2620                 if (dai_sel < 0) {
2621                         dev_err(codec->dev,
2622                                 "Failed to get sdp info: %d\n", dai_sel);
2623                         return -EINVAL;
2624                 }
2625                 if (dai_sel & RT5639_U_IF1) {
2626                         snd_soc_update_bits(codec, RT5639_GLB_CLK,
2627                                 RT5639_PLL1_SRC_MASK, RT5639_PLL1_SRC_BCLK1);
2628                 }
2629                 if (dai_sel & RT5639_U_IF2) {
2630                         snd_soc_update_bits(codec, RT5639_GLB_CLK,
2631                                 RT5639_PLL1_SRC_MASK, RT5639_PLL1_SRC_BCLK2);
2632                 }
2633                 if (dai_sel & RT5639_U_IF3) {
2634                         snd_soc_update_bits(codec, RT5639_GLB_CLK,
2635                                 RT5639_PLL1_SRC_MASK, RT5639_PLL1_SRC_BCLK3);
2636                 }
2637                 break;
2638         default:
2639                 dev_err(codec->dev, "Unknown PLL source %d\n", source);
2640                 return -EINVAL;
2641         }
2642
2643         ret = rt5639_pll_calc(freq_in, freq_out, &pll_code);
2644         if (ret < 0) {
2645                 dev_err(codec->dev, "Unsupport input clock %d\n", freq_in);
2646                 return ret;
2647         }
2648
2649         dev_dbg(codec->dev, "bypass=%d m=%d n=%d k=%d\n", pll_code.m_bp,
2650                 (pll_code.m_bp ? 0 : pll_code.m_code),
2651                 pll_code.n_code, pll_code.k_code);
2652
2653         snd_soc_write(codec, RT5639_PLL_CTRL1,
2654                 pll_code.n_code << RT5639_PLL_N_SFT | pll_code.k_code);
2655         snd_soc_write(codec, RT5639_PLL_CTRL2,
2656                 (pll_code.m_bp ? 0 : pll_code.m_code) << RT5639_PLL_M_SFT |
2657                 pll_code.m_bp << RT5639_PLL_M_BP_SFT);
2658
2659         rt5639->pll_in = freq_in;
2660         rt5639->pll_out = freq_out;
2661         rt5639->pll_src = source;
2662
2663         return 0;
2664 }
2665
2666 /**
2667  * rt5639_index_show - Dump private registers.
2668  * @dev: codec device.
2669  * @attr: device attribute.
2670  * @buf: buffer for display.
2671  *
2672  * To show non-zero values of all private registers.
2673  *
2674  * Returns buffer length.
2675  */
2676 static ssize_t rt5639_index_show(struct device *dev,
2677         struct device_attribute *attr, char *buf)
2678 {
2679         struct i2c_client *client = to_i2c_client(dev);
2680         struct rt5639_priv *rt5639 = i2c_get_clientdata(client);
2681         struct snd_soc_codec *codec = rt5639->codec;
2682         unsigned int val;
2683         int cnt = 0, i;
2684
2685         cnt += sprintf(buf, "RT5639 index register\n");
2686         for (i = 0; i < 0xb4; i++) {
2687                 if (cnt + RT5639_REG_DISP_LEN >= PAGE_SIZE)
2688                         break;
2689                 val = rt5639_index_read(codec, i);
2690                 if (!val)
2691                         continue;
2692                 cnt += snprintf(buf + cnt, RT5639_REG_DISP_LEN,
2693                                 "%02x: %04x\n", i, val);
2694         }
2695
2696         if (cnt >= PAGE_SIZE)
2697                 cnt = PAGE_SIZE - 1;
2698
2699         return cnt;
2700 }
2701
2702 static ssize_t rt5639_index_store(struct device *dev,
2703                 struct device_attribute *attr, const char *buf, size_t count)
2704 {
2705         struct i2c_client *client = to_i2c_client(dev);
2706         struct rt5639_priv *rt5639 = i2c_get_clientdata(client);
2707         struct snd_soc_codec *codec = rt5639->codec;
2708         unsigned int val = 0, addr = 0;
2709         int i;
2710
2711         dev_info(codec->dev, "register \"%s\" count=%d\n", buf, count);
2712         for (i = 0; i < count; i++) { /*address*/
2713                 if (*(buf+i) <= '9' && *(buf+i) >= '0')
2714                         addr = (addr << 4) | (*(buf+i)-'0');
2715                 else if (*(buf+i) <= 'f' && *(buf+i) >= 'a')
2716                         addr = (addr << 4) | ((*(buf+i) - 'a')+0xa);
2717                 else if (*(buf+i) <= 'F' && *(buf+i) >= 'A')
2718                         addr = (addr << 4) | ((*(buf+i) - 'A')+0xa);
2719                 else
2720                         break;
2721         }
2722
2723         for (i = i+1; i < count; i++) { /*val*/
2724                 if (*(buf+i) <= '9' && *(buf+i) >= '0')
2725                         val = (val << 4) | (*(buf+i) - '0');
2726                 else if (*(buf+i) <= 'f' && *(buf+i) >= 'a')
2727                         val = (val << 4) | ((*(buf+i) - 'a') + 0xa);
2728                 else if (*(buf+i) <= 'F' && *(buf+i) >= 'A')
2729                         val = (val << 4) | ((*(buf+i) - 'A') + 0xa);
2730                 else
2731                         break;
2732         }
2733         dev_info(codec->dev, "addr=0x%x val=0x%x\n", addr, val);
2734         if (addr > RT5639_VENDOR_ID2 || val > 0xffff || val < 0)
2735                 return count;
2736
2737         if (i == count)
2738                 dev_info(codec->dev, "0x%02x = 0x%04x\n", addr,
2739                         rt5639_index_read(codec, addr));
2740         else
2741                 rt5639_index_write(codec, addr, val);
2742
2743         return count;
2744 }
2745 static DEVICE_ATTR(index_reg, 0444, rt5639_index_show, rt5639_index_store);
2746
2747 static ssize_t rt5639_codec_show(struct device *dev,
2748         struct device_attribute *attr, char *buf)
2749 {
2750         struct i2c_client *client = to_i2c_client(dev);
2751         struct rt5639_priv *rt5639 = i2c_get_clientdata(client);
2752         struct snd_soc_codec *codec = rt5639->codec;
2753         unsigned int val;
2754         int cnt = 0, i;
2755
2756         cnt += sprintf(buf, "RT5639 codec register\n");
2757         for (i = 0; i <= RT5639_VENDOR_ID2; i++) {
2758                 if (cnt + RT5639_REG_DISP_LEN >= PAGE_SIZE)
2759                         break;
2760                 val = codec->hw_read(codec, i);
2761                 if (!val)
2762                         continue;
2763                 cnt += snprintf(buf + cnt, RT5639_REG_DISP_LEN,
2764                                 "#rng%02x  #rv%04x  #rd0\n", i, val);
2765         }
2766
2767         if (cnt >= PAGE_SIZE)
2768                 cnt = PAGE_SIZE - 1;
2769
2770         return cnt;
2771 }
2772
2773 static ssize_t rt5639_codec_store(struct device *dev,
2774                 struct device_attribute *attr, const char *buf, size_t count)
2775 {
2776         struct i2c_client *client = to_i2c_client(dev);
2777         struct rt5639_priv *rt5639 = i2c_get_clientdata(client);
2778         struct snd_soc_codec *codec = rt5639->codec;
2779         unsigned int val = 0, addr = 0;
2780         int i;
2781
2782         dev_info(codec->dev, "register \"%s\" count=%d\n", buf, count);
2783         for (i = 0; i < count; i++) {/*address*/
2784                 if (*(buf+i) <= '9' && *(buf+i) >= '0')
2785                         addr = (addr << 4) | (*(buf+i)-'0');
2786                 else if (*(buf+i) <= 'f' && *(buf+i) >= 'a')
2787                         addr = (addr << 4) | ((*(buf+i) - 'a') + 0xa);
2788                 else if (*(buf+i) <= 'F' && *(buf+i) >= 'A')
2789                         addr = (addr << 4) | ((*(buf+i) - 'A') + 0xa);
2790                 else
2791                         break;
2792         }
2793
2794         for (i = i+1; i < count; i++) {/*val*/
2795                 if (*(buf+i) <= '9' && *(buf+i) >= '0')
2796                         val = (val << 4) | (*(buf+i) - '0');
2797                 else if (*(buf+i) <= 'f' && *(buf+i) >= 'a')
2798                         val = (val << 4) | ((*(buf+i) - 'a') + 0xa);
2799                 else if (*(buf+i) <= 'F' && *(buf+i) >= 'A')
2800                         val = (val << 4) | ((*(buf+i) - 'A') + 0xa);
2801                 else
2802                         break;
2803         }
2804         dev_info(codec->dev, "addr=0x%x val=0x%x\n", addr, val);
2805         if (addr > RT5639_VENDOR_ID2 || val > 0xffff || val < 0)
2806                 return count;
2807
2808         if (i == count)
2809                 dev_info(codec->dev, "0x%02x = 0x%04x\n", addr,
2810                         codec->hw_read(codec, addr));
2811         else
2812                 snd_soc_write(codec, addr, val);
2813
2814         return count;
2815 }
2816
2817 static DEVICE_ATTR(codec_reg, 0644, rt5639_codec_show, rt5639_codec_store);
2818
2819 static int rt5639_set_bias_level(struct snd_soc_codec *codec,
2820                         enum snd_soc_bias_level level)
2821 {
2822         switch (level) {
2823         case SND_SOC_BIAS_ON:
2824                 break;
2825
2826         case SND_SOC_BIAS_PREPARE:
2827                 snd_soc_update_bits(codec, RT5639_PWR_ANLG2,
2828                         RT5639_PWR_MB1 | RT5639_PWR_MB2,
2829                         RT5639_PWR_MB1 | RT5639_PWR_MB2);
2830                 break;
2831
2832         case SND_SOC_BIAS_STANDBY:
2833                 snd_soc_update_bits(codec, RT5639_PWR_ANLG2,
2834                         RT5639_PWR_MB1 | RT5639_PWR_MB2, 0);
2835                 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level) {
2836                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
2837                                 RT5639_PWR_VREF1 | RT5639_PWR_MB |
2838                                 RT5639_PWR_BG | RT5639_PWR_VREF2,
2839                                 RT5639_PWR_VREF1 | RT5639_PWR_MB |
2840                                 RT5639_PWR_BG | RT5639_PWR_VREF2);
2841                         msleep(5);
2842                         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
2843                                 RT5639_PWR_FV1 | RT5639_PWR_FV2,
2844                                 RT5639_PWR_FV1 | RT5639_PWR_FV2);
2845                         snd_soc_write(codec, RT5639_GEN_CTRL1, 0x3701);
2846                         codec->cache_only = false;
2847                         codec->cache_sync = 1;
2848                         snd_soc_cache_sync(codec);
2849                         rt5639_index_sync(codec);
2850                 }
2851                 break;
2852
2853         case SND_SOC_BIAS_OFF:
2854                 snd_soc_write(codec, RT5639_DEPOP_M1, 0x0004);
2855                 snd_soc_write(codec, RT5639_DEPOP_M2, 0x1100);
2856                 snd_soc_write(codec, RT5639_GEN_CTRL1, 0x3700);
2857                 snd_soc_write(codec, RT5639_PWR_DIG1, 0x0000);
2858                 snd_soc_write(codec, RT5639_PWR_DIG2, 0x0000);
2859                 snd_soc_write(codec, RT5639_PWR_VOL, 0x0000);
2860                 snd_soc_write(codec, RT5639_PWR_MIXER, 0x0000);
2861                 snd_soc_write(codec, RT5639_PWR_ANLG1, 0x0000);
2862                 snd_soc_write(codec, RT5639_PWR_ANLG2, 0x0000);
2863                 break;
2864
2865         default:
2866                 break;
2867         }
2868         codec->dapm.bias_level = level;
2869
2870         return 0;
2871 }
2872
2873 static int rt5639_probe(struct snd_soc_codec *codec)
2874 {
2875         struct rt5639_priv *rt5639 = snd_soc_codec_get_drvdata(codec);
2876         int ret;
2877
2878         pr_info("Codec driver version %s\n", VERSION);
2879
2880         ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
2881         if (ret != 0) {
2882                 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
2883                 return ret;
2884         }
2885
2886         rt5639_reset(codec);
2887         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
2888                 RT5639_PWR_VREF1 | RT5639_PWR_MB |
2889                 RT5639_PWR_BG | RT5639_PWR_VREF2,
2890                 RT5639_PWR_VREF1 | RT5639_PWR_MB |
2891                 RT5639_PWR_BG | RT5639_PWR_VREF2);
2892         msleep(10);
2893         snd_soc_update_bits(codec, RT5639_PWR_ANLG1,
2894                 RT5639_PWR_FV1 | RT5639_PWR_FV2,
2895                 RT5639_PWR_FV1 | RT5639_PWR_FV2);
2896         /* DMIC */
2897         if (rt5639->dmic_en == RT5639_DMIC1) {
2898                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
2899                         RT5639_GP2_PIN_MASK, RT5639_GP2_PIN_DMIC1_SCL);
2900                 snd_soc_update_bits(codec, RT5639_DMIC,
2901                         RT5639_DMIC_1L_LH_MASK | RT5639_DMIC_1R_LH_MASK,
2902                         RT5639_DMIC_1L_LH_FALLING | RT5639_DMIC_1R_LH_RISING);
2903         } else if (rt5639->dmic_en == RT5639_DMIC2) {
2904                 snd_soc_update_bits(codec, RT5639_GPIO_CTRL1,
2905                         RT5639_GP2_PIN_MASK, RT5639_GP2_PIN_DMIC1_SCL);
2906                 snd_soc_update_bits(codec, RT5639_DMIC,
2907                         RT5639_DMIC_2L_LH_MASK | RT5639_DMIC_2R_LH_MASK,
2908                         RT5639_DMIC_2L_LH_FALLING | RT5639_DMIC_2R_LH_RISING);
2909         }
2910         /*snd_soc_write(codec, RT5639_GEN_CTRL2, 0x4040);*/
2911         /* Enable JD2 Function for Extra JD Status */
2912         snd_soc_write(codec, RT5639_GEN_CTRL2, 0x4140);
2913         ret = snd_soc_read(codec, RT5639_VENDOR_ID);
2914         dev_info(codec->dev, "read 0x%x=0x%x\n", RT5639_VENDOR_ID, ret);
2915         if (0x5 == ret) {
2916                 snd_soc_update_bits(codec, RT5639_JD_CTRL,
2917                         RT5639_JD1_IN4P_MASK | RT5639_JD2_IN4N_MASK,
2918                         RT5639_JD1_IN4P_EN | RT5639_JD2_IN4N_EN);
2919         }
2920         rt5639_reg_init(codec);
2921         DC_Calibrate(codec);
2922         codec->dapm.bias_level = SND_SOC_BIAS_STANDBY;
2923         rt5639->codec = codec;
2924
2925         snd_soc_add_codec_controls(codec, rt5639_snd_controls,
2926                         ARRAY_SIZE(rt5639_snd_controls));
2927         snd_soc_dapm_new_controls(&codec->dapm, rt5639_dapm_widgets,
2928                         ARRAY_SIZE(rt5639_dapm_widgets));
2929         snd_soc_dapm_add_routes(&codec->dapm, rt5639_dapm_routes,
2930                         ARRAY_SIZE(rt5639_dapm_routes));
2931
2932
2933 #ifdef RTK_IOCTL
2934 #if defined(CONFIG_SND_HWDEP) || defined(CONFIG_SND_HWDEP_MODULE)
2935         {
2936                 struct rt56xx_ops *ioctl_ops = rt56xx_get_ioctl_ops();
2937                 ioctl_ops->index_write = rt5639_index_write;
2938                 ioctl_ops->index_read = rt5639_index_read;
2939                 ioctl_ops->index_update_bits = rt5639_index_update_bits;
2940                 ioctl_ops->ioctl_common = rt5639_ioctl_common;
2941                 realtek_ce_init_hwdep(codec);
2942         }
2943 #endif
2944 #endif
2945
2946         ret = device_create_file(codec->dev, &dev_attr_index_reg);
2947         if (ret != 0) {
2948                 dev_err(codec->dev,
2949                         "Failed to create index_reg sysfs files: %d\n", ret);
2950                 return ret;
2951         }
2952
2953         ret = device_create_file(codec->dev, &dev_attr_codec_reg);
2954         if (ret != 0) {
2955                 dev_err(codec->dev,
2956                         "Failed to create codex_reg sysfs files: %d\n", ret);
2957                 return ret;
2958         }
2959
2960         return 0;
2961 }
2962
2963 static int rt5639_remove(struct snd_soc_codec *codec)
2964 {
2965         rt5639_set_bias_level(codec, SND_SOC_BIAS_OFF);
2966         return 0;
2967 }
2968
2969 #ifdef CONFIG_PM
2970 static int rt5639_suspend(struct snd_soc_codec *codec)
2971 {
2972         rt5639_set_bias_level(codec, SND_SOC_BIAS_OFF);
2973         return 0;
2974 }
2975
2976 static int rt5639_resume(struct snd_soc_codec *codec)
2977 {
2978         rt5639_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2979         return 0;
2980 }
2981 #else
2982 #define rt5639_suspend NULL
2983 #define rt5639_resume NULL
2984 #endif
2985
2986 #define RT5639_STEREO_RATES SNDRV_PCM_RATE_8000_96000
2987 #define RT5639_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
2988                         SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
2989
2990 struct snd_soc_dai_ops rt5639_aif_dai_ops = {
2991         .hw_params = rt5639_hw_params,
2992         .prepare = rt5639_prepare,
2993         .set_fmt = rt5639_set_dai_fmt,
2994         .set_sysclk = rt5639_set_dai_sysclk,
2995         .set_pll = rt5639_set_dai_pll,
2996 };
2997
2998 struct snd_soc_dai_driver rt5639_dai[] = {
2999         {
3000                 .name = "rt5639-aif1",
3001                 .id = RT5639_AIF1,
3002                 .playback = {
3003                         .stream_name = "AIF1 Playback",
3004                         .channels_min = 1,
3005                         .channels_max = 2,
3006                         .rates = RT5639_STEREO_RATES,
3007                         .formats = RT5639_FORMATS,
3008                 },
3009                 .capture = {
3010                         .stream_name = "AIF1 Capture",
3011                         .channels_min = 1,
3012                         .channels_max = 2,
3013                         .rates = RT5639_STEREO_RATES,
3014                         .formats = RT5639_FORMATS,
3015                 },
3016                 .ops = &rt5639_aif_dai_ops,
3017         },
3018         {
3019                 .name = "rt5639-aif2",
3020                 .id = RT5639_AIF2,
3021                 .playback = {
3022                         .stream_name = "AIF2 Playback",
3023                         .channels_min = 1,
3024                         .channels_max = 2,
3025                         .rates = RT5639_STEREO_RATES,
3026                         .formats = RT5639_FORMATS,
3027                 },
3028                 .capture = {
3029                         .stream_name = "AIF2 Capture",
3030                         .channels_min = 1,
3031                         .channels_max = 2,
3032                         .rates = RT5639_STEREO_RATES,
3033                         .formats = RT5639_FORMATS,
3034                 },
3035                 .ops = &rt5639_aif_dai_ops,
3036         },
3037 };
3038
3039 static struct snd_soc_codec_driver soc_codec_dev_rt5639 = {
3040         .probe = rt5639_probe,
3041         .remove = rt5639_remove,
3042         .suspend = rt5639_suspend,
3043         .resume = rt5639_resume,
3044         .set_bias_level = rt5639_set_bias_level,
3045         .reg_cache_size = RT5639_VENDOR_ID2 + 1,
3046         .reg_word_size = sizeof(u16),
3047         .reg_cache_default = rt5639_reg,
3048         .volatile_register = rt5639_volatile_register,
3049         .readable_register = rt5639_readable_register,
3050         .reg_cache_step = 1,
3051 };
3052
3053 static const struct i2c_device_id rt5639_i2c_id[] = {
3054         { "rt5639", 0 },
3055         { }
3056 };
3057 MODULE_DEVICE_TABLE(i2c, rt5639_i2c_id);
3058
3059 static int __devinit rt5639_i2c_probe(struct i2c_client *i2c,
3060                     const struct i2c_device_id *id)
3061 {
3062         struct rt5639_priv *rt5639;
3063         int ret;
3064
3065         rt5639 = kzalloc(sizeof(struct rt5639_priv), GFP_KERNEL);
3066         if (NULL == rt5639)
3067                 return -ENOMEM;
3068
3069         i2c_set_clientdata(i2c, rt5639);
3070
3071         ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5639,
3072                         rt5639_dai, ARRAY_SIZE(rt5639_dai));
3073         if (ret < 0)
3074                 kfree(rt5639);
3075
3076         return ret;
3077 }
3078
3079 static int __devexit rt5639_i2c_remove(struct i2c_client *i2c)
3080 {
3081         snd_soc_unregister_codec(&i2c->dev);
3082         kfree(i2c_get_clientdata(i2c));
3083         return 0;
3084 }
3085
3086 static void rt5639_i2c_shutdown(struct i2c_client *client)
3087 {
3088         struct rt5639_priv *rt5639 = i2c_get_clientdata(client);
3089         struct snd_soc_codec *codec = rt5639->codec;
3090
3091         if (codec != NULL)
3092                 rt5639_set_bias_level(codec, SND_SOC_BIAS_OFF);
3093
3094 }
3095
3096 struct i2c_driver rt5639_i2c_driver = {
3097         .driver = {
3098                 .name = "rt5639",
3099                 .owner = THIS_MODULE,
3100         },
3101         .probe = rt5639_i2c_probe,
3102         .remove   = __devexit_p(rt5639_i2c_remove),
3103         .shutdown = rt5639_i2c_shutdown,
3104         .id_table = rt5639_i2c_id,
3105 };
3106
3107 static int __init rt5639_modinit(void)
3108 {
3109         return i2c_add_driver(&rt5639_i2c_driver);
3110 }
3111 module_init(rt5639_modinit);
3112
3113 static void __exit rt5639_modexit(void)
3114 {
3115         i2c_del_driver(&rt5639_i2c_driver);
3116 }
3117 module_exit(rt5639_modexit);
3118
3119 MODULE_DESCRIPTION("ASoC RT5639 driver");
3120 MODULE_AUTHOR("Johnny Hsu <johnnyhsu@realtek.com>");
3121 MODULE_LICENSE("GPL");