sound/soc/codecs/rt5616.c

   1 /*
   2  * rt5616.c  --  RT5616 ALSA SoC audio codec driver
   3  *
   4  * Copyright 2012 Realtek Semiconductor Corp.
   5  * Author: Bard Liao <bardliao@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 #include "rt5616.h"
  29
  30 #define POWER_ON_MICBIAS1
  31
  32 struct rt5616_init_reg {
  33         u8 reg;
  34         u16 val;
  35 };
  36
  37 static struct rt5616_init_reg init_list[] = {
  38         {RT5616_D_MISC          , 0x0011},
  39         {RT5616_PRIV_INDEX      , 0x003d},
  40         {RT5616_PRIV_DATA       , 0x3e00},
  41         {RT5616_PRIV_INDEX      , 0x0025}, //PR-25 = 6110
  42         {RT5616_PRIV_DATA       , 0x6110},
  43         /*Playback*/
  44         {RT5616_STO_DAC_MIXER   , 0x1212},
  45         /*HP*/
  46         //{RT5616_HPO_MIXER     , 0x2000}, //DAC -> HPO
  47         {RT5616_HPO_MIXER       , 0x4000}, //HPVOL -> HPO
  48         {RT5616_HP_VOL          , 0x8888}, //unmute HPVOL
  49         {RT5616_OUT_L3_MIXER    , 0x0278}, //DACL1 -> OUTMIXL
  50         {RT5616_OUT_R3_MIXER    , 0x0278}, //DACR1 -> OUTMIXR
  51         /*LOUT*/
  52         {RT5616_LOUT_MIXER      , 0x3000},
  53         /*Capture*/
  54         //{RT5616_REC_L2_MIXER  , 0x006d}, //MIC1 -> RECMIXL
  55         //{RT5616_REC_R2_MIXER  , 0x006d}, //MIC1 -> RECMIXR
  56         {RT5616_REC_L2_MIXER    , 0x006b}, //MIC2 -> RECMIXL
  57         {RT5616_REC_R2_MIXER    , 0x006b}, //MIC2 -> RECMIXR
  58         {RT5616_ADC_DIG_VOL     , 0xafaf}, //mute adc for pop noise
  59         /*MIC*/
  60         {RT5616_STO1_ADC_MIXER  , 0x3802},
  61         {RT5616_IN1_IN2         , 0x0100} //20db
  62 };
  63 #define RT5616_INIT_REG_LEN ARRAY_SIZE(init_list)
  64
  65 static struct snd_soc_codec *rt5616_codec;
  66
  67 static int rt5616_reg_init(struct snd_soc_codec *codec)
  68 {
  69         int i;
  70
  71         for (i = 0; i < RT5616_INIT_REG_LEN; i++)
  72                 snd_soc_write(codec, init_list[i].reg, init_list[i].val);
  73
  74         return 0;
  75 }
  76
  77 static int rt5616_index_sync(struct snd_soc_codec *codec)
  78 {
  79         int i;
  80
  81         for (i = 0; i < RT5616_INIT_REG_LEN; i++)
  82                 if (RT5616_PRIV_INDEX == init_list[i].reg ||
  83                         RT5616_PRIV_DATA == init_list[i].reg)
  84                         snd_soc_write(codec, init_list[i].reg,
  85                                         init_list[i].val);
  86         return 0;
  87 }
  88
  89 static const u16 rt5616_reg[RT5616_DEVICE_ID + 1] = {
  90         [RT5616_RESET] = 0x0020,
  91         [RT5616_HP_VOL] = 0xc8c8,
  92         [RT5616_LOUT_CTRL1] = 0xc8c8,
  93         [RT5616_INL1_INR1_VOL] = 0x0808,
  94         [RT5616_DAC1_DIG_VOL] = 0xafaf,
  95         [RT5616_ADC_DIG_VOL] = 0x2f2f,
  96         [RT5616_STO1_ADC_MIXER] = 0x7860,
  97         [RT5616_AD_DA_MIXER] = 0x8080,
  98         [RT5616_STO_DAC_MIXER] = 0x5252,
  99         [RT5616_REC_L2_MIXER] = 0x006f,
 100         [RT5616_REC_R2_MIXER] = 0x006f,
 101         [RT5616_HPO_MIXER] = 0x6000,
 102         [RT5616_OUT_L3_MIXER] = 0x0279,
 103         [RT5616_OUT_R3_MIXER] = 0x0279,
 104         [RT5616_LOUT_MIXER] = 0xf000,
 105         [RT5616_PWR_ANLG1] = 0x00c0,
 106         [RT5616_I2S1_SDP] = 0x8000,
 107         [RT5616_ADDA_CLK1] = 0x1104,
 108         [RT5616_ADDA_CLK2] = 0x0c00,
 109         [RT5616_HP_OVCD] = 0x0600,
 110         [RT5616_DEPOP_M1] = 0x0004,
 111         [RT5616_DEPOP_M2] = 0x1100,
 112         [RT5616_MICBIAS] = 0x2000,
 113         [RT5616_A_JD_CTL1] = 0x0200,
 114         [RT5616_EQ_CTRL1] = 0x2080,
 115         [RT5616_ALC_1] = 0x2206,
 116         [RT5616_ALC_2] = 0x1f00,
 117         [RT5616_GPIO_CTRL1] = 0x0400,
 118         [RT5616_BASE_BACK] = 0x0013,
 119         [RT5616_MP3_PLUS1] = 0x0680,
 120         [RT5616_MP3_PLUS2] = 0x1c17,
 121         [RT5616_ADJ_HPF_CTRL1] = 0xb320,
 122         [RT5616_SV_ZCD1] = 0x0809,
 123         [RT5616_D_MISC] = 0x0010,
 124         [RT5616_VENDOR_ID] = 0x10ec,
 125         [RT5616_DEVICE_ID] = 0x6281,
 126 };
 127
 128 static int rt5616_reset(struct snd_soc_codec *codec)
 129 {
 130         return snd_soc_write(codec, RT5616_RESET, 0);
 131 }
 132
 133 /**
 134  * rt5616_index_write - Write private register.
 135  * @codec: SoC audio codec device.
 136  * @reg: Private register index.
 137  * @value: Private register Data.
 138  *
 139  * Modify private register for advanced setting. It can be written through
 140  * private index (0x6a) and data (0x6c) register.
 141  *
 142  * Returns 0 for success or negative error code.
 143  */
 144 static int rt5616_index_write(struct snd_soc_codec *codec,
 145                 unsigned int reg, unsigned int value)
 146 {
 147         int ret;
 148
 149         ret = snd_soc_write(codec, RT5616_PRIV_INDEX, reg);
 150         if (ret < 0) {
 151                 dev_err(codec->dev, "Failed to set private addr: %d\n", ret);
 152                 goto err;
 153         }
 154         ret = snd_soc_write(codec, RT5616_PRIV_DATA, value);
 155         if (ret < 0) {
 156                 dev_err(codec->dev, "Failed to set private value: %d\n", ret);
 157                 goto err;
 158         }
 159         return 0;
 160
 161 err:
 162         return ret;
 163 }
 164
 165 /**
 166  * rt5616_index_read - Read private register.
 167  * @codec: SoC audio codec device.
 168  * @reg: Private register index.
 169  *
 170  * Read advanced setting from private register. It can be read through
 171  * private index (0x6a) and data (0x6c) register.
 172  *
 173  * Returns private register value or negative error code.
 174  */
 175 static unsigned int rt5616_index_read(
 176         struct snd_soc_codec *codec, unsigned int reg)
 177 {
 178         int ret;
 179
 180         ret = snd_soc_write(codec, RT5616_PRIV_INDEX, reg);
 181         if (ret < 0) {
 182                 dev_err(codec->dev, "Failed to set private addr: %d\n", ret);
 183                 return ret;
 184         }
 185         return snd_soc_read(codec, RT5616_PRIV_DATA);
 186 }
 187
 188 /**
 189  * rt5616_index_update_bits - update private register bits
 190  * @codec: audio codec
 191  * @reg: Private register index.
 192  * @mask: register mask
 193  * @value: new value
 194  *
 195  * Writes new register value.
 196  *
 197  * Returns 1 for change, 0 for no change, or negative error code.
 198  */
 199 static int rt5616_index_update_bits(struct snd_soc_codec *codec,
 200         unsigned int reg, unsigned int mask, unsigned int value)
 201 {
 202         unsigned int old, new;
 203         int change, ret;
 204
 205         ret = rt5616_index_read(codec, reg);
 206         if (ret < 0) {
 207                 dev_err(codec->dev, "Failed to read private reg: %d\n", ret);
 208                 goto err;
 209         }
 210
 211         old = ret;
 212         new = (old & ~mask) | (value & mask);
 213         change = old != new;
 214         if (change) {
 215                 ret = rt5616_index_write(codec, reg, new);
 216                 if (ret < 0) {
 217                         dev_err(codec->dev,
 218                                 "Failed to write private reg: %d\n", ret);
 219                         goto err;
 220                 }
 221         }
 222         return change;
 223
 224 err:
 225         return ret;
 226 }
 227
 228 static int rt5616_volatile_register(
 229         struct snd_soc_codec *codec, unsigned int reg)
 230 {
 231         switch (reg) {
 232         case RT5616_RESET:
 233         case RT5616_PRIV_DATA:
 234         case RT5616_EQ_CTRL1:
 235         case RT5616_ALC_1:
 236         case RT5616_IRQ_CTRL2:
 237         case RT5616_INT_IRQ_ST:
 238         case RT5616_PGM_REG_ARR1:
 239         case RT5616_PGM_REG_ARR3:
 240         case RT5616_VENDOR_ID:
 241         case RT5616_DEVICE_ID:
 242                 return 1;
 243         default:
 244                 return 0;
 245         }
 246 }
 247
 248 static int rt5616_readable_register(
 249         struct snd_soc_codec *codec, unsigned int reg)
 250 {
 251         switch (reg) {
 252         case RT5616_RESET:
 253         case RT5616_VERSION_ID:
 254         case RT5616_VENDOR_ID:
 255         case RT5616_DEVICE_ID:
 256         case RT5616_HP_VOL:
 257         case RT5616_LOUT_CTRL1:
 258         case RT5616_LOUT_CTRL2:
 259         case RT5616_IN1_IN2:
 260         case RT5616_INL1_INR1_VOL:
 261         case RT5616_DAC1_DIG_VOL:
 262         case RT5616_ADC_DIG_VOL:
 263         case RT5616_ADC_BST_VOL:
 264         case RT5616_STO1_ADC_MIXER:
 265         case RT5616_AD_DA_MIXER:
 266         case RT5616_STO_DAC_MIXER:
 267         case RT5616_REC_L1_MIXER:
 268         case RT5616_REC_L2_MIXER:
 269         case RT5616_REC_R1_MIXER:
 270         case RT5616_REC_R2_MIXER:
 271         case RT5616_HPO_MIXER:
 272         case RT5616_OUT_L1_MIXER:
 273         case RT5616_OUT_L2_MIXER:
 274         case RT5616_OUT_L3_MIXER:
 275         case RT5616_OUT_R1_MIXER:
 276         case RT5616_OUT_R2_MIXER:
 277         case RT5616_OUT_R3_MIXER:
 278         case RT5616_LOUT_MIXER:
 279         case RT5616_PWR_DIG1:
 280         case RT5616_PWR_DIG2:
 281         case RT5616_PWR_ANLG1:
 282         case RT5616_PWR_ANLG2:
 283         case RT5616_PWR_MIXER:
 284         case RT5616_PWR_VOL:
 285         case RT5616_PRIV_INDEX:
 286         case RT5616_PRIV_DATA:
 287         case RT5616_I2S1_SDP:
 288         case RT5616_ADDA_CLK1:
 289         case RT5616_ADDA_CLK2:
 290         case RT5616_GLB_CLK:
 291         case RT5616_PLL_CTRL1:
 292         case RT5616_PLL_CTRL2:
 293         case RT5616_HP_OVCD:
 294         case RT5616_DEPOP_M1:
 295         case RT5616_DEPOP_M2:
 296         case RT5616_DEPOP_M3:
 297         case RT5616_CHARGE_PUMP:
 298         case RT5616_PV_DET_SPK_G:
 299         case RT5616_MICBIAS:
 300         case RT5616_A_JD_CTL1:
 301         case RT5616_A_JD_CTL2:
 302         case RT5616_EQ_CTRL1:
 303         case RT5616_EQ_CTRL2:
 304         case RT5616_WIND_FILTER :
 305         case RT5616_ALC_1:
 306         case RT5616_ALC_2:
 307         case RT5616_ALC_3:
 308         case RT5616_SVOL_ZC:
 309         case RT5616_JD_CTRL1:
 310         case RT5616_JD_CTRL2:
 311         case RT5616_IRQ_CTRL1:
 312         case RT5616_IRQ_CTRL2:
 313         case RT5616_INT_IRQ_ST:
 314         case RT5616_GPIO_CTRL1:
 315         case RT5616_GPIO_CTRL2:
 316         case RT5616_GPIO_CTRL3:
 317         case RT5616_PGM_REG_ARR1:
 318         case RT5616_PGM_REG_ARR2:
 319         case RT5616_PGM_REG_ARR3:
 320         case RT5616_PGM_REG_ARR4:
 321         case RT5616_PGM_REG_ARR5:
 322         case RT5616_SCB_FUNC:
 323         case RT5616_SCB_CTRL:
 324         case RT5616_BASE_BACK:
 325         case RT5616_MP3_PLUS1:
 326         case RT5616_MP3_PLUS2:
 327         case RT5616_ADJ_HPF_CTRL1:
 328         case RT5616_ADJ_HPF_CTRL2:
 329         case RT5616_HP_CALIB_AMP_DET:
 330         case RT5616_HP_CALIB2:
 331         case RT5616_SV_ZCD1:
 332         case RT5616_SV_ZCD2:
 333         case RT5616_D_MISC:
 334         case RT5616_DUMMY2:
 335         case RT5616_DUMMY3:
 336                 return 1;
 337         default:
 338                 return 0;
 339         }
 340 }
 341
 342 /**
 343  * rt5616_headset_detect - Detect headset.
 344  * @codec: SoC audio codec device.
 345  * @jack_insert: Jack insert or not.
 346  *
 347  * Detect whether is headset or not when jack inserted.
 348  *
 349  * Returns detect status.
 350  */
 351  /*
 352 int rt5616_headset_detect(struct snd_soc_codec *codec, int jack_insert)
 353 {
 354         int jack_type;
 355         int sclk_src;
 356
 357         if(jack_insert) {
 358                 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level) {
 359                         snd_soc_write(codec, RT5616_PWR_ANLG1, 0x2004);
 360                         snd_soc_write(codec, RT5616_MICBIAS, 0x3830);
 361                         snd_soc_write(codec, RT5616_DUMMY1 , 0x3701);
 362                 }
 363                 sclk_src = snd_soc_read(codec, RT5616_GLB_CLK) &
 364                         RT5616_SCLK_SRC_MASK;
 365                 snd_soc_update_bits(codec, RT5616_GLB_CLK,
 366                         RT5616_SCLK_SRC_MASK, 0x3 << RT5616_SCLK_SRC_SFT);
 367                 snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
 368                         RT5616_PWR_LDO, RT5616_PWR_LDO);
 369                 snd_soc_update_bits(codec, RT5616_PWR_ANLG2,
 370                         RT5616_PWR_MB1, RT5616_PWR_MB1);
 371                 snd_soc_update_bits(codec, RT5616_MICBIAS,
 372                         RT5616_MIC1_OVCD_MASK | RT5616_MIC1_OVTH_MASK |
 373                         RT5616_PWR_CLK25M_MASK | RT5616_PWR_MB_MASK,
 374                         RT5616_MIC1_OVCD_EN | RT5616_MIC1_OVTH_600UA |
 375                         RT5616_PWR_MB_PU | RT5616_PWR_CLK25M_PU);
 376                 snd_soc_update_bits(codec, RT5616_DUMMY1,
 377                         0x1, 0x1);
 378                 msleep(100);
 379                 if (snd_soc_read(codec, RT5616_IRQ_CTRL2) & 0x8)
 380                         jack_type = RT5616_HEADPHO_DET;
 381                 else
 382                         jack_type = RT5616_HEADSET_DET;
 383                 snd_soc_update_bits(codec, RT5616_IRQ_CTRL2,
 384                         RT5616_MB1_OC_CLR, 0);
 385                 snd_soc_update_bits(codec, RT5616_GLB_CLK,
 386                         RT5616_SCLK_SRC_MASK, sclk_src);
 387         } else {
 388                 snd_soc_update_bits(codec, RT5616_MICBIAS,
 389                         RT5616_MIC1_OVCD_MASK,
 390                         RT5616_MIC1_OVCD_DIS);
 391
 392                 jack_type = RT5616_NO_JACK;
 393         }
 394
 395         return jack_type;
 396 }
 397 EXPORT_SYMBOL(rt5616_headset_detect);
 398 */
 399
 400 static const DECLARE_TLV_DB_SCALE(out_vol_tlv, -4650, 150, 0);
 401 static const DECLARE_TLV_DB_SCALE(dac_vol_tlv, -65625, 375, 0);
 402 static const DECLARE_TLV_DB_SCALE(in_vol_tlv, -3450, 150, 0);
 403 static const DECLARE_TLV_DB_SCALE(adc_vol_tlv, -17625, 375, 0);
 404 static const DECLARE_TLV_DB_SCALE(adc_bst_tlv, 0, 1200, 0);
 405
 406 /* {0, +20, +24, +30, +35, +40, +44, +50, +52} dB */
 407 static unsigned int bst_tlv[] = {
 408         TLV_DB_RANGE_HEAD(7),
 409         0, 0, TLV_DB_SCALE_ITEM(0, 0, 0),
 410         1, 1, TLV_DB_SCALE_ITEM(2000, 0, 0),
 411         2, 2, TLV_DB_SCALE_ITEM(2400, 0, 0),
 412         3, 5, TLV_DB_SCALE_ITEM(3000, 500, 0),
 413         6, 6, TLV_DB_SCALE_ITEM(4400, 0, 0),
 414         7, 7, TLV_DB_SCALE_ITEM(5000, 0, 0),
 415         8, 8, TLV_DB_SCALE_ITEM(5200, 0, 0),
 416 };
 417
 418 /* IN1/IN2 Input Type */
 419 static const char *rt5616_input_mode[] = {
 420         "Single ended", "Differential"};
 421
 422 static const SOC_ENUM_SINGLE_DECL(
 423         rt5616_in1_mode_enum, RT5616_IN1_IN2,
 424         RT5616_IN_SFT1, rt5616_input_mode);
 425
 426 static const SOC_ENUM_SINGLE_DECL(
 427         rt5616_in2_mode_enum, RT5616_IN1_IN2,
 428         RT5616_IN_SFT2, rt5616_input_mode);
 429
 430
 431 static int rt5616_vol_rescale_get(struct snd_kcontrol *kcontrol,
 432                 struct snd_ctl_elem_value *ucontrol)
 433 {
 434         struct soc_mixer_control *mc =
 435                 (struct soc_mixer_control *)kcontrol->private_value;
 436         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 437         unsigned int val = snd_soc_read(codec, mc->reg);
 438
 439         ucontrol->value.integer.value[0] = RT5616_VOL_RSCL_MAX -
 440                 ((val & RT5616_L_VOL_MASK) >> mc->shift);
 441         ucontrol->value.integer.value[1] = RT5616_VOL_RSCL_MAX -
 442                 (val & RT5616_R_VOL_MASK);
 443
 444         return 0;
 445 }
 446
 447 static int rt5616_vol_rescale_put(struct snd_kcontrol *kcontrol,
 448                 struct snd_ctl_elem_value *ucontrol)
 449 {
 450         struct soc_mixer_control *mc =
 451                 (struct soc_mixer_control *)kcontrol->private_value;
 452         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 453         unsigned int val, val2;
 454
 455         val = RT5616_VOL_RSCL_MAX - ucontrol->value.integer.value[0];
 456         val2 = RT5616_VOL_RSCL_MAX - ucontrol->value.integer.value[1];
 457         return snd_soc_update_bits_locked(codec, mc->reg, RT5616_L_VOL_MASK |
 458                         RT5616_R_VOL_MASK, val << mc->shift | val2);
 459 }
 460
 461
 462 static const struct snd_kcontrol_new rt5616_snd_controls[] = {
 463         /* Headphone Output Volume */
 464         SOC_DOUBLE("HP Playback Switch", RT5616_HP_VOL,
 465                 RT5616_L_MUTE_SFT, RT5616_R_MUTE_SFT, 1, 1),
 466         SOC_DOUBLE_EXT_TLV("HP Playback Volume", RT5616_HP_VOL,
 467                 RT5616_L_VOL_SFT, RT5616_R_VOL_SFT, RT5616_VOL_RSCL_RANGE, 0,
 468                 rt5616_vol_rescale_get, rt5616_vol_rescale_put, out_vol_tlv),
 469         /* OUTPUT Control */
 470         SOC_DOUBLE("OUT Playback Switch", RT5616_LOUT_CTRL1,
 471                 RT5616_L_MUTE_SFT, RT5616_R_MUTE_SFT, 1, 1),
 472         SOC_DOUBLE("OUT Channel Switch", RT5616_LOUT_CTRL1,
 473                 RT5616_VOL_L_SFT, RT5616_VOL_R_SFT, 1, 1),
 474         SOC_DOUBLE_TLV("OUT Playback Volume", RT5616_LOUT_CTRL1,
 475                 RT5616_L_VOL_SFT, RT5616_R_VOL_SFT, 39, 1, out_vol_tlv),
 476
 477         /* DAC Digital Volume */
 478         SOC_DOUBLE_TLV("DAC1 Playback Volume", RT5616_DAC1_DIG_VOL,
 479                         RT5616_L_VOL_SFT, RT5616_R_VOL_SFT,
 480                         175, 0, dac_vol_tlv),
 481         /* IN1/IN2 Control */
 482         SOC_ENUM("IN1 Mode Control",  rt5616_in1_mode_enum),
 483         SOC_SINGLE_TLV("IN1 Boost", RT5616_IN1_IN2,
 484                 RT5616_BST_SFT1, 8, 0, bst_tlv),
 485         SOC_ENUM("IN2 Mode Control", rt5616_in2_mode_enum),
 486         SOC_SINGLE_TLV("IN2 Boost", RT5616_IN1_IN2,
 487                 RT5616_BST_SFT2, 8, 0, bst_tlv),
 488         /* INL/INR Volume Control */
 489         SOC_DOUBLE_TLV("IN Capture Volume", RT5616_INL1_INR1_VOL,
 490                         RT5616_INL_VOL_SFT, RT5616_INR_VOL_SFT,
 491                         31, 1, in_vol_tlv),
 492         /* ADC Digital Volume Control */
 493         SOC_DOUBLE("ADC Capture Switch", RT5616_ADC_DIG_VOL,
 494                 RT5616_L_MUTE_SFT, RT5616_R_MUTE_SFT, 1, 1),
 495         SOC_DOUBLE_TLV("ADC Capture Volume", RT5616_ADC_DIG_VOL,
 496                         RT5616_L_VOL_SFT, RT5616_R_VOL_SFT,
 497                         127, 0, adc_vol_tlv),
 498
 499         /* ADC Boost Volume Control */
 500         SOC_DOUBLE_TLV("ADC Boost Gain", RT5616_ADC_BST_VOL,
 501                         RT5616_ADC_L_BST_SFT, RT5616_ADC_R_BST_SFT,
 502                         3, 0, adc_bst_tlv),
 503 };
 504
 505 static int check_sysclk1_source(struct snd_soc_dapm_widget *source,
 506                          struct snd_soc_dapm_widget *sink)
 507 {
 508         unsigned int val;
 509
 510         val = snd_soc_read(source->codec, RT5616_GLB_CLK);
 511         val &= RT5616_SCLK_SRC_MASK;
 512         if (val == RT5616_SCLK_SRC_PLL1)
 513                 return 1;
 514         else
 515                 return 0;
 516 }
 517
 518 /* Digital Mixer */
 519 static const struct snd_kcontrol_new rt5616_sto1_adc_l_mix[] = {
 520         SOC_DAPM_SINGLE("ADC1 Switch", RT5616_STO1_ADC_MIXER,
 521                         RT5616_M_STO1_ADC_L1_SFT, 1, 1),
 522 };
 523
 524 static const struct snd_kcontrol_new rt5616_sto1_adc_r_mix[] = {
 525         SOC_DAPM_SINGLE("ADC1 Switch", RT5616_STO1_ADC_MIXER,
 526                         RT5616_M_STO1_ADC_R1_SFT, 1, 1),
 527 };
 528
 529 static const struct snd_kcontrol_new rt5616_dac_l_mix[] = {
 530         SOC_DAPM_SINGLE("Stereo ADC Switch", RT5616_AD_DA_MIXER,
 531                         RT5616_M_ADCMIX_L_SFT, 1, 1),
 532         SOC_DAPM_SINGLE("INF1 Switch", RT5616_AD_DA_MIXER,
 533                         RT5616_M_IF1_DAC_L_SFT, 1, 1),
 534 };
 535
 536 static const struct snd_kcontrol_new rt5616_dac_r_mix[] = {
 537         SOC_DAPM_SINGLE("Stereo ADC Switch", RT5616_AD_DA_MIXER,
 538                         RT5616_M_ADCMIX_R_SFT, 1, 1),
 539         SOC_DAPM_SINGLE("INF1 Switch", RT5616_AD_DA_MIXER,
 540                         RT5616_M_IF1_DAC_R_SFT, 1, 1),
 541 };
 542
 543 static const struct snd_kcontrol_new rt5616_sto_dac_l_mix[] = {
 544         SOC_DAPM_SINGLE("DAC L1 Switch", RT5616_STO_DAC_MIXER,
 545                         RT5616_M_DAC_L1_MIXL_SFT, 1, 1),
 546         SOC_DAPM_SINGLE("DAC R1 Switch", RT5616_STO_DAC_MIXER,
 547                         RT5616_M_DAC_R1_MIXL_SFT, 1, 1),
 548 };
 549
 550 static const struct snd_kcontrol_new rt5616_sto_dac_r_mix[] = {
 551         SOC_DAPM_SINGLE("DAC R1 Switch", RT5616_STO_DAC_MIXER,
 552                         RT5616_M_DAC_R1_MIXR_SFT, 1, 1),
 553         SOC_DAPM_SINGLE("DAC L1 Switch", RT5616_STO_DAC_MIXER,
 554                         RT5616_M_DAC_L1_MIXR_SFT, 1, 1),
 555 };
 556
 557 /* Analog Input Mixer */
 558 static const struct snd_kcontrol_new rt5616_rec_l_mix[] = {
 559         SOC_DAPM_SINGLE("INL1 Switch", RT5616_REC_L2_MIXER,
 560                         RT5616_M_IN1_L_RM_L_SFT, 1, 1),
 561         SOC_DAPM_SINGLE("BST2 Switch", RT5616_REC_L2_MIXER,
 562                         RT5616_M_BST2_RM_L_SFT, 1, 1),
 563         SOC_DAPM_SINGLE("BST1 Switch", RT5616_REC_L2_MIXER,
 564                         RT5616_M_BST1_RM_L_SFT, 1, 1),
 565 };
 566
 567 static const struct snd_kcontrol_new rt5616_rec_r_mix[] = {
 568         SOC_DAPM_SINGLE("INR1 Switch", RT5616_REC_R2_MIXER,
 569                         RT5616_M_IN1_R_RM_R_SFT, 1, 1),
 570         SOC_DAPM_SINGLE("BST2 Switch", RT5616_REC_R2_MIXER,
 571                         RT5616_M_BST2_RM_R_SFT, 1, 1),
 572         SOC_DAPM_SINGLE("BST1 Switch", RT5616_REC_R2_MIXER,
 573                         RT5616_M_BST1_RM_R_SFT, 1, 1),
 574 };
 575
 576 /* Analog Output Mixer */
 577
 578 static const struct snd_kcontrol_new rt5616_out_l_mix[] = {
 579         SOC_DAPM_SINGLE("BST1 Switch", RT5616_OUT_L3_MIXER,
 580                         RT5616_M_BST1_OM_L_SFT, 1, 1),
 581         SOC_DAPM_SINGLE("BST2 Switch", RT5616_OUT_L3_MIXER,
 582                         RT5616_M_BST2_OM_L_SFT, 1, 1),
 583         SOC_DAPM_SINGLE("INL1 Switch", RT5616_OUT_L3_MIXER,
 584                         RT5616_M_IN1_L_OM_L_SFT, 1, 1),
 585         SOC_DAPM_SINGLE("REC MIXL Switch", RT5616_OUT_L3_MIXER,
 586                         RT5616_M_RM_L_OM_L_SFT, 1, 1),
 587         SOC_DAPM_SINGLE("DAC L1 Switch", RT5616_OUT_L3_MIXER,
 588                         RT5616_M_DAC_L1_OM_L_SFT, 1, 1),
 589 };
 590
 591 static const struct snd_kcontrol_new rt5616_out_r_mix[] = {
 592         SOC_DAPM_SINGLE("BST2 Switch", RT5616_OUT_R3_MIXER,
 593                         RT5616_M_BST2_OM_R_SFT, 1, 1),
 594         SOC_DAPM_SINGLE("BST1 Switch", RT5616_OUT_R3_MIXER,
 595                         RT5616_M_BST1_OM_R_SFT, 1, 1),
 596         SOC_DAPM_SINGLE("INR1 Switch", RT5616_OUT_R3_MIXER,
 597                         RT5616_M_IN1_R_OM_R_SFT, 1, 1),
 598         SOC_DAPM_SINGLE("REC MIXR Switch", RT5616_OUT_R3_MIXER,
 599                         RT5616_M_RM_R_OM_R_SFT, 1, 1),
 600         SOC_DAPM_SINGLE("DAC R1 Switch", RT5616_OUT_R3_MIXER,
 601                         RT5616_M_DAC_R1_OM_R_SFT, 1, 1),
 602 };
 603
 604 static const struct snd_kcontrol_new rt5616_hpo_mix[] = {
 605         SOC_DAPM_SINGLE("DAC1 Switch", RT5616_HPO_MIXER,
 606                         RT5616_M_DAC1_HM_SFT, 1, 1),
 607         SOC_DAPM_SINGLE("HPVOL Switch", RT5616_HPO_MIXER,
 608                         RT5616_M_HPVOL_HM_SFT, 1, 1),
 609 };
 610
 611 static const struct snd_kcontrol_new rt5616_lout_mix[] = {
 612         SOC_DAPM_SINGLE("DAC L1 Switch", RT5616_LOUT_MIXER,
 613                         RT5616_M_DAC_L1_LM_SFT, 1, 1),
 614         SOC_DAPM_SINGLE("DAC R1 Switch", RT5616_LOUT_MIXER,
 615                         RT5616_M_DAC_R1_LM_SFT, 1, 1),
 616         SOC_DAPM_SINGLE("OUTVOL L Switch", RT5616_LOUT_MIXER,
 617                         RT5616_M_OV_L_LM_SFT, 1, 1),
 618         SOC_DAPM_SINGLE("OUTVOL R Switch", RT5616_LOUT_MIXER,
 619                         RT5616_M_OV_R_LM_SFT, 1, 1),
 620 };
 621
 622 static int rt5616_adc_event(struct snd_soc_dapm_widget *w,
 623         struct snd_kcontrol *kcontrol, int event)
 624 {
 625         struct snd_soc_codec *codec = w->codec;
 626
 627         switch (event) {
 628         case SND_SOC_DAPM_POST_PMU:
 629                 snd_soc_update_bits(codec, RT5616_ADC_DIG_VOL, RT5616_L_MUTE | RT5616_R_MUTE, 0);
 630                 break;
 631
 632         case SND_SOC_DAPM_POST_PMD:
 633                 snd_soc_update_bits(codec, RT5616_ADC_DIG_VOL, RT5616_L_MUTE | RT5616_R_MUTE, RT5616_L_MUTE | RT5616_R_MUTE);
 634                 break;
 635
 636         default:
 637                 return 0;
 638         }
 639
 640         return 0;
 641 }
 642
 643 void rt5616_hp_amp_power(struct snd_soc_codec *codec, int on)
 644 {
 645         static int hp_amp_power_count;
 646
 647         if(on) {
 648                 if(hp_amp_power_count <= 0) {
 649                         /* depop parameters */
 650                         snd_soc_update_bits(codec, RT5616_DEPOP_M2,
 651                                 RT5616_DEPOP_MASK, RT5616_DEPOP_MAN);
 652                         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 653                                 RT5616_HP_CP_MASK | RT5616_HP_SG_MASK | RT5616_HP_CB_MASK,
 654                                 RT5616_HP_CP_PU | RT5616_HP_SG_DIS | RT5616_HP_CB_PU);
 655                         rt5616_index_write(codec, RT5616_HP_DCC_INT1, 0x9f00);
 656                         /* headphone amp power on */
 657                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
 658                                 RT5616_PWR_FV1 | RT5616_PWR_FV2 , 0);
 659                         snd_soc_update_bits(codec, RT5616_PWR_VOL,
 660                                 RT5616_PWR_HV_L | RT5616_PWR_HV_R,
 661                                 RT5616_PWR_HV_L | RT5616_PWR_HV_R);
 662                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
 663                                 RT5616_PWR_HP_L | RT5616_PWR_HP_R | RT5616_PWR_HA | RT5616_PWR_LM,
 664                                 RT5616_PWR_HP_L | RT5616_PWR_HP_R | RT5616_PWR_HA | RT5616_PWR_LM);
 665                         msleep(50);
 666                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
 667                                 RT5616_PWR_FV1 | RT5616_PWR_FV2,
 668                                 RT5616_PWR_FV1 | RT5616_PWR_FV2);
 669
 670                         snd_soc_update_bits(codec, RT5616_CHARGE_PUMP,
 671                                 RT5616_PM_HP_MASK, RT5616_PM_HP_HV);
 672                         rt5616_index_update_bits(codec, RT5616_CHOP_DAC_ADC, 0x0200, 0x0200);
 673                         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 674                                 RT5616_HP_CO_MASK | RT5616_HP_SG_MASK,
 675                                 RT5616_HP_CO_EN | RT5616_HP_SG_EN);
 676                 }
 677                 hp_amp_power_count++;
 678         } else {
 679                 hp_amp_power_count--;
 680                 if(hp_amp_power_count <= 0) {
 681                         rt5616_index_update_bits(codec, RT5616_CHOP_DAC_ADC, 0x0200, 0x0);
 682                         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 683                                 RT5616_HP_SG_MASK | RT5616_HP_L_SMT_MASK |
 684                                 RT5616_HP_R_SMT_MASK, RT5616_HP_SG_DIS |
 685                                 RT5616_HP_L_SMT_DIS | RT5616_HP_R_SMT_DIS);
 686                         /* headphone amp power down */
 687                         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 688                                 RT5616_SMT_TRIG_MASK | RT5616_HP_CD_PD_MASK |
 689                                 RT5616_HP_CO_MASK | RT5616_HP_CP_MASK |
 690                                 RT5616_HP_SG_MASK | RT5616_HP_CB_MASK,
 691                                 RT5616_SMT_TRIG_DIS | RT5616_HP_CD_PD_EN |
 692                                 RT5616_HP_CO_DIS | RT5616_HP_CP_PD |
 693                                 RT5616_HP_SG_EN | RT5616_HP_CB_PD);
 694                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
 695                                 RT5616_PWR_HP_L | RT5616_PWR_HP_R | RT5616_PWR_HA | RT5616_PWR_LM,
 696                                 0);
 697                 }
 698         }
 699 }
 700
 701 static void rt5616_pmu_depop(struct snd_soc_codec *codec)
 702 {
 703         rt5616_hp_amp_power(codec, 1);
 704
 705         /* headphone unmute sequence */
 706         snd_soc_update_bits(codec, RT5616_DEPOP_M3,
 707                 RT5616_CP_FQ1_MASK | RT5616_CP_FQ2_MASK | RT5616_CP_FQ3_MASK,
 708                 (RT5616_CP_FQ_192_KHZ << RT5616_CP_FQ1_SFT) |
 709                 (RT5616_CP_FQ_12_KHZ << RT5616_CP_FQ2_SFT) |
 710                 (RT5616_CP_FQ_192_KHZ << RT5616_CP_FQ3_SFT));
 711         rt5616_index_write(codec, RT5616_MAMP_INT_REG2, 0xfc00);
 712         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 713                 RT5616_SMT_TRIG_MASK, RT5616_SMT_TRIG_EN);
 714         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 715                 RT5616_RSTN_MASK, RT5616_RSTN_EN);
 716         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 717                 RT5616_RSTN_MASK | RT5616_HP_L_SMT_MASK | RT5616_HP_R_SMT_MASK,
 718                 RT5616_RSTN_DIS | RT5616_HP_L_SMT_EN | RT5616_HP_R_SMT_EN);
 719         snd_soc_update_bits(codec, RT5616_HP_VOL,
 720                 RT5616_L_MUTE | RT5616_R_MUTE, 0);
 721         msleep(100);
 722         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 723                 RT5616_HP_SG_MASK | RT5616_HP_L_SMT_MASK |
 724                 RT5616_HP_R_SMT_MASK, RT5616_HP_SG_DIS |
 725                 RT5616_HP_L_SMT_DIS | RT5616_HP_R_SMT_DIS);
 726         msleep(20);
 727 //      snd_soc_update_bits(codec, RT5616_HP_CALIB_AMP_DET,
 728 //              RT5616_HPD_PS_MASK, RT5616_HPD_PS_EN);
 729 }
 730
 731 static void rt5616_pmd_depop(struct snd_soc_codec *codec)
 732 {
 733         /* headphone mute sequence */
 734         snd_soc_update_bits(codec, RT5616_DEPOP_M3,
 735                 RT5616_CP_FQ1_MASK | RT5616_CP_FQ2_MASK | RT5616_CP_FQ3_MASK,
 736                 (RT5616_CP_FQ_96_KHZ << RT5616_CP_FQ1_SFT) |
 737                 (RT5616_CP_FQ_12_KHZ << RT5616_CP_FQ2_SFT) |
 738                 (RT5616_CP_FQ_96_KHZ << RT5616_CP_FQ3_SFT));
 739         rt5616_index_write(codec, RT5616_MAMP_INT_REG2, 0xfc00);
 740         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 741                 RT5616_HP_SG_MASK, RT5616_HP_SG_EN);
 742         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 743                 RT5616_RSTP_MASK, RT5616_RSTP_EN);
 744         snd_soc_update_bits(codec, RT5616_DEPOP_M1,
 745                 RT5616_RSTP_MASK | RT5616_HP_L_SMT_MASK |
 746                 RT5616_HP_R_SMT_MASK, RT5616_RSTP_DIS |
 747                 RT5616_HP_L_SMT_EN | RT5616_HP_R_SMT_EN);
 748 //      snd_soc_update_bits(codec, RT5616_HP_CALIB_AMP_DET,
 749 //              RT5616_HPD_PS_MASK, RT5616_HPD_PS_DIS);
 750         msleep(90);
 751         snd_soc_update_bits(codec, RT5616_HP_VOL,
 752                 RT5616_L_MUTE | RT5616_R_MUTE, RT5616_L_MUTE | RT5616_R_MUTE);
 753         msleep(30);
 754
 755         rt5616_hp_amp_power(codec, 0);
 756
 757 }
 758
 759 static int rt5616_hp_event(struct snd_soc_dapm_widget *w,
 760         struct snd_kcontrol *kcontrol, int event)
 761 {
 762         struct snd_soc_codec *codec = w->codec;
 763
 764         switch (event) {
 765         case SND_SOC_DAPM_POST_PMU:
 766                 rt5616_pmu_depop(codec);
 767                 break;
 768
 769         case SND_SOC_DAPM_PRE_PMD:
 770                 rt5616_pmd_depop(codec);
 771                 break;
 772
 773         default:
 774                 return 0;
 775         }
 776
 777         return 0;
 778 }
 779
 780 static int rt5616_lout_event(struct snd_soc_dapm_widget *w,
 781         struct snd_kcontrol *kcontrol, int event)
 782 {
 783         struct snd_soc_codec *codec = w->codec;
 784
 785         switch (event) {
 786         case SND_SOC_DAPM_POST_PMU:
 787                 rt5616_hp_amp_power(codec,1);
 788                 snd_soc_update_bits(codec, RT5616_LOUT_CTRL1,
 789                         RT5616_L_MUTE | RT5616_R_MUTE, 0);
 790                 break;
 791
 792         case SND_SOC_DAPM_PRE_PMD:
 793                 snd_soc_update_bits(codec, RT5616_LOUT_CTRL1,
 794                         RT5616_L_MUTE | RT5616_R_MUTE,
 795                         RT5616_L_MUTE | RT5616_R_MUTE);
 796                 rt5616_hp_amp_power(codec,0);
 797                 break;
 798
 799         default:
 800                 return 0;
 801         }
 802
 803         return 0;
 804 }
 805
 806 static int rt5616_bst1_event(struct snd_soc_dapm_widget *w,
 807         struct snd_kcontrol *kcontrol, int event)
 808 {
 809         struct snd_soc_codec *codec = w->codec;
 810
 811         switch (event) {
 812         case SND_SOC_DAPM_POST_PMU:
 813                 snd_soc_update_bits(codec, RT5616_PWR_ANLG2,
 814                         RT5616_PWR_BST1_OP2, RT5616_PWR_BST1_OP2);
 815                 break;
 816
 817         case SND_SOC_DAPM_PRE_PMD:
 818                 snd_soc_update_bits(codec, RT5616_PWR_ANLG2,
 819                         RT5616_PWR_BST1_OP2, 0);
 820                 break;
 821
 822         default:
 823                 return 0;
 824         }
 825
 826         return 0;
 827 }
 828
 829 static int rt5616_bst2_event(struct snd_soc_dapm_widget *w,
 830         struct snd_kcontrol *kcontrol, int event)
 831 {
 832         struct snd_soc_codec *codec = w->codec;
 833
 834         switch (event) {
 835         case SND_SOC_DAPM_POST_PMU:
 836                 snd_soc_update_bits(codec, RT5616_PWR_ANLG2,
 837                         RT5616_PWR_BST2_OP2, RT5616_PWR_BST2_OP2);
 838                 break;
 839
 840         case SND_SOC_DAPM_PRE_PMD:
 841                 snd_soc_update_bits(codec, RT5616_PWR_ANLG2,
 842                         RT5616_PWR_BST2_OP2, 0);
 843                 break;
 844
 845         default:
 846                 return 0;
 847         }
 848
 849         return 0;
 850 }
 851
 852 static const struct snd_soc_dapm_widget rt5616_dapm_widgets[] = {
 853         SND_SOC_DAPM_SUPPLY("PLL1", RT5616_PWR_ANLG2,
 854                         RT5616_PWR_PLL_BIT, 0, NULL, 0),
 855         /* Input Side */
 856         /* micbias */
 857         SND_SOC_DAPM_SUPPLY("LDO", RT5616_PWR_ANLG1,
 858                         RT5616_PWR_LDO_BIT, 0, NULL, 0),
 859 #ifdef POWER_ON_MICBIAS1
 860         SND_SOC_DAPM_SUPPLY("micbias1", RT5616_PWR_ANLG2,
 861                         RT5616_PWR_MB1_BIT, 0, NULL, 0),
 862 #else
 863         SND_SOC_DAPM_MICBIAS("micbias1", RT5616_PWR_ANLG2,
 864                         RT5616_PWR_MB1_BIT, 0),
 865 #endif
 866         /* Input Lines */
 867         SND_SOC_DAPM_INPUT("MIC1"),
 868         SND_SOC_DAPM_INPUT("MIC2"),
 869
 870
 871         SND_SOC_DAPM_INPUT("IN1P"),
 872         SND_SOC_DAPM_INPUT("IN2P"),
 873         SND_SOC_DAPM_INPUT("IN2N"),
 874
 875         /* Boost */
 876         SND_SOC_DAPM_PGA_E("BST1", RT5616_PWR_ANLG2,
 877                 RT5616_PWR_BST1_BIT, 0, NULL, 0, rt5616_bst1_event,
 878                 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
 879         SND_SOC_DAPM_PGA_E("BST2", RT5616_PWR_ANLG2,
 880                 RT5616_PWR_BST2_BIT, 0, NULL, 0, rt5616_bst2_event,
 881                 SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
 882         /* Input Volume */
 883         SND_SOC_DAPM_PGA("INL1 VOL", RT5616_PWR_VOL,
 884                 RT5616_PWR_IN1_L_BIT, 0, NULL, 0),
 885         SND_SOC_DAPM_PGA("INR1 VOL", RT5616_PWR_VOL,
 886                 RT5616_PWR_IN1_R_BIT, 0, NULL, 0),
 887         SND_SOC_DAPM_PGA("INL2 VOL", RT5616_PWR_VOL,
 888                 RT5616_PWR_IN2_L_BIT, 0, NULL, 0),
 889         SND_SOC_DAPM_PGA("INR2 VOL", RT5616_PWR_VOL,
 890                 RT5616_PWR_IN2_R_BIT, 0, NULL, 0),
 891
 892         /* REC Mixer */
 893         SND_SOC_DAPM_MIXER("RECMIXL", RT5616_PWR_MIXER, RT5616_PWR_RM_L_BIT, 0,
 894                         rt5616_rec_l_mix, ARRAY_SIZE(rt5616_rec_l_mix)),
 895         SND_SOC_DAPM_MIXER("RECMIXR", RT5616_PWR_MIXER, RT5616_PWR_RM_R_BIT, 0,
 896                         rt5616_rec_r_mix, ARRAY_SIZE(rt5616_rec_r_mix)),
 897         /* ADCs */
 898         SND_SOC_DAPM_ADC_E("ADC L", NULL, RT5616_PWR_DIG1,
 899                 RT5616_PWR_ADC_L_BIT, 0, rt5616_adc_event,
 900                 SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
 901         SND_SOC_DAPM_ADC_E("ADC R", NULL, RT5616_PWR_DIG1,
 902                 RT5616_PWR_ADC_R_BIT, 0, rt5616_adc_event,
 903                 SND_SOC_DAPM_POST_PMD | SND_SOC_DAPM_POST_PMU),
 904
 905         /* ADC Mixer */
 906         SND_SOC_DAPM_SUPPLY("stereo1 filter", RT5616_PWR_DIG2,
 907                 RT5616_PWR_ADC_STO1_F_BIT, 0, NULL, 0),
 908         SND_SOC_DAPM_MIXER("Stereo1 ADC MIXL", SND_SOC_NOPM, 0, 0,
 909                 rt5616_sto1_adc_l_mix, ARRAY_SIZE(rt5616_sto1_adc_l_mix)),
 910         SND_SOC_DAPM_MIXER("Stereo1 ADC MIXR", SND_SOC_NOPM, 0, 0,
 911                 rt5616_sto1_adc_r_mix, ARRAY_SIZE(rt5616_sto1_adc_r_mix)),
 912
 913         /* Digital Interface */
 914         SND_SOC_DAPM_SUPPLY("I2S1", RT5616_PWR_DIG1,
 915                 RT5616_PWR_I2S1_BIT, 0, NULL, 0),
 916         SND_SOC_DAPM_PGA("IF1 DAC", SND_SOC_NOPM, 0, 0, NULL, 0),
 917         SND_SOC_DAPM_PGA("IF1 DAC1 L", SND_SOC_NOPM, 0, 0, NULL, 0),
 918         SND_SOC_DAPM_PGA("IF1 DAC1 R", SND_SOC_NOPM, 0, 0, NULL, 0),
 919         SND_SOC_DAPM_PGA("IF1 ADC1", SND_SOC_NOPM, 0, 0, NULL, 0),
 920
 921         /* Digital Interface Select */
 922
 923         /* Audio Interface */
 924         SND_SOC_DAPM_AIF_IN("AIF1RX", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
 925         SND_SOC_DAPM_AIF_OUT("AIF1TX", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
 926
 927         /* Audio DSP */
 928         SND_SOC_DAPM_PGA("Audio DSP", SND_SOC_NOPM, 0, 0, NULL, 0),
 929
 930         /* Output Side */
 931         /* DAC mixer before sound effect  */
 932         SND_SOC_DAPM_MIXER("DAC MIXL", SND_SOC_NOPM, 0, 0,
 933                 rt5616_dac_l_mix, ARRAY_SIZE(rt5616_dac_l_mix)),
 934         SND_SOC_DAPM_MIXER("DAC MIXR", SND_SOC_NOPM, 0, 0,
 935                 rt5616_dac_r_mix, ARRAY_SIZE(rt5616_dac_r_mix)),
 936
 937         SND_SOC_DAPM_SUPPLY("Stero1 DAC Power", RT5616_PWR_DIG2,
 938                         RT5616_PWR_DAC_STO1_F_BIT, 0, NULL, 0),
 939
 940         /* DAC Mixer */
 941         SND_SOC_DAPM_MIXER("Stereo DAC MIXL", SND_SOC_NOPM, 0, 0,
 942                 rt5616_sto_dac_l_mix, ARRAY_SIZE(rt5616_sto_dac_l_mix)),
 943         SND_SOC_DAPM_MIXER("Stereo DAC MIXR", SND_SOC_NOPM, 0, 0,
 944                 rt5616_sto_dac_r_mix, ARRAY_SIZE(rt5616_sto_dac_r_mix)),
 945
 946         /* DACs */
 947         SND_SOC_DAPM_DAC("DAC L1", NULL, RT5616_PWR_DIG1,
 948                         RT5616_PWR_DAC_L1_BIT, 0),
 949         SND_SOC_DAPM_DAC("DAC R1", NULL, RT5616_PWR_DIG1,
 950                         RT5616_PWR_DAC_R1_BIT, 0),
 951         /* OUT Mixer */
 952         SND_SOC_DAPM_MIXER("OUT MIXL", RT5616_PWR_MIXER, RT5616_PWR_OM_L_BIT,
 953                 0, rt5616_out_l_mix, ARRAY_SIZE(rt5616_out_l_mix)),
 954         SND_SOC_DAPM_MIXER("OUT MIXR", RT5616_PWR_MIXER, RT5616_PWR_OM_R_BIT,
 955                 0, rt5616_out_r_mix, ARRAY_SIZE(rt5616_out_r_mix)),
 956         /* Ouput Volume */
 957         SND_SOC_DAPM_PGA("OUTVOL L", RT5616_PWR_VOL,
 958                 RT5616_PWR_OV_L_BIT, 0, NULL, 0),
 959         SND_SOC_DAPM_PGA("OUTVOL R", RT5616_PWR_VOL,
 960                 RT5616_PWR_OV_R_BIT, 0, NULL, 0),
 961         SND_SOC_DAPM_PGA("HPOVOL L", RT5616_PWR_VOL,
 962                 RT5616_PWR_HV_L_BIT, 0, NULL, 0),
 963         SND_SOC_DAPM_PGA("HPOVOL R", RT5616_PWR_VOL,
 964                 RT5616_PWR_HV_R_BIT, 0, NULL, 0),
 965         SND_SOC_DAPM_PGA("DAC 1", SND_SOC_NOPM,
 966                 0, 0, NULL, 0),
 967         SND_SOC_DAPM_PGA("DAC 2", SND_SOC_NOPM,
 968                 0, 0, NULL, 0),
 969         SND_SOC_DAPM_PGA("HPOVOL", SND_SOC_NOPM,
 970                 0, 0, NULL, 0),
 971         SND_SOC_DAPM_PGA("INL1", RT5616_PWR_VOL,
 972                 RT5616_PWR_IN1_L_BIT, 0, NULL, 0),
 973         SND_SOC_DAPM_PGA("INR1", RT5616_PWR_VOL,
 974                 RT5616_PWR_IN1_R_BIT, 0, NULL, 0),
 975         SND_SOC_DAPM_PGA("INL2", RT5616_PWR_VOL,
 976                 RT5616_PWR_IN2_L_BIT, 0, NULL, 0),
 977         SND_SOC_DAPM_PGA("INR2", RT5616_PWR_VOL,
 978                 RT5616_PWR_IN2_R_BIT, 0, NULL, 0),
 979         /* HPO/LOUT/Mono Mixer */
 980         SND_SOC_DAPM_MIXER("HPO MIX", SND_SOC_NOPM, 0, 0,
 981                 rt5616_hpo_mix, ARRAY_SIZE(rt5616_hpo_mix)),
 982         SND_SOC_DAPM_MIXER("LOUT MIX", RT5616_PWR_ANLG1, RT5616_PWR_LM_BIT, 0,
 983                 rt5616_lout_mix, ARRAY_SIZE(rt5616_lout_mix)),
 984
 985         SND_SOC_DAPM_PGA_S("HP amp", 1, SND_SOC_NOPM, 0, 0,
 986                 rt5616_hp_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
 987         SND_SOC_DAPM_PGA_S("LOUT amp", 1, SND_SOC_NOPM, 0, 0,
 988                 rt5616_lout_event, SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMU),
 989
 990         /* Output Lines */
 991         SND_SOC_DAPM_OUTPUT("HPOL"),
 992         SND_SOC_DAPM_OUTPUT("HPOR"),
 993         SND_SOC_DAPM_OUTPUT("LOUTL"),
 994         SND_SOC_DAPM_OUTPUT("LOUTR"),
 995 };
 996
 997 static const struct snd_soc_dapm_route rt5616_dapm_routes[] = {
 998         {"IN1P", NULL, "LDO"},
 999         {"IN2P", NULL, "LDO"},
1000
1001         {"IN1P", NULL, "MIC1"},
1002         {"IN2P", NULL, "MIC2"},
1003         {"IN2N", NULL, "MIC2"},
1004
1005         {"BST1", NULL, "IN1P"},
1006         {"BST2", NULL, "IN2P"},
1007         {"BST2", NULL, "IN2N"},
1008 #ifdef POWER_ON_MICBIAS1
1009         {"BST1", NULL, "micbias1"},
1010         {"BST2", NULL, "micbias1"},
1011 #endif
1012
1013         {"INL1 VOL", NULL, "IN2P"},
1014         {"INR1 VOL", NULL, "IN2N"},
1015
1016         {"RECMIXL", "INL1 Switch", "INL1 VOL"},
1017         {"RECMIXL", "BST2 Switch", "BST2"},
1018         {"RECMIXL", "BST1 Switch", "BST1"},
1019
1020         {"RECMIXR", "INR1 Switch", "INR1 VOL"},
1021         {"RECMIXR", "BST2 Switch", "BST2"},
1022         {"RECMIXR", "BST1 Switch", "BST1"},
1023
1024         {"ADC L", NULL, "RECMIXL"},
1025         {"ADC R", NULL, "RECMIXR"},
1026
1027         {"Stereo1 ADC MIXL", "ADC1 Switch", "ADC L"},
1028         {"Stereo1 ADC MIXL", NULL, "stereo1 filter"},
1029         {"stereo1 filter", NULL, "PLL1", check_sysclk1_source},
1030
1031         {"Stereo1 ADC MIXR", "ADC1 Switch", "ADC R"},
1032         {"Stereo1 ADC MIXR", NULL, "stereo1 filter"},
1033         {"stereo1 filter", NULL, "PLL1", check_sysclk1_source},
1034
1035         {"IF1 ADC1", NULL, "Stereo1 ADC MIXL"},
1036         {"IF1 ADC1", NULL, "Stereo1 ADC MIXR"},
1037         {"IF1 ADC1", NULL, "I2S1"},
1038
1039         {"AIF1TX", NULL, "IF1 ADC1"},
1040
1041         {"IF1 DAC", NULL, "AIF1RX"},
1042         {"IF1 DAC", NULL, "I2S1"},
1043
1044         {"IF1 DAC1 L", NULL, "IF1 DAC"},
1045         {"IF1 DAC1 R", NULL, "IF1 DAC"},
1046
1047         {"DAC MIXL", "Stereo ADC Switch", "Stereo1 ADC MIXL"},
1048         {"DAC MIXL", "INF1 Switch", "IF1 DAC1 L"},
1049         {"DAC MIXR", "Stereo ADC Switch", "Stereo1 ADC MIXR"},
1050         {"DAC MIXR", "INF1 Switch", "IF1 DAC1 R"},
1051
1052         {"Audio DSP", NULL, "DAC MIXL"},
1053         {"Audio DSP", NULL, "DAC MIXR"},
1054
1055         {"Stereo DAC MIXL", "DAC L1 Switch", "Audio DSP"},
1056         {"Stereo DAC MIXL", "DAC R1 Switch", "DAC MIXR"},
1057         {"Stereo DAC MIXL", NULL, "Stero1 DAC Power"},
1058         {"Stereo DAC MIXR", "DAC R1 Switch", "Audio DSP"},
1059         {"Stereo DAC MIXR", "DAC L1 Switch", "DAC MIXL"},
1060         {"Stereo DAC MIXR", NULL, "Stero1 DAC Power"},
1061
1062         {"DAC L1", NULL, "Stereo DAC MIXL"},
1063         {"DAC L1", NULL, "PLL1", check_sysclk1_source},
1064         {"DAC R1", NULL, "Stereo DAC MIXR"},
1065         {"DAC R1", NULL, "PLL1", check_sysclk1_source},
1066
1067         {"OUT MIXL", "BST1 Switch", "BST1"},
1068         {"OUT MIXL", "BST2 Switch", "BST2"},
1069         {"OUT MIXL", "INL1 Switch", "INL1 VOL"},
1070         {"OUT MIXL", "REC MIXL Switch", "RECMIXL"},
1071         {"OUT MIXL", "DAC L1 Switch", "DAC L1"},
1072
1073         {"OUT MIXR", "BST2 Switch", "BST2"},
1074         {"OUT MIXR", "BST1 Switch", "BST1"},
1075         {"OUT MIXR", "INR1 Switch", "INR1 VOL"},
1076         {"OUT MIXR", "REC MIXR Switch", "RECMIXR"},
1077         {"OUT MIXR", "DAC R1 Switch", "DAC R1"},
1078
1079         {"HPOVOL L", NULL, "OUT MIXL"},
1080         {"HPOVOL R", NULL, "OUT MIXR"},
1081         {"OUTVOL L", NULL, "OUT MIXL"},
1082         {"OUTVOL R", NULL, "OUT MIXR"},
1083
1084         {"DAC 1", NULL, "DAC L1"},
1085         {"DAC 1", NULL, "DAC R1"},
1086         {"HPOVOL", NULL, "HPOVOL L"},
1087         {"HPOVOL", NULL, "HPOVOL R"},
1088         {"HPO MIX", "DAC1 Switch", "DAC 1"},
1089         {"HPO MIX", "HPVOL Switch", "HPOVOL"},
1090
1091         {"LOUT MIX", "DAC L1 Switch", "DAC L1"},
1092         {"LOUT MIX", "DAC R1 Switch", "DAC R1"},
1093         {"LOUT MIX", "OUTVOL L Switch", "OUTVOL L"},
1094         {"LOUT MIX", "OUTVOL R Switch", "OUTVOL R"},
1095
1096         {"HP amp", NULL, "HPO MIX"},
1097         {"HPOL", NULL, "HP amp"},
1098         {"HPOR", NULL, "HP amp"},
1099
1100         {"LOUT amp", NULL, "LOUT MIX"},
1101         {"LOUTL", NULL, "LOUT amp"},
1102         {"LOUTR", NULL, "LOUT amp"},
1103
1104 };
1105
1106 static int get_clk_info(int sclk, int rate)
1107 {
1108         int i, pd[] = {1, 2, 3, 4, 6, 8, 12, 16};
1109
1110         if (sclk <= 0 || rate <= 0)
1111                 return -EINVAL;
1112
1113         rate = rate << 8;
1114         for (i = 0; i < ARRAY_SIZE(pd); i++)
1115                 if (sclk == rate * pd[i])
1116                         return i;
1117
1118         return -EINVAL;
1119 }
1120
1121 static int rt5616_hw_params(struct snd_pcm_substream *substream,
1122         struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
1123 {
1124         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1125         struct snd_soc_codec *codec = rtd->codec;
1126         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1127         unsigned int val_len = 0, val_clk, mask_clk;
1128         int pre_div, bclk_ms, frame_size;
1129
1130         rt5616->lrck[dai->id] = params_rate(params);
1131         pre_div = get_clk_info(rt5616->sysclk, rt5616->lrck[dai->id]);
1132
1133         if (pre_div < 0) {
1134                 dev_err(codec->dev, "Unsupported clock setting\n");
1135                 return -EINVAL;
1136         }
1137         frame_size = snd_soc_params_to_frame_size(params);
1138         if (frame_size < 0) {
1139                 dev_err(codec->dev, "Unsupported frame size: %d\n", frame_size);
1140                 return -EINVAL;
1141         }
1142         bclk_ms = frame_size > 32 ? 1 : 0;
1143         rt5616->bclk[dai->id] = rt5616->lrck[dai->id] * (32 << bclk_ms);
1144
1145         dev_dbg(dai->dev, "bclk is %dHz and lrck is %dHz\n",
1146                 rt5616->bclk[dai->id], rt5616->lrck[dai->id]);
1147         dev_dbg(dai->dev, "bclk_ms is %d and pre_div is %d for iis %d\n",
1148                                 bclk_ms, pre_div, dai->id);
1149
1150         switch (params_format(params)) {
1151         case SNDRV_PCM_FORMAT_S16_LE:
1152                 break;
1153         case SNDRV_PCM_FORMAT_S20_3LE:
1154                 val_len |= RT5616_I2S_DL_20;
1155                 break;
1156         case SNDRV_PCM_FORMAT_S24_LE:
1157                 val_len |= RT5616_I2S_DL_24;
1158                 break;
1159         case SNDRV_PCM_FORMAT_S8:
1160                 val_len |= RT5616_I2S_DL_8;
1161                 break;
1162         default:
1163                 return -EINVAL;
1164         }
1165
1166         mask_clk = RT5616_I2S_PD1_MASK;
1167         val_clk = pre_div << RT5616_I2S_PD1_SFT;
1168         snd_soc_update_bits(codec, RT5616_I2S1_SDP,
1169                 RT5616_I2S_DL_MASK, val_len);
1170         snd_soc_update_bits(codec, RT5616_ADDA_CLK1, mask_clk, val_clk);
1171
1172
1173         return 0;
1174 }
1175
1176 static int rt5616_prepare(struct snd_pcm_substream *substream,
1177                                 struct snd_soc_dai *dai)
1178 {
1179         struct snd_soc_pcm_runtime *rtd = substream->private_data;
1180         struct snd_soc_codec *codec = rtd->codec;
1181         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1182
1183         rt5616->aif_pu = dai->id;
1184         return 0;
1185 }
1186
1187 static int rt5616_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1188 {
1189         struct snd_soc_codec *codec = dai->codec;
1190         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1191         unsigned int reg_val = 0;
1192
1193         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1194         case SND_SOC_DAIFMT_CBM_CFM:
1195                 rt5616->master[dai->id] = 1;
1196                 break;
1197         case SND_SOC_DAIFMT_CBS_CFS:
1198                 reg_val |= RT5616_I2S_MS_S;
1199                 rt5616->master[dai->id] = 0;
1200                 break;
1201         default:
1202                 return -EINVAL;
1203         }
1204
1205         switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1206         case SND_SOC_DAIFMT_NB_NF:
1207                 break;
1208         case SND_SOC_DAIFMT_IB_NF:
1209                 reg_val |= RT5616_I2S_BP_INV;
1210                 break;
1211         default:
1212                 return -EINVAL;
1213         }
1214
1215         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1216         case SND_SOC_DAIFMT_I2S:
1217                 break;
1218         case SND_SOC_DAIFMT_LEFT_J:
1219                 reg_val |= RT5616_I2S_DF_LEFT;
1220                 break;
1221         case SND_SOC_DAIFMT_DSP_A:
1222                 reg_val |= RT5616_I2S_DF_PCM_A;
1223                 break;
1224         case SND_SOC_DAIFMT_DSP_B:
1225                 reg_val |= RT5616_I2S_DF_PCM_B;
1226                 break;
1227         default:
1228                 return -EINVAL;
1229         }
1230
1231         snd_soc_update_bits(codec, RT5616_I2S1_SDP,
1232                 RT5616_I2S_MS_MASK | RT5616_I2S_BP_MASK |
1233                 RT5616_I2S_DF_MASK, reg_val);
1234
1235
1236         return 0;
1237 }
1238
1239 static int rt5616_set_dai_sysclk(struct snd_soc_dai *dai,
1240                 int clk_id, unsigned int freq, int dir)
1241 {
1242         struct snd_soc_codec *codec = dai->codec;
1243         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1244         unsigned int reg_val = 0;
1245
1246         if (freq == rt5616->sysclk && clk_id == rt5616->sysclk_src)
1247                 return 0;
1248
1249         switch (clk_id) {
1250         case RT5616_SCLK_S_MCLK:
1251                 reg_val |= RT5616_SCLK_SRC_MCLK;
1252                 break;
1253         case RT5616_SCLK_S_PLL1:
1254                 reg_val |= RT5616_SCLK_SRC_PLL1;
1255                 break;
1256         default:
1257                 dev_err(codec->dev, "Invalid clock id (%d)\n", clk_id);
1258                 return -EINVAL;
1259         }
1260         snd_soc_update_bits(codec, RT5616_GLB_CLK,
1261                 RT5616_SCLK_SRC_MASK, reg_val);
1262         rt5616->sysclk = freq;
1263         rt5616->sysclk_src = clk_id;
1264
1265         dev_dbg(dai->dev, "Sysclk is %dHz and clock id is %d\n", freq, clk_id);
1266
1267         return 0;
1268 }
1269
1270 /**
1271  * rt5616_pll_calc - Calcualte PLL M/N/K code.
1272  * @freq_in: external clock provided to codec.
1273  * @freq_out: target clock which codec works on.
1274  * @pll_code: Pointer to structure with M, N, K and bypass flag.
1275  *
1276  * Calcualte M/N/K code to configure PLL for codec. And K is assigned to 2
1277  * which make calculation more efficiently.
1278  *
1279  * Returns 0 for success or negative error code.
1280  */
1281 static int rt5616_pll_calc(const unsigned int freq_in,
1282         const unsigned int freq_out, struct rt5616_pll_code *pll_code)
1283 {
1284         int max_n = RT5616_PLL_N_MAX, max_m = RT5616_PLL_M_MAX;
1285         int k, n, m, red, n_t, m_t, in_t, out_t, red_t = abs(freq_out - freq_in);
1286         bool bypass = false;
1287
1288         if (RT5616_PLL_INP_MAX < freq_in || RT5616_PLL_INP_MIN > freq_in)
1289                 return -EINVAL;
1290
1291         k=100000000/freq_out-2;
1292         if(k>31)
1293                 k = 31;
1294         for (n_t = 0; n_t <= max_n; n_t++) {
1295                 in_t = (freq_in >> 1) + (freq_in >> 2) * n_t;
1296                 if (in_t < 0)
1297                         continue;
1298                 if (in_t == freq_out) {
1299                         bypass = true;
1300                         n = n_t;
1301                         goto code_find;
1302                 }
1303                 red = abs(in_t - freq_out); //m bypass
1304                 if (red < red_t) {
1305                         bypass = true;
1306                         n = n_t;
1307                         m = m_t;
1308                         if (red == 0)
1309                                 goto code_find;
1310                         red_t = red;
1311                 }
1312                 for (m_t = 0; m_t <= max_m; m_t++) {
1313                         out_t = in_t / (m_t + 2);
1314                         red = abs(out_t - freq_out);
1315                         if (red < red_t) {
1316                                 bypass = false;
1317                                 n = n_t;
1318                                 m = m_t;
1319                                 if (red == 0)
1320                                         goto code_find;
1321                                 red_t = red;
1322                         }
1323                 }
1324         }
1325         pr_debug("Only get approximation about PLL\n");
1326
1327 code_find:
1328
1329         pll_code->m_bp = bypass;
1330         pll_code->m_code = m;
1331         pll_code->n_code = n;
1332         pll_code->k_code = k;
1333         return 0;
1334 }
1335
1336 static int rt5616_set_dai_pll(struct snd_soc_dai *dai, int pll_id, int source,
1337                         unsigned int freq_in, unsigned int freq_out)
1338 {
1339         struct snd_soc_codec *codec = dai->codec;
1340         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1341         struct rt5616_pll_code pll_code;
1342         int ret;
1343
1344         if (source == rt5616->pll_src && freq_in == rt5616->pll_in &&
1345             freq_out == rt5616->pll_out)
1346                 return 0;
1347
1348         if (!freq_in || !freq_out) {
1349                 dev_dbg(codec->dev, "PLL disabled\n");
1350
1351                 rt5616->pll_in = 0;
1352                 rt5616->pll_out = 0;
1353                 snd_soc_update_bits(codec, RT5616_GLB_CLK,
1354                         RT5616_SCLK_SRC_MASK, RT5616_SCLK_SRC_MCLK);
1355                 return 0;
1356         }
1357
1358         switch (source) {
1359         case RT5616_PLL1_S_MCLK:
1360                 snd_soc_update_bits(codec, RT5616_GLB_CLK,
1361                         RT5616_PLL1_SRC_MASK, RT5616_PLL1_SRC_MCLK);
1362                 break;
1363         case RT5616_PLL1_S_BCLK1:
1364         case RT5616_PLL1_S_BCLK2:
1365
1366                 snd_soc_update_bits(codec, RT5616_GLB_CLK,
1367                         RT5616_PLL1_SRC_MASK, RT5616_PLL1_SRC_BCLK1);
1368
1369
1370                 break;
1371         default:
1372                 dev_err(codec->dev, "Unknown PLL source %d\n", source);
1373                 return -EINVAL;
1374         }
1375
1376         ret = rt5616_pll_calc(freq_in, freq_out, &pll_code);
1377         if (ret < 0) {
1378                 dev_err(codec->dev, "Unsupport input clock %d\n", freq_in);
1379                 return ret;
1380         }
1381
1382         dev_dbg(codec->dev, "bypass=%d m=%d n=%d k=%d\n", pll_code.m_bp,
1383                 (pll_code.m_bp ? 0 : pll_code.m_code), pll_code.n_code, pll_code.k_code);
1384
1385         snd_soc_write(codec, RT5616_PLL_CTRL1,
1386                 pll_code.n_code << RT5616_PLL_N_SFT | pll_code.k_code);
1387         snd_soc_write(codec, RT5616_PLL_CTRL2,
1388                 (pll_code.m_bp ? 0 : pll_code.m_code) << RT5616_PLL_M_SFT |
1389                 pll_code.m_bp << RT5616_PLL_M_BP_SFT);
1390
1391         rt5616->pll_in = freq_in;
1392         rt5616->pll_out = freq_out;
1393         rt5616->pll_src = source;
1394
1395         return 0;
1396 }
1397
1398 /**
1399  * rt5616_index_show - Dump private registers.
1400  * @dev: codec device.
1401  * @attr: device attribute.
1402  * @buf: buffer for display.
1403  *
1404  * To show non-zero values of all private registers.
1405  *
1406  * Returns buffer length.
1407  */
1408 static ssize_t rt5616_index_show(struct device *dev,
1409         struct device_attribute *attr, char *buf)
1410 {
1411         struct i2c_client *client = to_i2c_client(dev);
1412         struct rt5616_priv *rt5616 = i2c_get_clientdata(client);
1413         struct snd_soc_codec *codec = rt5616->codec;
1414         unsigned int val;
1415         int cnt = 0, i;
1416
1417         cnt += sprintf(buf, "RT5616 index register\n");
1418         for (i = 0; i < 0xb4; i++) {
1419                 if (cnt + RT5616_REG_DISP_LEN >= PAGE_SIZE)
1420                         break;
1421                 val = rt5616_index_read(codec, i);
1422                 if (!val)
1423                         continue;
1424                 cnt += snprintf(buf + cnt, RT5616_REG_DISP_LEN,
1425                                 "%02x: %04x\n", i, val);
1426         }
1427
1428         if (cnt >= PAGE_SIZE)
1429                 cnt = PAGE_SIZE - 1;
1430
1431         return cnt;
1432 }
1433 static DEVICE_ATTR(index_reg, 0444, rt5616_index_show, NULL);
1434
1435 static int rt5616_set_bias_level(struct snd_soc_codec *codec,
1436                         enum snd_soc_bias_level level)
1437 {
1438         switch (level) {
1439         case SND_SOC_BIAS_ON:
1440                 break;
1441
1442         case SND_SOC_BIAS_PREPARE:
1443                 break;
1444
1445         case SND_SOC_BIAS_STANDBY:
1446                 if (SND_SOC_BIAS_OFF == codec->dapm.bias_level) {
1447                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
1448                                 RT5616_PWR_VREF1 | RT5616_PWR_MB |
1449                                 RT5616_PWR_BG | RT5616_PWR_VREF2,
1450                                 RT5616_PWR_VREF1 | RT5616_PWR_MB |
1451                                 RT5616_PWR_BG | RT5616_PWR_VREF2);
1452                         msleep(10);
1453                         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
1454                                 RT5616_PWR_FV1 | RT5616_PWR_FV2,
1455                                 RT5616_PWR_FV1 | RT5616_PWR_FV2);
1456                         codec->cache_only = false;
1457                         codec->cache_sync = 1;
1458                         snd_soc_cache_sync(codec);
1459                         rt5616_index_sync(codec);
1460                         snd_soc_write(codec, RT5616_D_MISC, 0x0011);
1461                 }
1462                 break;
1463
1464         case SND_SOC_BIAS_OFF:
1465                 snd_soc_write(codec, RT5616_D_MISC, 0x0010);
1466                 snd_soc_write(codec, RT5616_PWR_DIG1, 0x0000);
1467                 snd_soc_write(codec, RT5616_PWR_DIG2, 0x0000);
1468                 snd_soc_write(codec, RT5616_PWR_VOL, 0x0000);
1469                 snd_soc_write(codec, RT5616_PWR_MIXER, 0x0000);
1470                 snd_soc_write(codec, RT5616_PWR_ANLG1, 0x0000);
1471                 snd_soc_write(codec, RT5616_PWR_ANLG2, 0x0000);
1472                 break;
1473
1474         default:
1475                 break;
1476         }
1477         codec->dapm.bias_level = level;
1478
1479         return 0;
1480 }
1481
1482 void rt5616_codec_set_spk(bool on)
1483 {
1484
1485         struct snd_soc_codec *codec = rt5616_codec;
1486         printk("%s: %d\n", __func__, on);
1487
1488         if(!codec)
1489                 return;
1490
1491         mutex_lock(&codec->mutex);
1492         if(on){
1493                 printk(">>>> snd_soc_dapm_enable_pin\n");
1494                 snd_soc_dapm_enable_pin(&codec->dapm, "Headphone Jack");
1495                 snd_soc_dapm_enable_pin(&codec->dapm, "Ext Spk");
1496         }else{
1497                 printk(">>>> snd_soc_dapm_disable_pin\n");
1498                 snd_soc_dapm_disable_pin(&codec->dapm, "Headphone Jack");
1499                 snd_soc_dapm_disable_pin(&codec->dapm, "Ext Spk");
1500         }
1501         snd_soc_dapm_sync(&codec->dapm);
1502         mutex_unlock(&codec->mutex);
1503 }
1504 static int rt5616_probe(struct snd_soc_codec *codec)
1505 {
1506         struct rt5616_priv *rt5616 = snd_soc_codec_get_drvdata(codec);
1507         int ret;
1508         printk("enter %s\n",__func__);
1509         ret = snd_soc_codec_set_cache_io(codec, 8, 16, SND_SOC_I2C);
1510         if (ret != 0) {
1511                 dev_err(codec->dev, "Failed to set cache I/O: %d\n", ret);
1512                 return ret;
1513         }
1514
1515         rt5616_reset(codec);
1516         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
1517                 RT5616_PWR_VREF1 | RT5616_PWR_MB |
1518                 RT5616_PWR_BG | RT5616_PWR_VREF2,
1519                 RT5616_PWR_VREF1 | RT5616_PWR_MB |
1520                 RT5616_PWR_BG | RT5616_PWR_VREF2);
1521         msleep(10);
1522         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
1523                 RT5616_PWR_FV1 | RT5616_PWR_FV2,
1524                 RT5616_PWR_FV1 | RT5616_PWR_FV2);
1525
1526         rt5616_reg_init(codec);
1527         snd_soc_update_bits(codec, RT5616_PWR_ANLG1,
1528                 RT5616_PWR_LDO_DVO_MASK, RT5616_PWR_LDO_DVO_1_2V);
1529
1530         codec->dapm.bias_level = SND_SOC_BIAS_STANDBY;
1531         rt5616->codec = codec;
1532
1533       rt5616_codec = codec;
1534
1535         snd_soc_add_codec_controls(codec, rt5616_snd_controls,
1536                         ARRAY_SIZE(rt5616_snd_controls));
1537         snd_soc_dapm_new_controls(&codec->dapm, rt5616_dapm_widgets,
1538                         ARRAY_SIZE(rt5616_dapm_widgets));
1539         snd_soc_dapm_add_routes(&codec->dapm, rt5616_dapm_routes,
1540                         ARRAY_SIZE(rt5616_dapm_routes));
1541
1542         ret = device_create_file(codec->dev, &dev_attr_index_reg);
1543         if (ret != 0) {
1544                 dev_err(codec->dev,
1545                         "Failed to create index_reg sysfs files: %d\n", ret);
1546                 return ret;
1547         }
1548
1549         return 0;
1550 }
1551
1552 static int rt5616_remove(struct snd_soc_codec *codec)
1553 {
1554         rt5616_set_bias_level(codec, SND_SOC_BIAS_OFF);
1555         return 0;
1556 }
1557
1558 #ifdef CONFIG_PM
1559 static int rt5616_suspend(struct snd_soc_codec *codec)
1560 {
1561         rt5616_set_bias_level(codec, SND_SOC_BIAS_OFF);
1562         return 0;
1563 }
1564
1565 static int rt5616_resume(struct snd_soc_codec *codec)
1566 {
1567         rt5616_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1568         return 0;
1569 }
1570 #else
1571 #define rt5616_suspend NULL
1572 #define rt5616_resume NULL
1573 #endif
1574
1575 #define RT5616_STEREO_RATES SNDRV_PCM_RATE_8000_96000
1576 #define RT5616_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE | \
1577                         SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S8)
1578
1579
1580 struct snd_soc_dai_ops rt5616_aif_dai_ops = {
1581         .hw_params = rt5616_hw_params,
1582         .prepare = rt5616_prepare,
1583         .set_fmt = rt5616_set_dai_fmt,
1584         .set_sysclk = rt5616_set_dai_sysclk,
1585         .set_pll = rt5616_set_dai_pll,
1586 };
1587
1588 struct snd_soc_dai_driver rt5616_dai[] = {
1589         {
1590                 .name = "rt5616-aif1",
1591                 .id = RT5616_AIF1,
1592                 .playback = {
1593                         .stream_name = "AIF1 Playback",
1594                         .channels_min = 1,
1595                         .channels_max = 2,
1596                         .rates = RT5616_STEREO_RATES,
1597                         .formats = RT5616_FORMATS,
1598                 },
1599                 .capture = {
1600                         .stream_name = "AIF1 Capture",
1601                         .channels_min = 1,
1602                         .channels_max = 2,
1603                         .rates = RT5616_STEREO_RATES,
1604                         .formats = RT5616_FORMATS,
1605                 },
1606                 .ops = &rt5616_aif_dai_ops,
1607         },
1608 };
1609
1610 static struct snd_soc_codec_driver soc_codec_dev_rt5616 = {
1611         .probe = rt5616_probe,
1612         .remove = rt5616_remove,
1613         .suspend = rt5616_suspend,
1614         .resume = rt5616_resume,
1615         .set_bias_level = rt5616_set_bias_level,
1616         .reg_cache_size = RT5616_DEVICE_ID + 1,
1617         .reg_word_size = sizeof(u16),
1618         .reg_cache_default = rt5616_reg,
1619         .volatile_register = rt5616_volatile_register,
1620         .readable_register = rt5616_readable_register,
1621         .reg_cache_step = 1,
1622 };
1623
1624 static const struct i2c_device_id rt5616_i2c_id[] = {
1625         { "rt5616", 0 },
1626         { }
1627 };
1628 MODULE_DEVICE_TABLE(i2c, rt5616_i2c_id);
1629
1630 static int rt5616_i2c_probe(struct i2c_client *i2c,
1631                     const struct i2c_device_id *id)
1632 {
1633         struct rt5616_priv *rt5616;
1634         int ret;
1635         printk("enter %s\n",__func__);
1636
1637         rt5616 = kzalloc(sizeof(struct rt5616_priv), GFP_KERNEL);
1638         if (NULL == rt5616)
1639                 return -ENOMEM;
1640
1641         i2c_set_clientdata(i2c, rt5616);
1642
1643         ret = snd_soc_register_codec(&i2c->dev, &soc_codec_dev_rt5616,
1644                         rt5616_dai, ARRAY_SIZE(rt5616_dai));
1645         if (ret < 0)
1646                 kfree(rt5616);
1647
1648         return ret;
1649 }
1650
1651 static int rt5616_i2c_remove(struct i2c_client *i2c)
1652 {
1653         snd_soc_unregister_codec(&i2c->dev);
1654         kfree(i2c_get_clientdata(i2c));
1655         return 0;
1656 }
1657
1658 static void rt5616_i2c_shutdown(struct i2c_client *client)
1659 {
1660         struct rt5616_priv *rt5616 = i2c_get_clientdata(client);
1661         struct snd_soc_codec *codec = rt5616->codec;
1662
1663         if (codec != NULL)
1664         {
1665                 snd_soc_write(codec, RT5616_HP_VOL, 0xc8c8);
1666                 snd_soc_write(codec, RT5616_LOUT_CTRL1, 0xc8c8);
1667                 rt5616_set_bias_level(codec, SND_SOC_BIAS_OFF);
1668         }
1669
1670 }
1671
1672 struct i2c_driver rt5616_i2c_driver = {
1673         .driver = {
1674                 .name = "rt5616",
1675                 .owner = THIS_MODULE,
1676         },
1677         .probe = rt5616_i2c_probe,
1678         .remove   = rt5616_i2c_remove,
1679         .shutdown = rt5616_i2c_shutdown,
1680         .id_table = rt5616_i2c_id,
1681 };
1682
1683 static int __init rt5616_modinit(void)
1684 {
1685         printk("enter %s\n",__func__);
1686         return i2c_add_driver(&rt5616_i2c_driver);
1687 }
1688 module_init(rt5616_modinit);
1689
1690 static void __exit rt5616_modexit(void)
1691 {
1692         i2c_del_driver(&rt5616_i2c_driver);
1693 }
1694 module_exit(rt5616_modexit);
1695
1696 MODULE_DESCRIPTION("ASoC RT5616 driver");
1697 MODULE_AUTHOR("Johnny Hsu <johnnyhsu@realtek.com>");
1698 MODULE_LICENSE("GPL");