sound/soc/codecs/rt5639.c

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