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