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