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