sound/soc/codecs/wm8994.c

   1 /*
   2  * wm8994.c  --  WM8994 ALSA SoC Audio driver
   3  *
   4  * Copyright 2009 Wolfson Microelectronics plc
   5  *
   6  * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
   7  *
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License version 2 as
  11  * published by the Free Software Foundation.
  12  */
  13
  14 #include <linux/module.h>
  15 #include <linux/moduleparam.h>
  16 #include <linux/init.h>
  17 #include <linux/delay.h>
  18 #include <linux/pm.h>
  19 #include <linux/i2c.h>
  20 #include <linux/platform_device.h>
  21 #include <linux/pm_runtime.h>
  22 #include <linux/regulator/consumer.h>
  23 #include <linux/slab.h>
  24 #include <sound/core.h>
  25 #include <sound/jack.h>
  26 #include <sound/pcm.h>
  27 #include <sound/pcm_params.h>
  28 #include <sound/soc.h>
  29 #include <sound/initval.h>
  30 #include <sound/tlv.h>
  31 #include <trace/events/asoc.h>
  32
  33 #include <linux/mfd/wm8994/core.h>
  34 #include <linux/mfd/wm8994/registers.h>
  35 #include <linux/mfd/wm8994/pdata.h>
  36 #include <linux/mfd/wm8994/gpio.h>
  37
  38 #include "wm8994.h"
  39 #include "wm_hubs.h"
  40
  41 struct fll_config {
  42         int src;
  43         int in;
  44         int out;
  45 };
  46
  47 #define WM8994_NUM_DRC 3
  48 #define WM8994_NUM_EQ  3
  49
  50 static int wm8994_drc_base[] = {
  51         WM8994_AIF1_DRC1_1,
  52         WM8994_AIF1_DRC2_1,
  53         WM8994_AIF2_DRC_1,
  54 };
  55
  56 static int wm8994_retune_mobile_base[] = {
  57         WM8994_AIF1_DAC1_EQ_GAINS_1,
  58         WM8994_AIF1_DAC2_EQ_GAINS_1,
  59         WM8994_AIF2_EQ_GAINS_1,
  60 };
  61
  62 struct wm8994_micdet {
  63         struct snd_soc_jack *jack;
  64         int det;
  65         int shrt;
  66 };
  67
  68 /* codec private data */
  69 struct wm8994_priv {
  70         struct wm_hubs_data hubs;
  71         enum snd_soc_control_type control_type;
  72         void *control_data;
  73         struct snd_soc_codec *codec;
  74         int sysclk[2];
  75         int sysclk_rate[2];
  76         int mclk[2];
  77         int aifclk[2];
  78         struct fll_config fll[2], fll_suspend[2];
  79
  80         int dac_rates[2];
  81         int lrclk_shared[2];
  82
  83         int mbc_ena[3];
  84
  85         /* Platform dependant DRC configuration */
  86         const char **drc_texts;
  87         int drc_cfg[WM8994_NUM_DRC];
  88         struct soc_enum drc_enum;
  89
  90         /* Platform dependant ReTune mobile configuration */
  91         int num_retune_mobile_texts;
  92         const char **retune_mobile_texts;
  93         int retune_mobile_cfg[WM8994_NUM_EQ];
  94         struct soc_enum retune_mobile_enum;
  95
  96         /* Platform dependant MBC configuration */
  97         int mbc_cfg;
  98         const char **mbc_texts;
  99         struct soc_enum mbc_enum;
 100
 101         struct wm8994_micdet micdet[2];
 102
 103         wm8958_micdet_cb jack_cb;
 104         void *jack_cb_data;
 105         bool jack_is_mic;
 106         bool jack_is_video;
 107
 108         int revision;
 109         struct wm8994_pdata *pdata;
 110 };
 111
 112 static int wm8994_readable(unsigned int reg)
 113 {
 114         switch (reg) {
 115         case WM8994_GPIO_1:
 116         case WM8994_GPIO_2:
 117         case WM8994_GPIO_3:
 118         case WM8994_GPIO_4:
 119         case WM8994_GPIO_5:
 120         case WM8994_GPIO_6:
 121         case WM8994_GPIO_7:
 122         case WM8994_GPIO_8:
 123         case WM8994_GPIO_9:
 124         case WM8994_GPIO_10:
 125         case WM8994_GPIO_11:
 126         case WM8994_INTERRUPT_STATUS_1:
 127         case WM8994_INTERRUPT_STATUS_2:
 128         case WM8994_INTERRUPT_RAW_STATUS_2:
 129                 return 1;
 130         default:
 131                 break;
 132         }
 133
 134         if (reg >= WM8994_CACHE_SIZE)
 135                 return 0;
 136         return wm8994_access_masks[reg].readable != 0;
 137 }
 138
 139 static int wm8994_volatile(unsigned int reg)
 140 {
 141         if (reg >= WM8994_CACHE_SIZE)
 142                 return 1;
 143
 144         switch (reg) {
 145         case WM8994_SOFTWARE_RESET:
 146         case WM8994_CHIP_REVISION:
 147         case WM8994_DC_SERVO_1:
 148         case WM8994_DC_SERVO_READBACK:
 149         case WM8994_RATE_STATUS:
 150         case WM8994_LDO_1:
 151         case WM8994_LDO_2:
 152         case WM8958_DSP2_EXECCONTROL:
 153         case WM8958_MIC_DETECT_3:
 154                 return 1;
 155         default:
 156                 return 0;
 157         }
 158 }
 159
 160 static int wm8994_write(struct snd_soc_codec *codec, unsigned int reg,
 161         unsigned int value)
 162 {
 163         int ret;
 164
 165         BUG_ON(reg > WM8994_MAX_REGISTER);
 166
 167         if (!wm8994_volatile(reg)) {
 168                 ret = snd_soc_cache_write(codec, reg, value);
 169                 if (ret != 0)
 170                         dev_err(codec->dev, "Cache write to %x failed: %d\n",
 171                                 reg, ret);
 172         }
 173
 174         return wm8994_reg_write(codec->control_data, reg, value);
 175 }
 176
 177 static unsigned int wm8994_read(struct snd_soc_codec *codec,
 178                                 unsigned int reg)
 179 {
 180         unsigned int val;
 181         int ret;
 182
 183         BUG_ON(reg > WM8994_MAX_REGISTER);
 184
 185         if (!wm8994_volatile(reg) && wm8994_readable(reg) &&
 186             reg < codec->driver->reg_cache_size) {
 187                 ret = snd_soc_cache_read(codec, reg, &val);
 188                 if (ret >= 0)
 189                         return val;
 190                 else
 191                         dev_err(codec->dev, "Cache read from %x failed: %d\n",
 192                                 reg, ret);
 193         }
 194
 195         return wm8994_reg_read(codec->control_data, reg);
 196 }
 197
 198 static int configure_aif_clock(struct snd_soc_codec *codec, int aif)
 199 {
 200         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 201         int rate;
 202         int reg1 = 0;
 203         int offset;
 204
 205         if (aif)
 206                 offset = 4;
 207         else
 208                 offset = 0;
 209
 210         switch (wm8994->sysclk[aif]) {
 211         case WM8994_SYSCLK_MCLK1:
 212                 rate = wm8994->mclk[0];
 213                 break;
 214
 215         case WM8994_SYSCLK_MCLK2:
 216                 reg1 |= 0x8;
 217                 rate = wm8994->mclk[1];
 218                 break;
 219
 220         case WM8994_SYSCLK_FLL1:
 221                 reg1 |= 0x10;
 222                 rate = wm8994->fll[0].out;
 223                 break;
 224
 225         case WM8994_SYSCLK_FLL2:
 226                 reg1 |= 0x18;
 227                 rate = wm8994->fll[1].out;
 228                 break;
 229
 230         default:
 231                 return -EINVAL;
 232         }
 233
 234         if (rate >= 13500000) {
 235                 rate /= 2;
 236                 reg1 |= WM8994_AIF1CLK_DIV;
 237
 238                 dev_dbg(codec->dev, "Dividing AIF%d clock to %dHz\n",
 239                         aif + 1, rate);
 240         }
 241
 242         if (rate && rate < 3000000)
 243                 dev_warn(codec->dev, "AIF%dCLK is %dHz, should be >=3MHz for optimal performance\n",
 244                          aif + 1, rate);
 245
 246         wm8994->aifclk[aif] = rate;
 247
 248         snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1 + offset,
 249                             WM8994_AIF1CLK_SRC_MASK | WM8994_AIF1CLK_DIV,
 250                             reg1);
 251
 252         return 0;
 253 }
 254
 255 static int configure_clock(struct snd_soc_codec *codec)
 256 {
 257         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 258         int old, new;
 259
 260         /* Bring up the AIF clocks first */
 261         configure_aif_clock(codec, 0);
 262         configure_aif_clock(codec, 1);
 263
 264         /* Then switch CLK_SYS over to the higher of them; a change
 265          * can only happen as a result of a clocking change which can
 266          * only be made outside of DAPM so we can safely redo the
 267          * clocking.
 268          */
 269
 270         /* If they're equal it doesn't matter which is used */
 271         if (wm8994->aifclk[0] == wm8994->aifclk[1])
 272                 return 0;
 273
 274         if (wm8994->aifclk[0] < wm8994->aifclk[1])
 275                 new = WM8994_SYSCLK_SRC;
 276         else
 277                 new = 0;
 278
 279         old = snd_soc_read(codec, WM8994_CLOCKING_1) & WM8994_SYSCLK_SRC;
 280
 281         /* If there's no change then we're done. */
 282         if (old == new)
 283                 return 0;
 284
 285         snd_soc_update_bits(codec, WM8994_CLOCKING_1, WM8994_SYSCLK_SRC, new);
 286
 287         snd_soc_dapm_sync(&codec->dapm);
 288
 289         return 0;
 290 }
 291
 292 static int check_clk_sys(struct snd_soc_dapm_widget *source,
 293                          struct snd_soc_dapm_widget *sink)
 294 {
 295         int reg = snd_soc_read(source->codec, WM8994_CLOCKING_1);
 296         const char *clk;
 297
 298         /* Check what we're currently using for CLK_SYS */
 299         if (reg & WM8994_SYSCLK_SRC)
 300                 clk = "AIF2CLK";
 301         else
 302                 clk = "AIF1CLK";
 303
 304         return strcmp(source->name, clk) == 0;
 305 }
 306
 307 static const char *sidetone_hpf_text[] = {
 308         "2.7kHz", "1.35kHz", "675Hz", "370Hz", "180Hz", "90Hz", "45Hz"
 309 };
 310
 311 static const struct soc_enum sidetone_hpf =
 312         SOC_ENUM_SINGLE(WM8994_SIDETONE, 7, 7, sidetone_hpf_text);
 313
 314 static const char *adc_hpf_text[] = {
 315         "HiFi", "Voice 1", "Voice 2", "Voice 3"
 316 };
 317
 318 static const struct soc_enum aif1adc1_hpf =
 319         SOC_ENUM_SINGLE(WM8994_AIF1_ADC1_FILTERS, 13, 4, adc_hpf_text);
 320
 321 static const struct soc_enum aif1adc2_hpf =
 322         SOC_ENUM_SINGLE(WM8994_AIF1_ADC2_FILTERS, 13, 4, adc_hpf_text);
 323
 324 static const struct soc_enum aif2adc_hpf =
 325         SOC_ENUM_SINGLE(WM8994_AIF2_ADC_FILTERS, 13, 4, adc_hpf_text);
 326
 327 static const DECLARE_TLV_DB_SCALE(aif_tlv, 0, 600, 0);
 328 static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
 329 static const DECLARE_TLV_DB_SCALE(st_tlv, -3600, 300, 0);
 330 static const DECLARE_TLV_DB_SCALE(wm8994_3d_tlv, -1600, 183, 0);
 331 static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0);
 332
 333 #define WM8994_DRC_SWITCH(xname, reg, shift) \
 334 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
 335         .info = snd_soc_info_volsw, .get = snd_soc_get_volsw,\
 336         .put = wm8994_put_drc_sw, \
 337         .private_value =  SOC_SINGLE_VALUE(reg, shift, 1, 0) }
 338
 339 static int wm8994_put_drc_sw(struct snd_kcontrol *kcontrol,
 340                              struct snd_ctl_elem_value *ucontrol)
 341 {
 342         struct soc_mixer_control *mc =
 343                 (struct soc_mixer_control *)kcontrol->private_value;
 344         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 345         int mask, ret;
 346
 347         /* Can't enable both ADC and DAC paths simultaneously */
 348         if (mc->shift == WM8994_AIF1DAC1_DRC_ENA_SHIFT)
 349                 mask = WM8994_AIF1ADC1L_DRC_ENA_MASK |
 350                         WM8994_AIF1ADC1R_DRC_ENA_MASK;
 351         else
 352                 mask = WM8994_AIF1DAC1_DRC_ENA_MASK;
 353
 354         ret = snd_soc_read(codec, mc->reg);
 355         if (ret < 0)
 356                 return ret;
 357         if (ret & mask)
 358                 return -EINVAL;
 359
 360         return snd_soc_put_volsw(kcontrol, ucontrol);
 361 }
 362
 363 static void wm8994_set_drc(struct snd_soc_codec *codec, int drc)
 364 {
 365         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 366         struct wm8994_pdata *pdata = wm8994->pdata;
 367         int base = wm8994_drc_base[drc];
 368         int cfg = wm8994->drc_cfg[drc];
 369         int save, i;
 370
 371         /* Save any enables; the configuration should clear them. */
 372         save = snd_soc_read(codec, base);
 373         save &= WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA |
 374                 WM8994_AIF1ADC1R_DRC_ENA;
 375
 376         for (i = 0; i < WM8994_DRC_REGS; i++)
 377                 snd_soc_update_bits(codec, base + i, 0xffff,
 378                                     pdata->drc_cfgs[cfg].regs[i]);
 379
 380         snd_soc_update_bits(codec, base, WM8994_AIF1DAC1_DRC_ENA |
 381                              WM8994_AIF1ADC1L_DRC_ENA |
 382                              WM8994_AIF1ADC1R_DRC_ENA, save);
 383 }
 384
 385 /* Icky as hell but saves code duplication */
 386 static int wm8994_get_drc(const char *name)
 387 {
 388         if (strcmp(name, "AIF1DRC1 Mode") == 0)
 389                 return 0;
 390         if (strcmp(name, "AIF1DRC2 Mode") == 0)
 391                 return 1;
 392         if (strcmp(name, "AIF2DRC Mode") == 0)
 393                 return 2;
 394         return -EINVAL;
 395 }
 396
 397 static int wm8994_put_drc_enum(struct snd_kcontrol *kcontrol,
 398                                struct snd_ctl_elem_value *ucontrol)
 399 {
 400         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 401         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 402         struct wm8994_pdata *pdata = wm8994->pdata;
 403         int drc = wm8994_get_drc(kcontrol->id.name);
 404         int value = ucontrol->value.integer.value[0];
 405
 406         if (drc < 0)
 407                 return drc;
 408
 409         if (value >= pdata->num_drc_cfgs)
 410                 return -EINVAL;
 411
 412         wm8994->drc_cfg[drc] = value;
 413
 414         wm8994_set_drc(codec, drc);
 415
 416         return 0;
 417 }
 418
 419 static int wm8994_get_drc_enum(struct snd_kcontrol *kcontrol,
 420                                struct snd_ctl_elem_value *ucontrol)
 421 {
 422         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 423         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 424         int drc = wm8994_get_drc(kcontrol->id.name);
 425
 426         ucontrol->value.enumerated.item[0] = wm8994->drc_cfg[drc];
 427
 428         return 0;
 429 }
 430
 431 static void wm8994_set_retune_mobile(struct snd_soc_codec *codec, int block)
 432 {
 433         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 434         struct wm8994_pdata *pdata = wm8994->pdata;
 435         int base = wm8994_retune_mobile_base[block];
 436         int iface, best, best_val, save, i, cfg;
 437
 438         if (!pdata || !wm8994->num_retune_mobile_texts)
 439                 return;
 440
 441         switch (block) {
 442         case 0:
 443         case 1:
 444                 iface = 0;
 445                 break;
 446         case 2:
 447                 iface = 1;
 448                 break;
 449         default:
 450                 return;
 451         }
 452
 453         /* Find the version of the currently selected configuration
 454          * with the nearest sample rate. */
 455         cfg = wm8994->retune_mobile_cfg[block];
 456         best = 0;
 457         best_val = INT_MAX;
 458         for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
 459                 if (strcmp(pdata->retune_mobile_cfgs[i].name,
 460                            wm8994->retune_mobile_texts[cfg]) == 0 &&
 461                     abs(pdata->retune_mobile_cfgs[i].rate
 462                         - wm8994->dac_rates[iface]) < best_val) {
 463                         best = i;
 464                         best_val = abs(pdata->retune_mobile_cfgs[i].rate
 465                                        - wm8994->dac_rates[iface]);
 466                 }
 467         }
 468
 469         dev_dbg(codec->dev, "ReTune Mobile %d %s/%dHz for %dHz sample rate\n",
 470                 block,
 471                 pdata->retune_mobile_cfgs[best].name,
 472                 pdata->retune_mobile_cfgs[best].rate,
 473                 wm8994->dac_rates[iface]);
 474
 475         /* The EQ will be disabled while reconfiguring it, remember the
 476          * current configuration.
 477          */
 478         save = snd_soc_read(codec, base);
 479         save &= WM8994_AIF1DAC1_EQ_ENA;
 480
 481         for (i = 0; i < WM8994_EQ_REGS; i++)
 482                 snd_soc_update_bits(codec, base + i, 0xffff,
 483                                 pdata->retune_mobile_cfgs[best].regs[i]);
 484
 485         snd_soc_update_bits(codec, base, WM8994_AIF1DAC1_EQ_ENA, save);
 486 }
 487
 488 /* Icky as hell but saves code duplication */
 489 static int wm8994_get_retune_mobile_block(const char *name)
 490 {
 491         if (strcmp(name, "AIF1.1 EQ Mode") == 0)
 492                 return 0;
 493         if (strcmp(name, "AIF1.2 EQ Mode") == 0)
 494                 return 1;
 495         if (strcmp(name, "AIF2 EQ Mode") == 0)
 496                 return 2;
 497         return -EINVAL;
 498 }
 499
 500 static int wm8994_put_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 501                                          struct snd_ctl_elem_value *ucontrol)
 502 {
 503         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 504         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 505         struct wm8994_pdata *pdata = wm8994->pdata;
 506         int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 507         int value = ucontrol->value.integer.value[0];
 508
 509         if (block < 0)
 510                 return block;
 511
 512         if (value >= pdata->num_retune_mobile_cfgs)
 513                 return -EINVAL;
 514
 515         wm8994->retune_mobile_cfg[block] = value;
 516
 517         wm8994_set_retune_mobile(codec, block);
 518
 519         return 0;
 520 }
 521
 522 static int wm8994_get_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 523                                          struct snd_ctl_elem_value *ucontrol)
 524 {
 525         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 526         struct wm8994_priv *wm8994 =snd_soc_codec_get_drvdata(codec);
 527         int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 528
 529         ucontrol->value.enumerated.item[0] = wm8994->retune_mobile_cfg[block];
 530
 531         return 0;
 532 }
 533
 534 static const char *aif_chan_src_text[] = {
 535         "Left", "Right"
 536 };
 537
 538 static const struct soc_enum aif1adcl_src =
 539         SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_1, 15, 2, aif_chan_src_text);
 540
 541 static const struct soc_enum aif1adcr_src =
 542         SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_1, 14, 2, aif_chan_src_text);
 543
 544 static const struct soc_enum aif2adcl_src =
 545         SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_1, 15, 2, aif_chan_src_text);
 546
 547 static const struct soc_enum aif2adcr_src =
 548         SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_1, 14, 2, aif_chan_src_text);
 549
 550 static const struct soc_enum aif1dacl_src =
 551         SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_2, 15, 2, aif_chan_src_text);
 552
 553 static const struct soc_enum aif1dacr_src =
 554         SOC_ENUM_SINGLE(WM8994_AIF1_CONTROL_2, 14, 2, aif_chan_src_text);
 555
 556 static const struct soc_enum aif2dacl_src =
 557         SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_2, 15, 2, aif_chan_src_text);
 558
 559 static const struct soc_enum aif2dacr_src =
 560         SOC_ENUM_SINGLE(WM8994_AIF2_CONTROL_2, 14, 2, aif_chan_src_text);
 561
 562 static const char *osr_text[] = {
 563         "Low Power", "High Performance",
 564 };
 565
 566 static const struct soc_enum dac_osr =
 567         SOC_ENUM_SINGLE(WM8994_OVERSAMPLING, 0, 2, osr_text);
 568
 569 static const struct soc_enum adc_osr =
 570         SOC_ENUM_SINGLE(WM8994_OVERSAMPLING, 1, 2, osr_text);
 571
 572 static void wm8958_mbc_apply(struct snd_soc_codec *codec, int mbc, int start)
 573 {
 574         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 575         struct wm8994_pdata *pdata = wm8994->pdata;
 576         int pwr_reg = snd_soc_read(codec, WM8994_POWER_MANAGEMENT_5);
 577         int ena, reg, aif, i;
 578
 579         switch (mbc) {
 580         case 0:
 581                 pwr_reg &= (WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA);
 582                 aif = 0;
 583                 break;
 584         case 1:
 585                 pwr_reg &= (WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA);
 586                 aif = 0;
 587                 break;
 588         case 2:
 589                 pwr_reg &= (WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA);
 590                 aif = 1;
 591                 break;
 592         default:
 593                 BUG();
 594                 return;
 595         }
 596
 597         /* We can only enable the MBC if the AIF is enabled and we
 598          * want it to be enabled. */
 599         ena = pwr_reg && wm8994->mbc_ena[mbc];
 600
 601         reg = snd_soc_read(codec, WM8958_DSP2_PROGRAM);
 602
 603         dev_dbg(codec->dev, "MBC %d startup: %d, power: %x, DSP: %x\n",
 604                 mbc, start, pwr_reg, reg);
 605
 606         if (start && ena) {
 607                 /* If the DSP is already running then noop */
 608                 if (reg & WM8958_DSP2_ENA)
 609                         return;
 610
 611                 /* Switch the clock over to the appropriate AIF */
 612                 snd_soc_update_bits(codec, WM8994_CLOCKING_1,
 613                                     WM8958_DSP2CLK_SRC | WM8958_DSP2CLK_ENA,
 614                                     aif << WM8958_DSP2CLK_SRC_SHIFT |
 615                                     WM8958_DSP2CLK_ENA);
 616
 617                 snd_soc_update_bits(codec, WM8958_DSP2_PROGRAM,
 618                                     WM8958_DSP2_ENA, WM8958_DSP2_ENA);
 619
 620                 /* If we've got user supplied MBC settings use them */
 621                 if (pdata && pdata->num_mbc_cfgs) {
 622                         struct wm8958_mbc_cfg *cfg
 623                                 = &pdata->mbc_cfgs[wm8994->mbc_cfg];
 624
 625                         for (i = 0; i < ARRAY_SIZE(cfg->coeff_regs); i++)
 626                                 snd_soc_write(codec, i + WM8958_MBC_BAND_1_K_1,
 627                                               cfg->coeff_regs[i]);
 628
 629                         for (i = 0; i < ARRAY_SIZE(cfg->cutoff_regs); i++)
 630                                 snd_soc_write(codec,
 631                                               i + WM8958_MBC_BAND_2_LOWER_CUTOFF_C1_1,
 632                                               cfg->cutoff_regs[i]);
 633                 }
 634
 635                 /* Run the DSP */
 636                 snd_soc_write(codec, WM8958_DSP2_EXECCONTROL,
 637                               WM8958_DSP2_RUNR);
 638
 639                 /* And we're off! */
 640                 snd_soc_update_bits(codec, WM8958_DSP2_CONFIG,
 641                                     WM8958_MBC_ENA | WM8958_MBC_SEL_MASK,
 642                                     mbc << WM8958_MBC_SEL_SHIFT |
 643                                     WM8958_MBC_ENA);
 644         } else {
 645                 /* If the DSP is already stopped then noop */
 646                 if (!(reg & WM8958_DSP2_ENA))
 647                         return;
 648
 649                 snd_soc_update_bits(codec, WM8958_DSP2_CONFIG,
 650                                     WM8958_MBC_ENA, 0);
 651                 snd_soc_update_bits(codec, WM8958_DSP2_PROGRAM,
 652                                     WM8958_DSP2_ENA, 0);
 653                 snd_soc_update_bits(codec, WM8994_CLOCKING_1,
 654                                     WM8958_DSP2CLK_ENA, 0);
 655         }
 656 }
 657
 658 static int wm8958_aif_ev(struct snd_soc_dapm_widget *w,
 659                     struct snd_kcontrol *kcontrol, int event)
 660 {
 661         struct snd_soc_codec *codec = w->codec;
 662         int mbc;
 663
 664         switch (w->shift) {
 665         case 13:
 666         case 12:
 667                 mbc = 2;
 668                 break;
 669         case 11:
 670         case 10:
 671                 mbc = 1;
 672                 break;
 673         case 9:
 674         case 8:
 675                 mbc = 0;
 676                 break;
 677         default:
 678                 BUG();
 679                 return -EINVAL;
 680         }
 681
 682         switch (event) {
 683         case SND_SOC_DAPM_POST_PMU:
 684                 wm8958_mbc_apply(codec, mbc, 1);
 685                 break;
 686         case SND_SOC_DAPM_POST_PMD:
 687                 wm8958_mbc_apply(codec, mbc, 0);
 688                 break;
 689         }
 690
 691         return 0;
 692 }
 693
 694 static int wm8958_put_mbc_enum(struct snd_kcontrol *kcontrol,
 695                                struct snd_ctl_elem_value *ucontrol)
 696 {
 697         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 698         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 699         struct wm8994_pdata *pdata = wm8994->pdata;
 700         int value = ucontrol->value.integer.value[0];
 701         int reg;
 702
 703         /* Don't allow on the fly reconfiguration */
 704         reg = snd_soc_read(codec, WM8994_CLOCKING_1);
 705         if (reg < 0 || reg & WM8958_DSP2CLK_ENA)
 706                 return -EBUSY;
 707
 708         if (value >= pdata->num_mbc_cfgs)
 709                 return -EINVAL;
 710
 711         wm8994->mbc_cfg = value;
 712
 713         return 0;
 714 }
 715
 716 static int wm8958_get_mbc_enum(struct snd_kcontrol *kcontrol,
 717                                struct snd_ctl_elem_value *ucontrol)
 718 {
 719         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 720         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 721
 722         ucontrol->value.enumerated.item[0] = wm8994->mbc_cfg;
 723
 724         return 0;
 725 }
 726
 727 static int wm8958_mbc_info(struct snd_kcontrol *kcontrol,
 728                            struct snd_ctl_elem_info *uinfo)
 729 {
 730         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
 731         uinfo->count = 1;
 732         uinfo->value.integer.min = 0;
 733         uinfo->value.integer.max = 1;
 734         return 0;
 735 }
 736
 737 static int wm8958_mbc_get(struct snd_kcontrol *kcontrol,
 738                           struct snd_ctl_elem_value *ucontrol)
 739 {
 740         int mbc = kcontrol->private_value;
 741         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 742         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 743
 744         ucontrol->value.integer.value[0] = wm8994->mbc_ena[mbc];
 745
 746         return 0;
 747 }
 748
 749 static int wm8958_mbc_put(struct snd_kcontrol *kcontrol,
 750                           struct snd_ctl_elem_value *ucontrol)
 751 {
 752         int mbc = kcontrol->private_value;
 753         int i;
 754         struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 755         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 756
 757         if (ucontrol->value.integer.value[0] > 1)
 758                 return -EINVAL;
 759
 760         for (i = 0; i < ARRAY_SIZE(wm8994->mbc_ena); i++) {
 761                 if (mbc != i && wm8994->mbc_ena[i]) {
 762                         dev_dbg(codec->dev, "MBC %d active already\n", mbc);
 763                         return -EBUSY;
 764                 }
 765         }
 766
 767         wm8994->mbc_ena[mbc] = ucontrol->value.integer.value[0];
 768
 769         wm8958_mbc_apply(codec, mbc, wm8994->mbc_ena[mbc]);
 770
 771         return 0;
 772 }
 773
 774 #define WM8958_MBC_SWITCH(xname, xval) {\
 775         .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname), \
 776         .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,\
 777         .info = wm8958_mbc_info, \
 778         .get = wm8958_mbc_get, .put = wm8958_mbc_put, \
 779         .private_value = xval }
 780
 781 static const struct snd_kcontrol_new wm8994_snd_controls[] = {
 782 SOC_DOUBLE_R_TLV("AIF1ADC1 Volume", WM8994_AIF1_ADC1_LEFT_VOLUME,
 783                  WM8994_AIF1_ADC1_RIGHT_VOLUME,
 784                  1, 119, 0, digital_tlv),
 785 SOC_DOUBLE_R_TLV("AIF1ADC2 Volume", WM8994_AIF1_ADC2_LEFT_VOLUME,
 786                  WM8994_AIF1_ADC2_RIGHT_VOLUME,
 787                  1, 119, 0, digital_tlv),
 788 SOC_DOUBLE_R_TLV("AIF2ADC Volume", WM8994_AIF2_ADC_LEFT_VOLUME,
 789                  WM8994_AIF2_ADC_RIGHT_VOLUME,
 790                  1, 119, 0, digital_tlv),
 791
 792 SOC_ENUM("AIF1ADCL Source", aif1adcl_src),
 793 SOC_ENUM("AIF1ADCR Source", aif1adcr_src),
 794 SOC_ENUM("AIF2ADCL Source", aif2adcl_src),
 795 SOC_ENUM("AIF2ADCR Source", aif2adcr_src),
 796
 797 SOC_ENUM("AIF1DACL Source", aif1dacl_src),
 798 SOC_ENUM("AIF1DACR Source", aif1dacr_src),
 799 SOC_ENUM("AIF2DACL Source", aif2dacl_src),
 800 SOC_ENUM("AIF2DACR Source", aif2dacr_src),
 801
 802 SOC_DOUBLE_R_TLV("AIF1DAC1 Volume", WM8994_AIF1_DAC1_LEFT_VOLUME,
 803                  WM8994_AIF1_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 804 SOC_DOUBLE_R_TLV("AIF1DAC2 Volume", WM8994_AIF1_DAC2_LEFT_VOLUME,
 805                  WM8994_AIF1_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 806 SOC_DOUBLE_R_TLV("AIF2DAC Volume", WM8994_AIF2_DAC_LEFT_VOLUME,
 807                  WM8994_AIF2_DAC_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 808
 809 SOC_SINGLE_TLV("AIF1 Boost Volume", WM8994_AIF1_CONTROL_2, 10, 3, 0, aif_tlv),
 810 SOC_SINGLE_TLV("AIF2 Boost Volume", WM8994_AIF2_CONTROL_2, 10, 3, 0, aif_tlv),
 811
 812 SOC_SINGLE("AIF1DAC1 EQ Switch", WM8994_AIF1_DAC1_EQ_GAINS_1, 0, 1, 0),
 813 SOC_SINGLE("AIF1DAC2 EQ Switch", WM8994_AIF1_DAC2_EQ_GAINS_1, 0, 1, 0),
 814 SOC_SINGLE("AIF2 EQ Switch", WM8994_AIF2_EQ_GAINS_1, 0, 1, 0),
 815
 816 WM8994_DRC_SWITCH("AIF1DAC1 DRC Switch", WM8994_AIF1_DRC1_1, 2),
 817 WM8994_DRC_SWITCH("AIF1ADC1L DRC Switch", WM8994_AIF1_DRC1_1, 1),
 818 WM8994_DRC_SWITCH("AIF1ADC1R DRC Switch", WM8994_AIF1_DRC1_1, 0),
 819
 820 WM8994_DRC_SWITCH("AIF1DAC2 DRC Switch", WM8994_AIF1_DRC2_1, 2),
 821 WM8994_DRC_SWITCH("AIF1ADC2L DRC Switch", WM8994_AIF1_DRC2_1, 1),
 822 WM8994_DRC_SWITCH("AIF1ADC2R DRC Switch", WM8994_AIF1_DRC2_1, 0),
 823
 824 WM8994_DRC_SWITCH("AIF2DAC DRC Switch", WM8994_AIF2_DRC_1, 2),
 825 WM8994_DRC_SWITCH("AIF2ADCL DRC Switch", WM8994_AIF2_DRC_1, 1),
 826 WM8994_DRC_SWITCH("AIF2ADCR DRC Switch", WM8994_AIF2_DRC_1, 0),
 827
 828 SOC_SINGLE_TLV("DAC1 Right Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 829                5, 12, 0, st_tlv),
 830 SOC_SINGLE_TLV("DAC1 Left Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 831                0, 12, 0, st_tlv),
 832 SOC_SINGLE_TLV("DAC2 Right Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 833                5, 12, 0, st_tlv),
 834 SOC_SINGLE_TLV("DAC2 Left Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 835                0, 12, 0, st_tlv),
 836 SOC_ENUM("Sidetone HPF Mux", sidetone_hpf),
 837 SOC_SINGLE("Sidetone HPF Switch", WM8994_SIDETONE, 6, 1, 0),
 838
 839 SOC_ENUM("AIF1ADC1 HPF Mode", aif1adc1_hpf),
 840 SOC_DOUBLE("AIF1ADC1 HPF Switch", WM8994_AIF1_ADC1_FILTERS, 12, 11, 1, 0),
 841
 842 SOC_ENUM("AIF1ADC2 HPF Mode", aif1adc2_hpf),
 843 SOC_DOUBLE("AIF1ADC2 HPF Switch", WM8994_AIF1_ADC2_FILTERS, 12, 11, 1, 0),
 844
 845 SOC_ENUM("AIF2ADC HPF Mode", aif2adc_hpf),
 846 SOC_DOUBLE("AIF2ADC HPF Switch", WM8994_AIF2_ADC_FILTERS, 12, 11, 1, 0),
 847
 848 SOC_ENUM("ADC OSR", adc_osr),
 849 SOC_ENUM("DAC OSR", dac_osr),
 850
 851 SOC_DOUBLE_R_TLV("DAC1 Volume", WM8994_DAC1_LEFT_VOLUME,
 852                  WM8994_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 853 SOC_DOUBLE_R("DAC1 Switch", WM8994_DAC1_LEFT_VOLUME,
 854              WM8994_DAC1_RIGHT_VOLUME, 9, 1, 1),
 855
 856 SOC_DOUBLE_R_TLV("DAC2 Volume", WM8994_DAC2_LEFT_VOLUME,
 857                  WM8994_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 858 SOC_DOUBLE_R("DAC2 Switch", WM8994_DAC2_LEFT_VOLUME,
 859              WM8994_DAC2_RIGHT_VOLUME, 9, 1, 1),
 860
 861 SOC_SINGLE_TLV("SPKL DAC2 Volume", WM8994_SPKMIXL_ATTENUATION,
 862                6, 1, 1, wm_hubs_spkmix_tlv),
 863 SOC_SINGLE_TLV("SPKL DAC1 Volume", WM8994_SPKMIXL_ATTENUATION,
 864                2, 1, 1, wm_hubs_spkmix_tlv),
 865
 866 SOC_SINGLE_TLV("SPKR DAC2 Volume", WM8994_SPKMIXR_ATTENUATION,
 867                6, 1, 1, wm_hubs_spkmix_tlv),
 868 SOC_SINGLE_TLV("SPKR DAC1 Volume", WM8994_SPKMIXR_ATTENUATION,
 869                2, 1, 1, wm_hubs_spkmix_tlv),
 870
 871 SOC_SINGLE_TLV("AIF1DAC1 3D Stereo Volume", WM8994_AIF1_DAC1_FILTERS_2,
 872                10, 15, 0, wm8994_3d_tlv),
 873 SOC_SINGLE("AIF1DAC1 3D Stereo Switch", WM8994_AIF1_DAC1_FILTERS_2,
 874            8, 1, 0),
 875 SOC_SINGLE_TLV("AIF1DAC2 3D Stereo Volume", WM8994_AIF1_DAC2_FILTERS_2,
 876                10, 15, 0, wm8994_3d_tlv),
 877 SOC_SINGLE("AIF1DAC2 3D Stereo Switch", WM8994_AIF1_DAC2_FILTERS_2,
 878            8, 1, 0),
 879 SOC_SINGLE_TLV("AIF2DAC 3D Stereo Volume", WM8994_AIF2_DAC_FILTERS_2,
 880                10, 15, 0, wm8994_3d_tlv),
 881 SOC_SINGLE("AIF2DAC 3D Stereo Switch", WM8994_AIF2_DAC_FILTERS_2,
 882            8, 1, 0),
 883 };
 884
 885 static const struct snd_kcontrol_new wm8994_eq_controls[] = {
 886 SOC_SINGLE_TLV("AIF1DAC1 EQ1 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 11, 31, 0,
 887                eq_tlv),
 888 SOC_SINGLE_TLV("AIF1DAC1 EQ2 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 6, 31, 0,
 889                eq_tlv),
 890 SOC_SINGLE_TLV("AIF1DAC1 EQ3 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 1, 31, 0,
 891                eq_tlv),
 892 SOC_SINGLE_TLV("AIF1DAC1 EQ4 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 11, 31, 0,
 893                eq_tlv),
 894 SOC_SINGLE_TLV("AIF1DAC1 EQ5 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 6, 31, 0,
 895                eq_tlv),
 896
 897 SOC_SINGLE_TLV("AIF1DAC2 EQ1 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 11, 31, 0,
 898                eq_tlv),
 899 SOC_SINGLE_TLV("AIF1DAC2 EQ2 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 6, 31, 0,
 900                eq_tlv),
 901 SOC_SINGLE_TLV("AIF1DAC2 EQ3 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 1, 31, 0,
 902                eq_tlv),
 903 SOC_SINGLE_TLV("AIF1DAC2 EQ4 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 11, 31, 0,
 904                eq_tlv),
 905 SOC_SINGLE_TLV("AIF1DAC2 EQ5 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 6, 31, 0,
 906                eq_tlv),
 907
 908 SOC_SINGLE_TLV("AIF2 EQ1 Volume", WM8994_AIF2_EQ_GAINS_1, 11, 31, 0,
 909                eq_tlv),
 910 SOC_SINGLE_TLV("AIF2 EQ2 Volume", WM8994_AIF2_EQ_GAINS_1, 6, 31, 0,
 911                eq_tlv),
 912 SOC_SINGLE_TLV("AIF2 EQ3 Volume", WM8994_AIF2_EQ_GAINS_1, 1, 31, 0,
 913                eq_tlv),
 914 SOC_SINGLE_TLV("AIF2 EQ4 Volume", WM8994_AIF2_EQ_GAINS_2, 11, 31, 0,
 915                eq_tlv),
 916 SOC_SINGLE_TLV("AIF2 EQ5 Volume", WM8994_AIF2_EQ_GAINS_2, 6, 31, 0,
 917                eq_tlv),
 918 };
 919
 920 static const struct snd_kcontrol_new wm8958_snd_controls[] = {
 921 SOC_SINGLE_TLV("AIF3 Boost Volume", WM8958_AIF3_CONTROL_2, 10, 3, 0, aif_tlv),
 922 WM8958_MBC_SWITCH("AIF1DAC1 MBC Switch", 0),
 923 WM8958_MBC_SWITCH("AIF1DAC2 MBC Switch", 1),
 924 WM8958_MBC_SWITCH("AIF2DAC MBC Switch", 2),
 925 };
 926
 927 static int clk_sys_event(struct snd_soc_dapm_widget *w,
 928                          struct snd_kcontrol *kcontrol, int event)
 929 {
 930         struct snd_soc_codec *codec = w->codec;
 931
 932         switch (event) {
 933         case SND_SOC_DAPM_PRE_PMU:
 934                 return configure_clock(codec);
 935
 936         case SND_SOC_DAPM_POST_PMD:
 937                 configure_clock(codec);
 938                 break;
 939         }
 940
 941         return 0;
 942 }
 943
 944 static void wm8994_update_class_w(struct snd_soc_codec *codec)
 945 {
 946         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
 947         int enable = 1;
 948         int source = 0;  /* GCC flow analysis can't track enable */
 949         int reg, reg_r;
 950
 951         /* Only support direct DAC->headphone paths */
 952         reg = snd_soc_read(codec, WM8994_OUTPUT_MIXER_1);
 953         if (!(reg & WM8994_DAC1L_TO_HPOUT1L)) {
 954                 dev_vdbg(codec->dev, "HPL connected to output mixer\n");
 955                 enable = 0;
 956         }
 957
 958         reg = snd_soc_read(codec, WM8994_OUTPUT_MIXER_2);
 959         if (!(reg & WM8994_DAC1R_TO_HPOUT1R)) {
 960                 dev_vdbg(codec->dev, "HPR connected to output mixer\n");
 961                 enable = 0;
 962         }
 963
 964         /* We also need the same setting for L/R and only one path */
 965         reg = snd_soc_read(codec, WM8994_DAC1_LEFT_MIXER_ROUTING);
 966         switch (reg) {
 967         case WM8994_AIF2DACL_TO_DAC1L:
 968                 dev_vdbg(codec->dev, "Class W source AIF2DAC\n");
 969                 source = 2 << WM8994_CP_DYN_SRC_SEL_SHIFT;
 970                 break;
 971         case WM8994_AIF1DAC2L_TO_DAC1L:
 972                 dev_vdbg(codec->dev, "Class W source AIF1DAC2\n");
 973                 source = 1 << WM8994_CP_DYN_SRC_SEL_SHIFT;
 974                 break;
 975         case WM8994_AIF1DAC1L_TO_DAC1L:
 976                 dev_vdbg(codec->dev, "Class W source AIF1DAC1\n");
 977                 source = 0 << WM8994_CP_DYN_SRC_SEL_SHIFT;
 978                 break;
 979         default:
 980                 dev_vdbg(codec->dev, "DAC mixer setting: %x\n", reg);
 981                 enable = 0;
 982                 break;
 983         }
 984
 985         reg_r = snd_soc_read(codec, WM8994_DAC1_RIGHT_MIXER_ROUTING);
 986         if (reg_r != reg) {
 987                 dev_vdbg(codec->dev, "Left and right DAC mixers different\n");
 988                 enable = 0;
 989         }
 990
 991         if (enable) {
 992                 dev_dbg(codec->dev, "Class W enabled\n");
 993                 snd_soc_update_bits(codec, WM8994_CLASS_W_1,
 994                                     WM8994_CP_DYN_PWR |
 995                                     WM8994_CP_DYN_SRC_SEL_MASK,
 996                                     source | WM8994_CP_DYN_PWR);
 997                 wm8994->hubs.class_w = true;
 998
 999         } else {
1000                 dev_dbg(codec->dev, "Class W disabled\n");
1001                 snd_soc_update_bits(codec, WM8994_CLASS_W_1,
1002                                     WM8994_CP_DYN_PWR, 0);
1003                 wm8994->hubs.class_w = false;
1004         }
1005 }
1006
1007 static const char *hp_mux_text[] = {
1008         "Mixer",
1009         "DAC",
1010 };
1011
1012 #define WM8994_HP_ENUM(xname, xenum) \
1013 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
1014         .info = snd_soc_info_enum_double, \
1015         .get = snd_soc_dapm_get_enum_double, \
1016         .put = wm8994_put_hp_enum, \
1017         .private_value = (unsigned long)&xenum }
1018
1019 static int wm8994_put_hp_enum(struct snd_kcontrol *kcontrol,
1020                               struct snd_ctl_elem_value *ucontrol)
1021 {
1022         struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
1023         struct snd_soc_codec *codec = w->codec;
1024         int ret;
1025
1026         ret = snd_soc_dapm_put_enum_double(kcontrol, ucontrol);
1027
1028         wm8994_update_class_w(codec);
1029
1030         return ret;
1031 }
1032
1033 static const struct soc_enum hpl_enum =
1034         SOC_ENUM_SINGLE(WM8994_OUTPUT_MIXER_1, 8, 2, hp_mux_text);
1035
1036 static const struct snd_kcontrol_new hpl_mux =
1037         WM8994_HP_ENUM("Left Headphone Mux", hpl_enum);
1038
1039 static const struct soc_enum hpr_enum =
1040         SOC_ENUM_SINGLE(WM8994_OUTPUT_MIXER_2, 8, 2, hp_mux_text);
1041
1042 static const struct snd_kcontrol_new hpr_mux =
1043         WM8994_HP_ENUM("Right Headphone Mux", hpr_enum);
1044
1045 static const char *adc_mux_text[] = {
1046         "ADC",
1047         "DMIC",
1048 };
1049
1050 static const struct soc_enum adc_enum =
1051         SOC_ENUM_SINGLE(0, 0, 2, adc_mux_text);
1052
1053 static const struct snd_kcontrol_new adcl_mux =
1054         SOC_DAPM_ENUM_VIRT("ADCL Mux", adc_enum);
1055
1056 static const struct snd_kcontrol_new adcr_mux =
1057         SOC_DAPM_ENUM_VIRT("ADCR Mux", adc_enum);
1058
1059 static const struct snd_kcontrol_new left_speaker_mixer[] = {
1060 SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 9, 1, 0),
1061 SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 7, 1, 0),
1062 SOC_DAPM_SINGLE("IN1LP Switch", WM8994_SPEAKER_MIXER, 5, 1, 0),
1063 SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 3, 1, 0),
1064 SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 1, 1, 0),
1065 };
1066
1067 static const struct snd_kcontrol_new right_speaker_mixer[] = {
1068 SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 8, 1, 0),
1069 SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 6, 1, 0),
1070 SOC_DAPM_SINGLE("IN1RP Switch", WM8994_SPEAKER_MIXER, 4, 1, 0),
1071 SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 2, 1, 0),
1072 SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 0, 1, 0),
1073 };
1074
1075 /* Debugging; dump chip status after DAPM transitions */
1076 static int post_ev(struct snd_soc_dapm_widget *w,
1077             struct snd_kcontrol *kcontrol, int event)
1078 {
1079         struct snd_soc_codec *codec = w->codec;
1080         dev_dbg(codec->dev, "SRC status: %x\n",
1081                 snd_soc_read(codec,
1082                              WM8994_RATE_STATUS));
1083         return 0;
1084 }
1085
1086 static const struct snd_kcontrol_new aif1adc1l_mix[] = {
1087 SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1088                 1, 1, 0),
1089 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1090                 0, 1, 0),
1091 };
1092
1093 static const struct snd_kcontrol_new aif1adc1r_mix[] = {
1094 SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1095                 1, 1, 0),
1096 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1097                 0, 1, 0),
1098 };
1099
1100 static const struct snd_kcontrol_new aif1adc2l_mix[] = {
1101 SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1102                 1, 1, 0),
1103 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1104                 0, 1, 0),
1105 };
1106
1107 static const struct snd_kcontrol_new aif1adc2r_mix[] = {
1108 SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1109                 1, 1, 0),
1110 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1111                 0, 1, 0),
1112 };
1113
1114 static const struct snd_kcontrol_new aif2dac2l_mix[] = {
1115 SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1116                 5, 1, 0),
1117 SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1118                 4, 1, 0),
1119 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1120                 2, 1, 0),
1121 SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1122                 1, 1, 0),
1123 SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1124                 0, 1, 0),
1125 };
1126
1127 static const struct snd_kcontrol_new aif2dac2r_mix[] = {
1128 SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1129                 5, 1, 0),
1130 SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1131                 4, 1, 0),
1132 SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1133                 2, 1, 0),
1134 SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1135                 1, 1, 0),
1136 SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1137                 0, 1, 0),
1138 };
1139
1140 #define WM8994_CLASS_W_SWITCH(xname, reg, shift, max, invert) \
1141 {       .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, \
1142         .info = snd_soc_info_volsw, \
1143         .get = snd_soc_dapm_get_volsw, .put = wm8994_put_class_w, \
1144         .private_value =  SOC_SINGLE_VALUE(reg, shift, max, invert) }
1145
1146 static int wm8994_put_class_w(struct snd_kcontrol *kcontrol,
1147                               struct snd_ctl_elem_value *ucontrol)
1148 {
1149         struct snd_soc_dapm_widget *w = snd_kcontrol_chip(kcontrol);
1150         struct snd_soc_codec *codec = w->codec;
1151         int ret;
1152
1153         ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol);
1154
1155         wm8994_update_class_w(codec);
1156
1157         return ret;
1158 }
1159
1160 static const struct snd_kcontrol_new dac1l_mix[] = {
1161 WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1162                       5, 1, 0),
1163 WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1164                       4, 1, 0),
1165 WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1166                       2, 1, 0),
1167 WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1168                       1, 1, 0),
1169 WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1170                       0, 1, 0),
1171 };
1172
1173 static const struct snd_kcontrol_new dac1r_mix[] = {
1174 WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1175                       5, 1, 0),
1176 WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1177                       4, 1, 0),
1178 WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1179                       2, 1, 0),
1180 WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1181                       1, 1, 0),
1182 WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1183                       0, 1, 0),
1184 };
1185
1186 static const char *sidetone_text[] = {
1187         "ADC/DMIC1", "DMIC2",
1188 };
1189
1190 static const struct soc_enum sidetone1_enum =
1191         SOC_ENUM_SINGLE(WM8994_SIDETONE, 0, 2, sidetone_text);
1192
1193 static const struct snd_kcontrol_new sidetone1_mux =
1194         SOC_DAPM_ENUM("Left Sidetone Mux", sidetone1_enum);
1195
1196 static const struct soc_enum sidetone2_enum =
1197         SOC_ENUM_SINGLE(WM8994_SIDETONE, 1, 2, sidetone_text);
1198
1199 static const struct snd_kcontrol_new sidetone2_mux =
1200         SOC_DAPM_ENUM("Right Sidetone Mux", sidetone2_enum);
1201
1202 static const char *aif1dac_text[] = {
1203         "AIF1DACDAT", "AIF3DACDAT",
1204 };
1205
1206 static const struct soc_enum aif1dac_enum =
1207         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 0, 2, aif1dac_text);
1208
1209 static const struct snd_kcontrol_new aif1dac_mux =
1210         SOC_DAPM_ENUM("AIF1DAC Mux", aif1dac_enum);
1211
1212 static const char *aif2dac_text[] = {
1213         "AIF2DACDAT", "AIF3DACDAT",
1214 };
1215
1216 static const struct soc_enum aif2dac_enum =
1217         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 1, 2, aif2dac_text);
1218
1219 static const struct snd_kcontrol_new aif2dac_mux =
1220         SOC_DAPM_ENUM("AIF2DAC Mux", aif2dac_enum);
1221
1222 static const char *aif2adc_text[] = {
1223         "AIF2ADCDAT", "AIF3DACDAT",
1224 };
1225
1226 static const struct soc_enum aif2adc_enum =
1227         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 2, 2, aif2adc_text);
1228
1229 static const struct snd_kcontrol_new aif2adc_mux =
1230         SOC_DAPM_ENUM("AIF2ADC Mux", aif2adc_enum);
1231
1232 static const char *aif3adc_text[] = {
1233         "AIF1ADCDAT", "AIF2ADCDAT", "AIF2DACDAT", "Mono PCM",
1234 };
1235
1236 static const struct soc_enum wm8994_aif3adc_enum =
1237         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 3, 3, aif3adc_text);
1238
1239 static const struct snd_kcontrol_new wm8994_aif3adc_mux =
1240         SOC_DAPM_ENUM("AIF3ADC Mux", wm8994_aif3adc_enum);
1241
1242 static const struct soc_enum wm8958_aif3adc_enum =
1243         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 3, 4, aif3adc_text);
1244
1245 static const struct snd_kcontrol_new wm8958_aif3adc_mux =
1246         SOC_DAPM_ENUM("AIF3ADC Mux", wm8958_aif3adc_enum);
1247
1248 static const char *mono_pcm_out_text[] = {
1249         "None", "AIF2ADCL", "AIF2ADCR",
1250 };
1251
1252 static const struct soc_enum mono_pcm_out_enum =
1253         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 9, 3, mono_pcm_out_text);
1254
1255 static const struct snd_kcontrol_new mono_pcm_out_mux =
1256         SOC_DAPM_ENUM("Mono PCM Out Mux", mono_pcm_out_enum);
1257
1258 static const char *aif2dac_src_text[] = {
1259         "AIF2", "AIF3",
1260 };
1261
1262 /* Note that these two control shouldn't be simultaneously switched to AIF3 */
1263 static const struct soc_enum aif2dacl_src_enum =
1264         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 7, 2, aif2dac_src_text);
1265
1266 static const struct snd_kcontrol_new aif2dacl_src_mux =
1267         SOC_DAPM_ENUM("AIF2DACL Mux", aif2dacl_src_enum);
1268
1269 static const struct soc_enum aif2dacr_src_enum =
1270         SOC_ENUM_SINGLE(WM8994_POWER_MANAGEMENT_6, 8, 2, aif2dac_src_text);
1271
1272 static const struct snd_kcontrol_new aif2dacr_src_mux =
1273         SOC_DAPM_ENUM("AIF2DACR Mux", aif2dacr_src_enum);
1274
1275 static const struct snd_soc_dapm_widget wm8994_dapm_widgets[] = {
1276 SND_SOC_DAPM_INPUT("DMIC1DAT"),
1277 SND_SOC_DAPM_INPUT("DMIC2DAT"),
1278 SND_SOC_DAPM_INPUT("Clock"),
1279
1280 SND_SOC_DAPM_SUPPLY("CLK_SYS", SND_SOC_NOPM, 0, 0, clk_sys_event,
1281                     SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1282
1283 SND_SOC_DAPM_SUPPLY("DSP1CLK", WM8994_CLOCKING_1, 3, 0, NULL, 0),
1284 SND_SOC_DAPM_SUPPLY("DSP2CLK", WM8994_CLOCKING_1, 2, 0, NULL, 0),
1285 SND_SOC_DAPM_SUPPLY("DSPINTCLK", WM8994_CLOCKING_1, 1, 0, NULL, 0),
1286
1287 SND_SOC_DAPM_SUPPLY("AIF1CLK", WM8994_AIF1_CLOCKING_1, 0, 0, NULL, 0),
1288 SND_SOC_DAPM_SUPPLY("AIF2CLK", WM8994_AIF2_CLOCKING_1, 0, 0, NULL, 0),
1289
1290 SND_SOC_DAPM_AIF_OUT("AIF1ADC1L", NULL,
1291                      0, WM8994_POWER_MANAGEMENT_4, 9, 0),
1292 SND_SOC_DAPM_AIF_OUT("AIF1ADC1R", NULL,
1293                      0, WM8994_POWER_MANAGEMENT_4, 8, 0),
1294 SND_SOC_DAPM_AIF_IN_E("AIF1DAC1L", NULL, 0,
1295                       WM8994_POWER_MANAGEMENT_5, 9, 0, wm8958_aif_ev,
1296                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1297 SND_SOC_DAPM_AIF_IN_E("AIF1DAC1R", NULL, 0,
1298                       WM8994_POWER_MANAGEMENT_5, 8, 0, wm8958_aif_ev,
1299                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1300
1301 SND_SOC_DAPM_AIF_OUT("AIF1ADC2L", NULL,
1302                      0, WM8994_POWER_MANAGEMENT_4, 11, 0),
1303 SND_SOC_DAPM_AIF_OUT("AIF1ADC2R", NULL,
1304                      0, WM8994_POWER_MANAGEMENT_4, 10, 0),
1305 SND_SOC_DAPM_AIF_IN_E("AIF1DAC2L", NULL, 0,
1306                       WM8994_POWER_MANAGEMENT_5, 11, 0, wm8958_aif_ev,
1307                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1308 SND_SOC_DAPM_AIF_IN_E("AIF1DAC2R", NULL, 0,
1309                       WM8994_POWER_MANAGEMENT_5, 10, 0, wm8958_aif_ev,
1310                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1311
1312 SND_SOC_DAPM_MIXER("AIF1ADC1L Mixer", SND_SOC_NOPM, 0, 0,
1313                    aif1adc1l_mix, ARRAY_SIZE(aif1adc1l_mix)),
1314 SND_SOC_DAPM_MIXER("AIF1ADC1R Mixer", SND_SOC_NOPM, 0, 0,
1315                    aif1adc1r_mix, ARRAY_SIZE(aif1adc1r_mix)),
1316
1317 SND_SOC_DAPM_MIXER("AIF1ADC2L Mixer", SND_SOC_NOPM, 0, 0,
1318                    aif1adc2l_mix, ARRAY_SIZE(aif1adc2l_mix)),
1319 SND_SOC_DAPM_MIXER("AIF1ADC2R Mixer", SND_SOC_NOPM, 0, 0,
1320                    aif1adc2r_mix, ARRAY_SIZE(aif1adc2r_mix)),
1321
1322 SND_SOC_DAPM_MIXER("AIF2DAC2L Mixer", SND_SOC_NOPM, 0, 0,
1323                    aif2dac2l_mix, ARRAY_SIZE(aif2dac2l_mix)),
1324 SND_SOC_DAPM_MIXER("AIF2DAC2R Mixer", SND_SOC_NOPM, 0, 0,
1325                    aif2dac2r_mix, ARRAY_SIZE(aif2dac2r_mix)),
1326
1327 SND_SOC_DAPM_MUX("Left Sidetone", SND_SOC_NOPM, 0, 0, &sidetone1_mux),
1328 SND_SOC_DAPM_MUX("Right Sidetone", SND_SOC_NOPM, 0, 0, &sidetone2_mux),
1329
1330 SND_SOC_DAPM_MIXER("DAC1L Mixer", SND_SOC_NOPM, 0, 0,
1331                    dac1l_mix, ARRAY_SIZE(dac1l_mix)),
1332 SND_SOC_DAPM_MIXER("DAC1R Mixer", SND_SOC_NOPM, 0, 0,
1333                    dac1r_mix, ARRAY_SIZE(dac1r_mix)),
1334
1335 SND_SOC_DAPM_AIF_OUT("AIF2ADCL", NULL, 0,
1336                      WM8994_POWER_MANAGEMENT_4, 13, 0),
1337 SND_SOC_DAPM_AIF_OUT("AIF2ADCR", NULL, 0,
1338                      WM8994_POWER_MANAGEMENT_4, 12, 0),
1339 SND_SOC_DAPM_AIF_IN_E("AIF2DACL", NULL, 0,
1340                       WM8994_POWER_MANAGEMENT_5, 13, 0, wm8958_aif_ev,
1341                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1342 SND_SOC_DAPM_AIF_IN_E("AIF2DACR", NULL, 0,
1343                       WM8994_POWER_MANAGEMENT_5, 12, 0, wm8958_aif_ev,
1344                       SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1345
1346 SND_SOC_DAPM_AIF_IN("AIF1DACDAT", "AIF1 Playback", 0, SND_SOC_NOPM, 0, 0),
1347 SND_SOC_DAPM_AIF_IN("AIF2DACDAT", "AIF2 Playback", 0, SND_SOC_NOPM, 0, 0),
1348 SND_SOC_DAPM_AIF_OUT("AIF1ADCDAT", "AIF1 Capture", 0, SND_SOC_NOPM, 0, 0),
1349 SND_SOC_DAPM_AIF_OUT("AIF2ADCDAT", "AIF2 Capture", 0, SND_SOC_NOPM, 0, 0),
1350
1351 SND_SOC_DAPM_MUX("AIF1DAC Mux", SND_SOC_NOPM, 0, 0, &aif1dac_mux),
1352 SND_SOC_DAPM_MUX("AIF2DAC Mux", SND_SOC_NOPM, 0, 0, &aif2dac_mux),
1353 SND_SOC_DAPM_MUX("AIF2ADC Mux", SND_SOC_NOPM, 0, 0, &aif2adc_mux),
1354
1355 SND_SOC_DAPM_AIF_IN("AIF3DACDAT", "AIF3 Playback", 0, SND_SOC_NOPM, 0, 0),
1356 SND_SOC_DAPM_AIF_IN("AIF3ADCDAT", "AIF3 Capture", 0, SND_SOC_NOPM, 0, 0),
1357
1358 SND_SOC_DAPM_SUPPLY("TOCLK", WM8994_CLOCKING_1, 4, 0, NULL, 0),
1359
1360 SND_SOC_DAPM_ADC("DMIC2L", NULL, WM8994_POWER_MANAGEMENT_4, 5, 0),
1361 SND_SOC_DAPM_ADC("DMIC2R", NULL, WM8994_POWER_MANAGEMENT_4, 4, 0),
1362 SND_SOC_DAPM_ADC("DMIC1L", NULL, WM8994_POWER_MANAGEMENT_4, 3, 0),
1363 SND_SOC_DAPM_ADC("DMIC1R", NULL, WM8994_POWER_MANAGEMENT_4, 2, 0),
1364
1365 /* Power is done with the muxes since the ADC power also controls the
1366  * downsampling chain, the chip will automatically manage the analogue
1367  * specific portions.
1368  */
1369 SND_SOC_DAPM_ADC("ADCL", NULL, SND_SOC_NOPM, 1, 0),
1370 SND_SOC_DAPM_ADC("ADCR", NULL, SND_SOC_NOPM, 0, 0),
1371
1372 SND_SOC_DAPM_MUX("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux),
1373 SND_SOC_DAPM_MUX("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux),
1374
1375 SND_SOC_DAPM_DAC("DAC2L", NULL, WM8994_POWER_MANAGEMENT_5, 3, 0),
1376 SND_SOC_DAPM_DAC("DAC2R", NULL, WM8994_POWER_MANAGEMENT_5, 2, 0),
1377 SND_SOC_DAPM_DAC("DAC1L", NULL, WM8994_POWER_MANAGEMENT_5, 1, 0),
1378 SND_SOC_DAPM_DAC("DAC1R", NULL, WM8994_POWER_MANAGEMENT_5, 0, 0),
1379
1380 SND_SOC_DAPM_MUX("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &hpl_mux),
1381 SND_SOC_DAPM_MUX("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &hpr_mux),
1382
1383 SND_SOC_DAPM_MIXER("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0,
1384                    left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)),
1385 SND_SOC_DAPM_MIXER("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0,
1386                    right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)),
1387
1388 SND_SOC_DAPM_POST("Debug log", post_ev),
1389 };
1390
1391 static const struct snd_soc_dapm_widget wm8994_specific_dapm_widgets[] = {
1392 SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8994_aif3adc_mux),
1393 };
1394
1395 static const struct snd_soc_dapm_widget wm8958_dapm_widgets[] = {
1396 SND_SOC_DAPM_MUX("Mono PCM Out Mux", SND_SOC_NOPM, 0, 0, &mono_pcm_out_mux),
1397 SND_SOC_DAPM_MUX("AIF2DACL Mux", SND_SOC_NOPM, 0, 0, &aif2dacl_src_mux),
1398 SND_SOC_DAPM_MUX("AIF2DACR Mux", SND_SOC_NOPM, 0, 0, &aif2dacr_src_mux),
1399 SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8958_aif3adc_mux),
1400 };
1401
1402 static const struct snd_soc_dapm_route intercon[] = {
1403         { "CLK_SYS", NULL, "AIF1CLK", check_clk_sys },
1404         { "CLK_SYS", NULL, "AIF2CLK", check_clk_sys },
1405
1406         { "DSP1CLK", NULL, "CLK_SYS" },
1407         { "DSP2CLK", NULL, "CLK_SYS" },
1408         { "DSPINTCLK", NULL, "CLK_SYS" },
1409
1410         { "AIF1ADC1L", NULL, "AIF1CLK" },
1411         { "AIF1ADC1L", NULL, "DSP1CLK" },
1412         { "AIF1ADC1R", NULL, "AIF1CLK" },
1413         { "AIF1ADC1R", NULL, "DSP1CLK" },
1414         { "AIF1ADC1R", NULL, "DSPINTCLK" },
1415
1416         { "AIF1DAC1L", NULL, "AIF1CLK" },
1417         { "AIF1DAC1L", NULL, "DSP1CLK" },
1418         { "AIF1DAC1R", NULL, "AIF1CLK" },
1419         { "AIF1DAC1R", NULL, "DSP1CLK" },
1420         { "AIF1DAC1R", NULL, "DSPINTCLK" },
1421
1422         { "AIF1ADC2L", NULL, "AIF1CLK" },
1423         { "AIF1ADC2L", NULL, "DSP1CLK" },
1424         { "AIF1ADC2R", NULL, "AIF1CLK" },
1425         { "AIF1ADC2R", NULL, "DSP1CLK" },
1426         { "AIF1ADC2R", NULL, "DSPINTCLK" },
1427
1428         { "AIF1DAC2L", NULL, "AIF1CLK" },
1429         { "AIF1DAC2L", NULL, "DSP1CLK" },
1430         { "AIF1DAC2R", NULL, "AIF1CLK" },
1431         { "AIF1DAC2R", NULL, "DSP1CLK" },
1432         { "AIF1DAC2R", NULL, "DSPINTCLK" },
1433
1434         { "AIF2ADCL", NULL, "AIF2CLK" },
1435         { "AIF2ADCL", NULL, "DSP2CLK" },
1436         { "AIF2ADCR", NULL, "AIF2CLK" },
1437         { "AIF2ADCR", NULL, "DSP2CLK" },
1438         { "AIF2ADCR", NULL, "DSPINTCLK" },
1439
1440         { "AIF2DACL", NULL, "AIF2CLK" },
1441         { "AIF2DACL", NULL, "DSP2CLK" },
1442         { "AIF2DACR", NULL, "AIF2CLK" },
1443         { "AIF2DACR", NULL, "DSP2CLK" },
1444         { "AIF2DACR", NULL, "DSPINTCLK" },
1445
1446         { "DMIC1L", NULL, "DMIC1DAT" },
1447         { "DMIC1L", NULL, "CLK_SYS" },
1448         { "DMIC1R", NULL, "DMIC1DAT" },
1449         { "DMIC1R", NULL, "CLK_SYS" },
1450         { "DMIC2L", NULL, "DMIC2DAT" },
1451         { "DMIC2L", NULL, "CLK_SYS" },
1452         { "DMIC2R", NULL, "DMIC2DAT" },
1453         { "DMIC2R", NULL, "CLK_SYS" },
1454
1455         { "ADCL", NULL, "AIF1CLK" },
1456         { "ADCL", NULL, "DSP1CLK" },
1457         { "ADCL", NULL, "DSPINTCLK" },
1458
1459         { "ADCR", NULL, "AIF1CLK" },
1460         { "ADCR", NULL, "DSP1CLK" },
1461         { "ADCR", NULL, "DSPINTCLK" },
1462
1463         { "ADCL Mux", "ADC", "ADCL" },
1464         { "ADCL Mux", "DMIC", "DMIC1L" },
1465         { "ADCR Mux", "ADC", "ADCR" },
1466         { "ADCR Mux", "DMIC", "DMIC1R" },
1467
1468         { "DAC1L", NULL, "AIF1CLK" },
1469         { "DAC1L", NULL, "DSP1CLK" },
1470         { "DAC1L", NULL, "DSPINTCLK" },
1471
1472         { "DAC1R", NULL, "AIF1CLK" },
1473         { "DAC1R", NULL, "DSP1CLK" },
1474         { "DAC1R", NULL, "DSPINTCLK" },
1475
1476         { "DAC2L", NULL, "AIF2CLK" },
1477         { "DAC2L", NULL, "DSP2CLK" },
1478         { "DAC2L", NULL, "DSPINTCLK" },
1479
1480         { "DAC2R", NULL, "AIF2DACR" },
1481         { "DAC2R", NULL, "AIF2CLK" },
1482         { "DAC2R", NULL, "DSP2CLK" },
1483         { "DAC2R", NULL, "DSPINTCLK" },
1484
1485         { "TOCLK", NULL, "CLK_SYS" },
1486
1487         /* AIF1 outputs */
1488         { "AIF1ADC1L", NULL, "AIF1ADC1L Mixer" },
1489         { "AIF1ADC1L Mixer", "ADC/DMIC Switch", "ADCL Mux" },
1490         { "AIF1ADC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1491
1492         { "AIF1ADC1R", NULL, "AIF1ADC1R Mixer" },
1493         { "AIF1ADC1R Mixer", "ADC/DMIC Switch", "ADCR Mux" },
1494         { "AIF1ADC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1495
1496         { "AIF1ADC2L", NULL, "AIF1ADC2L Mixer" },
1497         { "AIF1ADC2L Mixer", "DMIC Switch", "DMIC2L" },
1498         { "AIF1ADC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1499
1500         { "AIF1ADC2R", NULL, "AIF1ADC2R Mixer" },
1501         { "AIF1ADC2R Mixer", "DMIC Switch", "DMIC2R" },
1502         { "AIF1ADC2R Mixer", "AIF2 Switch", "AIF2DACR" },
1503
1504         /* Pin level routing for AIF3 */
1505         { "AIF1DAC1L", NULL, "AIF1DAC Mux" },
1506         { "AIF1DAC1R", NULL, "AIF1DAC Mux" },
1507         { "AIF1DAC2L", NULL, "AIF1DAC Mux" },
1508         { "AIF1DAC2R", NULL, "AIF1DAC Mux" },
1509
1510         { "AIF1DAC Mux", "AIF1DACDAT", "AIF1DACDAT" },
1511         { "AIF1DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1512         { "AIF2DAC Mux", "AIF2DACDAT", "AIF2DACDAT" },
1513         { "AIF2DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1514         { "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCL" },
1515         { "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCR" },
1516         { "AIF2ADC Mux", "AIF3DACDAT", "AIF3ADCDAT" },
1517
1518         /* DAC1 inputs */
1519         { "DAC1L", NULL, "DAC1L Mixer" },
1520         { "DAC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1521         { "DAC1L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1522         { "DAC1L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
1523         { "DAC1L Mixer", "Left Sidetone Switch", "Left Sidetone" },
1524         { "DAC1L Mixer", "Right Sidetone Switch", "Right Sidetone" },
1525
1526         { "DAC1R", NULL, "DAC1R Mixer" },
1527         { "DAC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1528         { "DAC1R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
1529         { "DAC1R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
1530         { "DAC1R Mixer", "Left Sidetone Switch", "Left Sidetone" },
1531         { "DAC1R Mixer", "Right Sidetone Switch", "Right Sidetone" },
1532
1533         /* DAC2/AIF2 outputs  */
1534         { "AIF2ADCL", NULL, "AIF2DAC2L Mixer" },
1535         { "DAC2L", NULL, "AIF2DAC2L Mixer" },
1536         { "AIF2DAC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1537         { "AIF2DAC2L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1538         { "AIF2DAC2L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
1539         { "AIF2DAC2L Mixer", "Left Sidetone Switch", "Left Sidetone" },
1540         { "AIF2DAC2L Mixer", "Right Sidetone Switch", "Right Sidetone" },
1541
1542         { "AIF2ADCR", NULL, "AIF2DAC2R Mixer" },
1543         { "DAC2R", NULL, "AIF2DAC2R Mixer" },
1544         { "AIF2DAC2R Mixer", "AIF2 Switch", "AIF2DACR" },
1545         { "AIF2DAC2R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
1546         { "AIF2DAC2R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
1547         { "AIF2DAC2R Mixer", "Left Sidetone Switch", "Left Sidetone" },
1548         { "AIF2DAC2R Mixer", "Right Sidetone Switch", "Right Sidetone" },
1549
1550         { "AIF1ADCDAT", NULL, "AIF1ADC1L" },
1551         { "AIF1ADCDAT", NULL, "AIF1ADC1R" },
1552         { "AIF1ADCDAT", NULL, "AIF1ADC2L" },
1553         { "AIF1ADCDAT", NULL, "AIF1ADC2R" },
1554
1555         { "AIF2ADCDAT", NULL, "AIF2ADC Mux" },
1556
1557         /* AIF3 output */
1558         { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC1L" },
1559         { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC1R" },
1560         { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC2L" },
1561         { "AIF3ADCDAT", "AIF1ADCDAT", "AIF1ADC2R" },
1562         { "AIF3ADCDAT", "AIF2ADCDAT", "AIF2ADCL" },
1563         { "AIF3ADCDAT", "AIF2ADCDAT", "AIF2ADCR" },
1564         { "AIF3ADCDAT", "AIF2DACDAT", "AIF2DACL" },
1565         { "AIF3ADCDAT", "AIF2DACDAT", "AIF2DACR" },
1566
1567         /* Sidetone */
1568         { "Left Sidetone", "ADC/DMIC1", "ADCL Mux" },
1569         { "Left Sidetone", "DMIC2", "DMIC2L" },
1570         { "Right Sidetone", "ADC/DMIC1", "ADCR Mux" },
1571         { "Right Sidetone", "DMIC2", "DMIC2R" },
1572
1573         /* Output stages */
1574         { "Left Output Mixer", "DAC Switch", "DAC1L" },
1575         { "Right Output Mixer", "DAC Switch", "DAC1R" },
1576
1577         { "SPKL", "DAC1 Switch", "DAC1L" },
1578         { "SPKL", "DAC2 Switch", "DAC2L" },
1579
1580         { "SPKR", "DAC1 Switch", "DAC1R" },
1581         { "SPKR", "DAC2 Switch", "DAC2R" },
1582
1583         { "Left Headphone Mux", "DAC", "DAC1L" },
1584         { "Right Headphone Mux", "DAC", "DAC1R" },
1585 };
1586
1587 static const struct snd_soc_dapm_route wm8994_revd_intercon[] = {
1588         { "AIF1DACDAT", NULL, "AIF2DACDAT" },
1589         { "AIF2DACDAT", NULL, "AIF1DACDAT" },
1590         { "AIF1ADCDAT", NULL, "AIF2ADCDAT" },
1591         { "AIF2ADCDAT", NULL, "AIF1ADCDAT" },
1592 };
1593
1594 static const struct snd_soc_dapm_route wm8994_intercon[] = {
1595         { "AIF2DACL", NULL, "AIF2DAC Mux" },
1596         { "AIF2DACR", NULL, "AIF2DAC Mux" },
1597 };
1598
1599 static const struct snd_soc_dapm_route wm8958_intercon[] = {
1600         { "AIF2DACL", NULL, "AIF2DACL Mux" },
1601         { "AIF2DACR", NULL, "AIF2DACR Mux" },
1602
1603         { "AIF2DACL Mux", "AIF2", "AIF2DAC Mux" },
1604         { "AIF2DACL Mux", "AIF3", "AIF3DACDAT" },
1605         { "AIF2DACR Mux", "AIF2", "AIF2DAC Mux" },
1606         { "AIF2DACR Mux", "AIF3", "AIF3DACDAT" },
1607
1608         { "Mono PCM Out Mux", "AIF2ADCL", "AIF2ADCL" },
1609         { "Mono PCM Out Mux", "AIF2ADCR", "AIF2ADCR" },
1610
1611         { "AIF3ADC Mux", "Mono PCM", "Mono PCM Out Mux" },
1612 };
1613
1614 /* The size in bits of the FLL divide multiplied by 10
1615  * to allow rounding later */
1616 #define FIXED_FLL_SIZE ((1 << 16) * 10)
1617
1618 struct fll_div {
1619         u16 outdiv;
1620         u16 n;
1621         u16 k;
1622         u16 clk_ref_div;
1623         u16 fll_fratio;
1624 };
1625
1626 static int wm8994_get_fll_config(struct fll_div *fll,
1627                                  int freq_in, int freq_out)
1628 {
1629         u64 Kpart;
1630         unsigned int K, Ndiv, Nmod;
1631
1632         pr_debug("FLL input=%dHz, output=%dHz\n", freq_in, freq_out);
1633
1634         /* Scale the input frequency down to <= 13.5MHz */
1635         fll->clk_ref_div = 0;
1636         while (freq_in > 13500000) {
1637                 fll->clk_ref_div++;
1638                 freq_in /= 2;
1639
1640                 if (fll->clk_ref_div > 3)
1641                         return -EINVAL;
1642         }
1643         pr_debug("CLK_REF_DIV=%d, Fref=%dHz\n", fll->clk_ref_div, freq_in);
1644
1645         /* Scale the output to give 90MHz<=Fvco<=100MHz */
1646         fll->outdiv = 3;
1647         while (freq_out * (fll->outdiv + 1) < 90000000) {
1648                 fll->outdiv++;
1649                 if (fll->outdiv > 63)
1650                         return -EINVAL;
1651         }
1652         freq_out *= fll->outdiv + 1;
1653         pr_debug("OUTDIV=%d, Fvco=%dHz\n", fll->outdiv, freq_out);
1654
1655         if (freq_in > 1000000) {
1656                 fll->fll_fratio = 0;
1657         } else if (freq_in > 256000) {
1658                 fll->fll_fratio = 1;
1659                 freq_in *= 2;
1660         } else if (freq_in > 128000) {
1661                 fll->fll_fratio = 2;
1662                 freq_in *= 4;
1663         } else if (freq_in > 64000) {
1664                 fll->fll_fratio = 3;
1665                 freq_in *= 8;
1666         } else {
1667                 fll->fll_fratio = 4;
1668                 freq_in *= 16;
1669         }
1670         pr_debug("FLL_FRATIO=%d, Fref=%dHz\n", fll->fll_fratio, freq_in);
1671
1672         /* Now, calculate N.K */
1673         Ndiv = freq_out / freq_in;
1674
1675         fll->n = Ndiv;
1676         Nmod = freq_out % freq_in;
1677         pr_debug("Nmod=%d\n", Nmod);
1678
1679         /* Calculate fractional part - scale up so we can round. */
1680         Kpart = FIXED_FLL_SIZE * (long long)Nmod;
1681
1682         do_div(Kpart, freq_in);
1683
1684         K = Kpart & 0xFFFFFFFF;
1685
1686         if ((K % 10) >= 5)
1687                 K += 5;
1688
1689         /* Move down to proper range now rounding is done */
1690         fll->k = K / 10;
1691
1692         pr_debug("N=%x K=%x\n", fll->n, fll->k);
1693
1694         return 0;
1695 }
1696
1697 static int _wm8994_set_fll(struct snd_soc_codec *codec, int id, int src,
1698                           unsigned int freq_in, unsigned int freq_out)
1699 {
1700         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
1701         int reg_offset, ret;
1702         struct fll_div fll;
1703         u16 reg, aif1, aif2;
1704
1705         aif1 = snd_soc_read(codec, WM8994_AIF1_CLOCKING_1)
1706                 & WM8994_AIF1CLK_ENA;
1707
1708         aif2 = snd_soc_read(codec, WM8994_AIF2_CLOCKING_1)
1709                 & WM8994_AIF2CLK_ENA;
1710
1711         switch (id) {
1712         case WM8994_FLL1:
1713                 reg_offset = 0;
1714                 id = 0;
1715                 break;
1716         case WM8994_FLL2:
1717                 reg_offset = 0x20;
1718                 id = 1;
1719                 break;
1720         default:
1721                 return -EINVAL;
1722         }
1723
1724         switch (src) {
1725         case 0:
1726                 /* Allow no source specification when stopping */
1727                 if (freq_out)
1728                         return -EINVAL;
1729                 src = wm8994->fll[id].src;
1730                 break;
1731         case WM8994_FLL_SRC_MCLK1:
1732         case WM8994_FLL_SRC_MCLK2:
1733         case WM8994_FLL_SRC_LRCLK:
1734         case WM8994_FLL_SRC_BCLK:
1735                 break;
1736         default:
1737                 return -EINVAL;
1738         }
1739
1740         /* Are we changing anything? */
1741         if (wm8994->fll[id].src == src &&
1742             wm8994->fll[id].in == freq_in && wm8994->fll[id].out == freq_out)
1743                 return 0;
1744
1745         /* If we're stopping the FLL redo the old config - no
1746          * registers will actually be written but we avoid GCC flow
1747          * analysis bugs spewing warnings.
1748          */
1749         if (freq_out)
1750                 ret = wm8994_get_fll_config(&fll, freq_in, freq_out);
1751         else
1752                 ret = wm8994_get_fll_config(&fll, wm8994->fll[id].in,
1753                                             wm8994->fll[id].out);
1754         if (ret < 0)
1755                 return ret;
1756
1757         /* Gate the AIF clocks while we reclock */
1758         snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1,
1759                             WM8994_AIF1CLK_ENA, 0);
1760         snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1,
1761                             WM8994_AIF2CLK_ENA, 0);
1762
1763         /* We always need to disable the FLL while reconfiguring */
1764         snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_1 + reg_offset,
1765                             WM8994_FLL1_ENA, 0);
1766
1767         reg = (fll.outdiv << WM8994_FLL1_OUTDIV_SHIFT) |
1768                 (fll.fll_fratio << WM8994_FLL1_FRATIO_SHIFT);
1769         snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_2 + reg_offset,
1770                             WM8994_FLL1_OUTDIV_MASK |
1771                             WM8994_FLL1_FRATIO_MASK, reg);
1772
1773         snd_soc_write(codec, WM8994_FLL1_CONTROL_3 + reg_offset, fll.k);
1774
1775         snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_4 + reg_offset,
1776                             WM8994_FLL1_N_MASK,
1777                                     fll.n << WM8994_FLL1_N_SHIFT);
1778
1779         snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_5 + reg_offset,
1780                             WM8994_FLL1_REFCLK_DIV_MASK |
1781                             WM8994_FLL1_REFCLK_SRC_MASK,
1782                             (fll.clk_ref_div << WM8994_FLL1_REFCLK_DIV_SHIFT) |
1783                             (src - 1));
1784
1785         /* Enable (with fractional mode if required) */
1786         if (freq_out) {
1787                 if (fll.k)
1788                         reg = WM8994_FLL1_ENA | WM8994_FLL1_FRAC;
1789                 else
1790                         reg = WM8994_FLL1_ENA;
1791                 snd_soc_update_bits(codec, WM8994_FLL1_CONTROL_1 + reg_offset,
1792                                     WM8994_FLL1_ENA | WM8994_FLL1_FRAC,
1793                                     reg);
1794         }
1795
1796         wm8994->fll[id].in = freq_in;
1797         wm8994->fll[id].out = freq_out;
1798         wm8994->fll[id].src = src;
1799
1800         /* Enable any gated AIF clocks */
1801         snd_soc_update_bits(codec, WM8994_AIF1_CLOCKING_1,
1802                             WM8994_AIF1CLK_ENA, aif1);
1803         snd_soc_update_bits(codec, WM8994_AIF2_CLOCKING_1,
1804                             WM8994_AIF2CLK_ENA, aif2);
1805
1806         configure_clock(codec);
1807
1808         return 0;
1809 }
1810
1811
1812 static int opclk_divs[] = { 10, 20, 30, 40, 55, 60, 80, 120, 160 };
1813
1814 static int wm8994_set_fll(struct snd_soc_dai *dai, int id, int src,
1815                           unsigned int freq_in, unsigned int freq_out)
1816 {
1817         return _wm8994_set_fll(dai->codec, id, src, freq_in, freq_out);
1818 }
1819
1820 static int wm8994_set_dai_sysclk(struct snd_soc_dai *dai,
1821                 int clk_id, unsigned int freq, int dir)
1822 {
1823         struct snd_soc_codec *codec = dai->codec;
1824         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
1825         int i;
1826
1827         switch (dai->id) {
1828         case 1:
1829         case 2:
1830                 break;
1831
1832         default:
1833                 /* AIF3 shares clocking with AIF1/2 */
1834                 return -EINVAL;
1835         }
1836
1837         switch (clk_id) {
1838         case WM8994_SYSCLK_MCLK1:
1839                 wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK1;
1840                 wm8994->mclk[0] = freq;
1841                 dev_dbg(dai->dev, "AIF%d using MCLK1 at %uHz\n",
1842                         dai->id, freq);
1843                 break;
1844
1845         case WM8994_SYSCLK_MCLK2:
1846                 /* TODO: Set GPIO AF */
1847                 wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK2;
1848                 wm8994->mclk[1] = freq;
1849                 dev_dbg(dai->dev, "AIF%d using MCLK2 at %uHz\n",
1850                         dai->id, freq);
1851                 break;
1852
1853         case WM8994_SYSCLK_FLL1:
1854                 wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL1;
1855                 dev_dbg(dai->dev, "AIF%d using FLL1\n", dai->id);
1856                 break;
1857
1858         case WM8994_SYSCLK_FLL2:
1859                 wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL2;
1860                 dev_dbg(dai->dev, "AIF%d using FLL2\n", dai->id);
1861                 break;
1862
1863         case WM8994_SYSCLK_OPCLK:
1864                 /* Special case - a division (times 10) is given and
1865                  * no effect on main clocking.
1866                  */
1867                 if (freq) {
1868                         for (i = 0; i < ARRAY_SIZE(opclk_divs); i++)
1869                                 if (opclk_divs[i] == freq)
1870                                         break;
1871                         if (i == ARRAY_SIZE(opclk_divs))
1872                                 return -EINVAL;
1873                         snd_soc_update_bits(codec, WM8994_CLOCKING_2,
1874                                             WM8994_OPCLK_DIV_MASK, i);
1875                         snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_2,
1876                                             WM8994_OPCLK_ENA, WM8994_OPCLK_ENA);
1877                 } else {
1878                         snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_2,
1879                                             WM8994_OPCLK_ENA, 0);
1880                 }
1881
1882         default:
1883                 return -EINVAL;
1884         }
1885
1886         configure_clock(codec);
1887
1888         return 0;
1889 }
1890
1891 static int wm8994_set_bias_level(struct snd_soc_codec *codec,
1892                                  enum snd_soc_bias_level level)
1893 {
1894         struct wm8994 *control = codec->control_data;
1895         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
1896
1897         switch (level) {
1898         case SND_SOC_BIAS_ON:
1899                 break;
1900
1901         case SND_SOC_BIAS_PREPARE:
1902                 /* VMID=2x40k */
1903                 snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1,
1904                                     WM8994_VMID_SEL_MASK, 0x2);
1905                 break;
1906
1907         case SND_SOC_BIAS_STANDBY:
1908                 if (codec->dapm.bias_level == SND_SOC_BIAS_OFF) {
1909                         pm_runtime_get_sync(codec->dev);
1910
1911                         switch (control->type) {
1912                         case WM8994:
1913                                 if (wm8994->revision < 4) {
1914                                         /* Tweak DC servo and DSP
1915                                          * configuration for improved
1916                                          * performance. */
1917                                         snd_soc_write(codec, 0x102, 0x3);
1918                                         snd_soc_write(codec, 0x56, 0x3);
1919                                         snd_soc_write(codec, 0x817, 0);
1920                                         snd_soc_write(codec, 0x102, 0);
1921                                 }
1922                                 break;
1923
1924                         case WM8958:
1925                                 if (wm8994->revision == 0) {
1926                                         /* Optimise performance for rev A */
1927                                         snd_soc_write(codec, 0x102, 0x3);
1928                                         snd_soc_write(codec, 0xcb, 0x81);
1929                                         snd_soc_write(codec, 0x817, 0);
1930                                         snd_soc_write(codec, 0x102, 0);
1931
1932                                         snd_soc_update_bits(codec,
1933                                                             WM8958_CHARGE_PUMP_2,
1934                                                             WM8958_CP_DISCH,
1935                                                             WM8958_CP_DISCH);
1936                                 }
1937                                 break;
1938                         }
1939
1940                         /* Discharge LINEOUT1 & 2 */
1941                         snd_soc_update_bits(codec, WM8994_ANTIPOP_1,
1942                                             WM8994_LINEOUT1_DISCH |
1943                                             WM8994_LINEOUT2_DISCH,
1944                                             WM8994_LINEOUT1_DISCH |
1945                                             WM8994_LINEOUT2_DISCH);
1946
1947                         /* Startup bias, VMID ramp & buffer */
1948                         snd_soc_update_bits(codec, WM8994_ANTIPOP_2,
1949                                             WM8994_STARTUP_BIAS_ENA |
1950                                             WM8994_VMID_BUF_ENA |
1951                                             WM8994_VMID_RAMP_MASK,
1952                                             WM8994_STARTUP_BIAS_ENA |
1953                                             WM8994_VMID_BUF_ENA |
1954                                             (0x11 << WM8994_VMID_RAMP_SHIFT));
1955
1956                         /* Main bias enable, VMID=2x40k */
1957                         snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1,
1958                                             WM8994_BIAS_ENA |
1959                                             WM8994_VMID_SEL_MASK,
1960                                             WM8994_BIAS_ENA | 0x2);
1961
1962                         msleep(20);
1963                 }
1964
1965                 /* VMID=2x500k */
1966                 snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1,
1967                                     WM8994_VMID_SEL_MASK, 0x4);
1968
1969                 break;
1970
1971         case SND_SOC_BIAS_OFF:
1972                 if (codec->dapm.bias_level == SND_SOC_BIAS_STANDBY) {
1973                         /* Switch over to startup biases */
1974                         snd_soc_update_bits(codec, WM8994_ANTIPOP_2,
1975                                             WM8994_BIAS_SRC |
1976                                             WM8994_STARTUP_BIAS_ENA |
1977                                             WM8994_VMID_BUF_ENA |
1978                                             WM8994_VMID_RAMP_MASK,
1979                                             WM8994_BIAS_SRC |
1980                                             WM8994_STARTUP_BIAS_ENA |
1981                                             WM8994_VMID_BUF_ENA |
1982                                             (1 << WM8994_VMID_RAMP_SHIFT));
1983
1984                         /* Disable main biases */
1985                         snd_soc_update_bits(codec, WM8994_POWER_MANAGEMENT_1,
1986                                             WM8994_BIAS_ENA |
1987                                             WM8994_VMID_SEL_MASK, 0);
1988
1989                         /* Discharge line */
1990                         snd_soc_update_bits(codec, WM8994_ANTIPOP_1,
1991                                             WM8994_LINEOUT1_DISCH |
1992                                             WM8994_LINEOUT2_DISCH,
1993                                             WM8994_LINEOUT1_DISCH |
1994                                             WM8994_LINEOUT2_DISCH);
1995
1996                         msleep(5);
1997
1998                         /* Switch off startup biases */
1999                         snd_soc_update_bits(codec, WM8994_ANTIPOP_2,
2000                                             WM8994_BIAS_SRC |
2001                                             WM8994_STARTUP_BIAS_ENA |
2002                                             WM8994_VMID_BUF_ENA |
2003                                             WM8994_VMID_RAMP_MASK, 0);
2004
2005                         pm_runtime_put(codec->dev);
2006                 }
2007                 break;
2008         }
2009         codec->dapm.bias_level = level;
2010         return 0;
2011 }
2012
2013 static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2014 {
2015         struct snd_soc_codec *codec = dai->codec;
2016         struct wm8994 *control = codec->control_data;
2017         int ms_reg;
2018         int aif1_reg;
2019         int ms = 0;
2020         int aif1 = 0;
2021
2022         switch (dai->id) {
2023         case 1:
2024                 ms_reg = WM8994_AIF1_MASTER_SLAVE;
2025                 aif1_reg = WM8994_AIF1_CONTROL_1;
2026                 break;
2027         case 2:
2028                 ms_reg = WM8994_AIF2_MASTER_SLAVE;
2029                 aif1_reg = WM8994_AIF2_CONTROL_1;
2030                 break;
2031         default:
2032                 return -EINVAL;
2033         }
2034
2035         switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2036         case SND_SOC_DAIFMT_CBS_CFS:
2037                 break;
2038         case SND_SOC_DAIFMT_CBM_CFM:
2039                 ms = WM8994_AIF1_MSTR;
2040                 break;
2041         default:
2042                 return -EINVAL;
2043         }
2044
2045         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2046         case SND_SOC_DAIFMT_DSP_B:
2047                 aif1 |= WM8994_AIF1_LRCLK_INV;
2048         case SND_SOC_DAIFMT_DSP_A:
2049                 aif1 |= 0x18;
2050                 break;
2051         case SND_SOC_DAIFMT_I2S:
2052                 aif1 |= 0x10;
2053                 break;
2054         case SND_SOC_DAIFMT_RIGHT_J:
2055                 break;
2056         case SND_SOC_DAIFMT_LEFT_J:
2057                 aif1 |= 0x8;
2058                 break;
2059         default:
2060                 return -EINVAL;
2061         }
2062
2063         switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2064         case SND_SOC_DAIFMT_DSP_A:
2065         case SND_SOC_DAIFMT_DSP_B:
2066                 /* frame inversion not valid for DSP modes */
2067                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2068                 case SND_SOC_DAIFMT_NB_NF:
2069                         break;
2070                 case SND_SOC_DAIFMT_IB_NF:
2071                         aif1 |= WM8994_AIF1_BCLK_INV;
2072                         break;
2073                 default:
2074                         return -EINVAL;
2075                 }
2076                 break;
2077
2078         case SND_SOC_DAIFMT_I2S:
2079         case SND_SOC_DAIFMT_RIGHT_J:
2080         case SND_SOC_DAIFMT_LEFT_J:
2081                 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2082                 case SND_SOC_DAIFMT_NB_NF:
2083                         break;
2084                 case SND_SOC_DAIFMT_IB_IF:
2085                         aif1 |= WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV;
2086                         break;
2087                 case SND_SOC_DAIFMT_IB_NF:
2088                         aif1 |= WM8994_AIF1_BCLK_INV;
2089                         break;
2090                 case SND_SOC_DAIFMT_NB_IF:
2091                         aif1 |= WM8994_AIF1_LRCLK_INV;
2092                         break;
2093                 default:
2094                         return -EINVAL;
2095                 }
2096                 break;
2097         default:
2098                 return -EINVAL;
2099         }
2100
2101         /* The AIF2 format configuration needs to be mirrored to AIF3
2102          * on WM8958 if it's in use so just do it all the time. */
2103         if (control->type == WM8958 && dai->id == 2)
2104                 snd_soc_update_bits(codec, WM8958_AIF3_CONTROL_1,
2105                                     WM8994_AIF1_LRCLK_INV |
2106                                     WM8958_AIF3_FMT_MASK, aif1);
2107
2108         snd_soc_update_bits(codec, aif1_reg,
2109                             WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV |
2110                             WM8994_AIF1_FMT_MASK,
2111                             aif1);
2112         snd_soc_update_bits(codec, ms_reg, WM8994_AIF1_MSTR,
2113                             ms);
2114
2115         return 0;
2116 }
2117
2118 static struct {
2119         int val, rate;
2120 } srs[] = {
2121         { 0,   8000 },
2122         { 1,  11025 },
2123         { 2,  12000 },
2124         { 3,  16000 },
2125         { 4,  22050 },
2126         { 5,  24000 },
2127         { 6,  32000 },
2128         { 7,  44100 },
2129         { 8,  48000 },
2130         { 9,  88200 },
2131         { 10, 96000 },
2132 };
2133
2134 static int fs_ratios[] = {
2135         64, 128, 192, 256, 348, 512, 768, 1024, 1408, 1536
2136 };
2137
2138 static int bclk_divs[] = {
2139         10, 15, 20, 30, 40, 50, 60, 80, 110, 120, 160, 220, 240, 320, 440, 480,
2140         640, 880, 960, 1280, 1760, 1920
2141 };
2142
2143 static int wm8994_hw_params(struct snd_pcm_substream *substream,
2144                             struct snd_pcm_hw_params *params,
2145                             struct snd_soc_dai *dai)
2146 {
2147         struct snd_soc_codec *codec = dai->codec;
2148         struct wm8994 *control = codec->control_data;
2149         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2150         int aif1_reg;
2151         int aif2_reg;
2152         int bclk_reg;
2153         int lrclk_reg;
2154         int rate_reg;
2155         int aif1 = 0;
2156         int aif2 = 0;
2157         int bclk = 0;
2158         int lrclk = 0;
2159         int rate_val = 0;
2160         int id = dai->id - 1;
2161
2162         int i, cur_val, best_val, bclk_rate, best;
2163
2164         switch (dai->id) {
2165         case 1:
2166                 aif1_reg = WM8994_AIF1_CONTROL_1;
2167                 aif2_reg = WM8994_AIF1_CONTROL_2;
2168                 bclk_reg = WM8994_AIF1_BCLK;
2169                 rate_reg = WM8994_AIF1_RATE;
2170                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2171                     wm8994->lrclk_shared[0]) {
2172                         lrclk_reg = WM8994_AIF1DAC_LRCLK;
2173                 } else {
2174                         lrclk_reg = WM8994_AIF1ADC_LRCLK;
2175                         dev_dbg(codec->dev, "AIF1 using split LRCLK\n");
2176                 }
2177                 break;
2178         case 2:
2179                 aif1_reg = WM8994_AIF2_CONTROL_1;
2180                 aif2_reg = WM8994_AIF2_CONTROL_2;
2181                 bclk_reg = WM8994_AIF2_BCLK;
2182                 rate_reg = WM8994_AIF2_RATE;
2183                 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2184                     wm8994->lrclk_shared[1]) {
2185                         lrclk_reg = WM8994_AIF2DAC_LRCLK;
2186                 } else {
2187                         lrclk_reg = WM8994_AIF2ADC_LRCLK;
2188                         dev_dbg(codec->dev, "AIF2 using split LRCLK\n");
2189                 }
2190                 break;
2191         case 3:
2192                 switch (control->type) {
2193                 case WM8958:
2194                         aif1_reg = WM8958_AIF3_CONTROL_1;
2195                         break;
2196                 default:
2197                         return 0;
2198                 }
2199         default:
2200                 return -EINVAL;
2201         }
2202
2203         bclk_rate = params_rate(params) * 2;
2204         switch (params_format(params)) {
2205         case SNDRV_PCM_FORMAT_S16_LE:
2206                 bclk_rate *= 16;
2207                 break;
2208         case SNDRV_PCM_FORMAT_S20_3LE:
2209                 bclk_rate *= 20;
2210                 aif1 |= 0x20;
2211                 break;
2212         case SNDRV_PCM_FORMAT_S24_LE:
2213                 bclk_rate *= 24;
2214                 aif1 |= 0x40;
2215                 break;
2216         case SNDRV_PCM_FORMAT_S32_LE:
2217                 bclk_rate *= 32;
2218                 aif1 |= 0x60;
2219                 break;
2220         default:
2221                 return -EINVAL;
2222         }
2223
2224         /* Try to find an appropriate sample rate; look for an exact match. */
2225         for (i = 0; i < ARRAY_SIZE(srs); i++)
2226                 if (srs[i].rate == params_rate(params))
2227                         break;
2228         if (i == ARRAY_SIZE(srs))
2229                 return -EINVAL;
2230         rate_val |= srs[i].val << WM8994_AIF1_SR_SHIFT;
2231
2232         dev_dbg(dai->dev, "Sample rate is %dHz\n", srs[i].rate);
2233         dev_dbg(dai->dev, "AIF%dCLK is %dHz, target BCLK %dHz\n",
2234                 dai->id, wm8994->aifclk[id], bclk_rate);
2235
2236         if (params_channels(params) == 1 &&
2237             (snd_soc_read(codec, aif1_reg) & 0x18) == 0x18)
2238                 aif2 |= WM8994_AIF1_MONO;
2239
2240         if (wm8994->aifclk[id] == 0) {
2241                 dev_err(dai->dev, "AIF%dCLK not configured\n", dai->id);
2242                 return -EINVAL;
2243         }
2244
2245         /* AIFCLK/fs ratio; look for a close match in either direction */
2246         best = 0;
2247         best_val = abs((fs_ratios[0] * params_rate(params))
2248                        - wm8994->aifclk[id]);
2249         for (i = 1; i < ARRAY_SIZE(fs_ratios); i++) {
2250                 cur_val = abs((fs_ratios[i] * params_rate(params))
2251                               - wm8994->aifclk[id]);
2252                 if (cur_val >= best_val)
2253                         continue;
2254                 best = i;
2255                 best_val = cur_val;
2256         }
2257         dev_dbg(dai->dev, "Selected AIF%dCLK/fs = %d\n",
2258                 dai->id, fs_ratios[best]);
2259         rate_val |= best;
2260
2261         /* We may not get quite the right frequency if using
2262          * approximate clocks so look for the closest match that is
2263          * higher than the target (we need to ensure that there enough
2264          * BCLKs to clock out the samples).
2265          */
2266         best = 0;
2267         for (i = 0; i < ARRAY_SIZE(bclk_divs); i++) {
2268                 cur_val = (wm8994->aifclk[id] * 10 / bclk_divs[i]) - bclk_rate;
2269                 if (cur_val < 0) /* BCLK table is sorted */
2270                         break;
2271                 best = i;
2272         }
2273         bclk_rate = wm8994->aifclk[id] * 10 / bclk_divs[best];
2274         dev_dbg(dai->dev, "Using BCLK_DIV %d for actual BCLK %dHz\n",
2275                 bclk_divs[best], bclk_rate);
2276         bclk |= best << WM8994_AIF1_BCLK_DIV_SHIFT;
2277
2278         lrclk = bclk_rate / params_rate(params);
2279         dev_dbg(dai->dev, "Using LRCLK rate %d for actual LRCLK %dHz\n",
2280                 lrclk, bclk_rate / lrclk);
2281
2282         snd_soc_update_bits(codec, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
2283         snd_soc_update_bits(codec, aif2_reg, WM8994_AIF1_MONO, aif2);
2284         snd_soc_update_bits(codec, bclk_reg, WM8994_AIF1_BCLK_DIV_MASK, bclk);
2285         snd_soc_update_bits(codec, lrclk_reg, WM8994_AIF1DAC_RATE_MASK,
2286                             lrclk);
2287         snd_soc_update_bits(codec, rate_reg, WM8994_AIF1_SR_MASK |
2288                             WM8994_AIF1CLK_RATE_MASK, rate_val);
2289
2290         if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
2291                 switch (dai->id) {
2292                 case 1:
2293                         wm8994->dac_rates[0] = params_rate(params);
2294                         wm8994_set_retune_mobile(codec, 0);
2295                         wm8994_set_retune_mobile(codec, 1);
2296                         break;
2297                 case 2:
2298                         wm8994->dac_rates[1] = params_rate(params);
2299                         wm8994_set_retune_mobile(codec, 2);
2300                         break;
2301                 }
2302         }
2303
2304         return 0;
2305 }
2306
2307 static int wm8994_aif3_hw_params(struct snd_pcm_substream *substream,
2308                                  struct snd_pcm_hw_params *params,
2309                                  struct snd_soc_dai *dai)
2310 {
2311         struct snd_soc_codec *codec = dai->codec;
2312         struct wm8994 *control = codec->control_data;
2313         int aif1_reg;
2314         int aif1 = 0;
2315
2316         switch (dai->id) {
2317         case 3:
2318                 switch (control->type) {
2319                 case WM8958:
2320                         aif1_reg = WM8958_AIF3_CONTROL_1;
2321                         break;
2322                 default:
2323                         return 0;
2324                 }
2325         default:
2326                 return 0;
2327         }
2328
2329         switch (params_format(params)) {
2330         case SNDRV_PCM_FORMAT_S16_LE:
2331                 break;
2332         case SNDRV_PCM_FORMAT_S20_3LE:
2333                 aif1 |= 0x20;
2334                 break;
2335         case SNDRV_PCM_FORMAT_S24_LE:
2336                 aif1 |= 0x40;
2337                 break;
2338         case SNDRV_PCM_FORMAT_S32_LE:
2339                 aif1 |= 0x60;
2340                 break;
2341         default:
2342                 return -EINVAL;
2343         }
2344
2345         return snd_soc_update_bits(codec, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
2346 }
2347
2348 static int wm8994_aif_mute(struct snd_soc_dai *codec_dai, int mute)
2349 {
2350         struct snd_soc_codec *codec = codec_dai->codec;
2351         int mute_reg;
2352         int reg;
2353
2354         switch (codec_dai->id) {
2355         case 1:
2356                 mute_reg = WM8994_AIF1_DAC1_FILTERS_1;
2357                 break;
2358         case 2:
2359                 mute_reg = WM8994_AIF2_DAC_FILTERS_1;
2360                 break;
2361         default:
2362                 return -EINVAL;
2363         }
2364
2365         if (mute)
2366                 reg = WM8994_AIF1DAC1_MUTE;
2367         else
2368                 reg = 0;
2369
2370         snd_soc_update_bits(codec, mute_reg, WM8994_AIF1DAC1_MUTE, reg);
2371
2372         return 0;
2373 }
2374
2375 static int wm8994_set_tristate(struct snd_soc_dai *codec_dai, int tristate)
2376 {
2377         struct snd_soc_codec *codec = codec_dai->codec;
2378         int reg, val, mask;
2379
2380         switch (codec_dai->id) {
2381         case 1:
2382                 reg = WM8994_AIF1_MASTER_SLAVE;
2383                 mask = WM8994_AIF1_TRI;
2384                 break;
2385         case 2:
2386                 reg = WM8994_AIF2_MASTER_SLAVE;
2387                 mask = WM8994_AIF2_TRI;
2388                 break;
2389         case 3:
2390                 reg = WM8994_POWER_MANAGEMENT_6;
2391                 mask = WM8994_AIF3_TRI;
2392                 break;
2393         default:
2394                 return -EINVAL;
2395         }
2396
2397         if (tristate)
2398                 val = mask;
2399         else
2400                 val = 0;
2401
2402         return snd_soc_update_bits(codec, reg, mask, val);
2403 }
2404
2405 #define WM8994_RATES SNDRV_PCM_RATE_8000_96000
2406
2407 #define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
2408                         SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
2409
2410 static struct snd_soc_dai_ops wm8994_aif1_dai_ops = {
2411         .set_sysclk     = wm8994_set_dai_sysclk,
2412         .set_fmt        = wm8994_set_dai_fmt,
2413         .hw_params      = wm8994_hw_params,
2414         .digital_mute   = wm8994_aif_mute,
2415         .set_pll        = wm8994_set_fll,
2416         .set_tristate   = wm8994_set_tristate,
2417 };
2418
2419 static struct snd_soc_dai_ops wm8994_aif2_dai_ops = {
2420         .set_sysclk     = wm8994_set_dai_sysclk,
2421         .set_fmt        = wm8994_set_dai_fmt,
2422         .hw_params      = wm8994_hw_params,
2423         .digital_mute   = wm8994_aif_mute,
2424         .set_pll        = wm8994_set_fll,
2425         .set_tristate   = wm8994_set_tristate,
2426 };
2427
2428 static struct snd_soc_dai_ops wm8994_aif3_dai_ops = {
2429         .hw_params      = wm8994_aif3_hw_params,
2430         .set_tristate   = wm8994_set_tristate,
2431 };
2432
2433 static struct snd_soc_dai_driver wm8994_dai[] = {
2434         {
2435                 .name = "wm8994-aif1",
2436                 .id = 1,
2437                 .playback = {
2438                         .stream_name = "AIF1 Playback",
2439                         .channels_min = 1,
2440                         .channels_max = 2,
2441                         .rates = WM8994_RATES,
2442                         .formats = WM8994_FORMATS,
2443                 },
2444                 .capture = {
2445                         .stream_name = "AIF1 Capture",
2446                         .channels_min = 1,
2447                         .channels_max = 2,
2448                         .rates = WM8994_RATES,
2449                         .formats = WM8994_FORMATS,
2450                  },
2451                 .ops = &wm8994_aif1_dai_ops,
2452         },
2453         {
2454                 .name = "wm8994-aif2",
2455                 .id = 2,
2456                 .playback = {
2457                         .stream_name = "AIF2 Playback",
2458                         .channels_min = 1,
2459                         .channels_max = 2,
2460                         .rates = WM8994_RATES,
2461                         .formats = WM8994_FORMATS,
2462                 },
2463                 .capture = {
2464                         .stream_name = "AIF2 Capture",
2465                         .channels_min = 1,
2466                         .channels_max = 2,
2467                         .rates = WM8994_RATES,
2468                         .formats = WM8994_FORMATS,
2469                 },
2470                 .ops = &wm8994_aif2_dai_ops,
2471         },
2472         {
2473                 .name = "wm8994-aif3",
2474                 .id = 3,
2475                 .playback = {
2476                         .stream_name = "AIF3 Playback",
2477                         .channels_min = 1,
2478                         .channels_max = 2,
2479                         .rates = WM8994_RATES,
2480                         .formats = WM8994_FORMATS,
2481                 },
2482                 .capture = {
2483                         .stream_name = "AIF3 Capture",
2484                         .channels_min = 1,
2485                         .channels_max = 2,
2486                         .rates = WM8994_RATES,
2487                         .formats = WM8994_FORMATS,
2488                 },
2489                 .ops = &wm8994_aif3_dai_ops,
2490         }
2491 };
2492
2493 #ifdef CONFIG_PM
2494 static int wm8994_suspend(struct snd_soc_codec *codec, pm_message_t state)
2495 {
2496         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2497         int i, ret;
2498
2499         for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
2500                 memcpy(&wm8994->fll_suspend[i], &wm8994->fll[i],
2501                        sizeof(struct fll_config));
2502                 ret = _wm8994_set_fll(codec, i + 1, 0, 0, 0);
2503                 if (ret < 0)
2504                         dev_warn(codec->dev, "Failed to stop FLL%d: %d\n",
2505                                  i + 1, ret);
2506         }
2507
2508         wm8994_set_bias_level(codec, SND_SOC_BIAS_OFF);
2509
2510         return 0;
2511 }
2512
2513 static int wm8994_resume(struct snd_soc_codec *codec)
2514 {
2515         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2516         int i, ret;
2517
2518         /* Restore the registers */
2519         ret = snd_soc_cache_sync(codec);
2520         if (ret != 0)
2521                 dev_err(codec->dev, "Failed to sync cache: %d\n", ret);
2522
2523         wm8994_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2524
2525         for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
2526                 if (!wm8994->fll_suspend[i].out)
2527                         continue;
2528
2529                 ret = _wm8994_set_fll(codec, i + 1,
2530                                      wm8994->fll_suspend[i].src,
2531                                      wm8994->fll_suspend[i].in,
2532                                      wm8994->fll_suspend[i].out);
2533                 if (ret < 0)
2534                         dev_warn(codec->dev, "Failed to restore FLL%d: %d\n",
2535                                  i + 1, ret);
2536         }
2537
2538         return 0;
2539 }
2540 #else
2541 #define wm8994_suspend NULL
2542 #define wm8994_resume NULL
2543 #endif
2544
2545 static void wm8994_handle_retune_mobile_pdata(struct wm8994_priv *wm8994)
2546 {
2547         struct snd_soc_codec *codec = wm8994->codec;
2548         struct wm8994_pdata *pdata = wm8994->pdata;
2549         struct snd_kcontrol_new controls[] = {
2550                 SOC_ENUM_EXT("AIF1.1 EQ Mode",
2551                              wm8994->retune_mobile_enum,
2552                              wm8994_get_retune_mobile_enum,
2553                              wm8994_put_retune_mobile_enum),
2554                 SOC_ENUM_EXT("AIF1.2 EQ Mode",
2555                              wm8994->retune_mobile_enum,
2556                              wm8994_get_retune_mobile_enum,
2557                              wm8994_put_retune_mobile_enum),
2558                 SOC_ENUM_EXT("AIF2 EQ Mode",
2559                              wm8994->retune_mobile_enum,
2560                              wm8994_get_retune_mobile_enum,
2561                              wm8994_put_retune_mobile_enum),
2562         };
2563         int ret, i, j;
2564         const char **t;
2565
2566         /* We need an array of texts for the enum API but the number
2567          * of texts is likely to be less than the number of
2568          * configurations due to the sample rate dependency of the
2569          * configurations. */
2570         wm8994->num_retune_mobile_texts = 0;
2571         wm8994->retune_mobile_texts = NULL;
2572         for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
2573                 for (j = 0; j < wm8994->num_retune_mobile_texts; j++) {
2574                         if (strcmp(pdata->retune_mobile_cfgs[i].name,
2575                                    wm8994->retune_mobile_texts[j]) == 0)
2576                                 break;
2577                 }
2578
2579                 if (j != wm8994->num_retune_mobile_texts)
2580                         continue;
2581
2582                 /* Expand the array... */
2583                 t = krealloc(wm8994->retune_mobile_texts,
2584                              sizeof(char *) *
2585                              (wm8994->num_retune_mobile_texts + 1),
2586                              GFP_KERNEL);
2587                 if (t == NULL)
2588                         continue;
2589
2590                 /* ...store the new entry... */
2591                 t[wm8994->num_retune_mobile_texts] =
2592                         pdata->retune_mobile_cfgs[i].name;
2593
2594                 /* ...and remember the new version. */
2595                 wm8994->num_retune_mobile_texts++;
2596                 wm8994->retune_mobile_texts = t;
2597         }
2598
2599         dev_dbg(codec->dev, "Allocated %d unique ReTune Mobile names\n",
2600                 wm8994->num_retune_mobile_texts);
2601
2602         wm8994->retune_mobile_enum.max = wm8994->num_retune_mobile_texts;
2603         wm8994->retune_mobile_enum.texts = wm8994->retune_mobile_texts;
2604
2605         ret = snd_soc_add_controls(wm8994->codec, controls,
2606                                    ARRAY_SIZE(controls));
2607         if (ret != 0)
2608                 dev_err(wm8994->codec->dev,
2609                         "Failed to add ReTune Mobile controls: %d\n", ret);
2610 }
2611
2612 static void wm8994_handle_pdata(struct wm8994_priv *wm8994)
2613 {
2614         struct snd_soc_codec *codec = wm8994->codec;
2615         struct wm8994_pdata *pdata = wm8994->pdata;
2616         int ret, i;
2617
2618         if (!pdata)
2619                 return;
2620
2621         wm_hubs_handle_analogue_pdata(codec, pdata->lineout1_diff,
2622                                       pdata->lineout2_diff,
2623                                       pdata->lineout1fb,
2624                                       pdata->lineout2fb,
2625                                       pdata->jd_scthr,
2626                                       pdata->jd_thr,
2627                                       pdata->micbias1_lvl,
2628                                       pdata->micbias2_lvl);
2629
2630         dev_dbg(codec->dev, "%d DRC configurations\n", pdata->num_drc_cfgs);
2631
2632         if (pdata->num_drc_cfgs) {
2633                 struct snd_kcontrol_new controls[] = {
2634                         SOC_ENUM_EXT("AIF1DRC1 Mode", wm8994->drc_enum,
2635                                      wm8994_get_drc_enum, wm8994_put_drc_enum),
2636                         SOC_ENUM_EXT("AIF1DRC2 Mode", wm8994->drc_enum,
2637                                      wm8994_get_drc_enum, wm8994_put_drc_enum),
2638                         SOC_ENUM_EXT("AIF2DRC Mode", wm8994->drc_enum,
2639                                      wm8994_get_drc_enum, wm8994_put_drc_enum),
2640                 };
2641
2642                 /* We need an array of texts for the enum API */
2643                 wm8994->drc_texts = kmalloc(sizeof(char *)
2644                                             * pdata->num_drc_cfgs, GFP_KERNEL);
2645                 if (!wm8994->drc_texts) {
2646                         dev_err(wm8994->codec->dev,
2647                                 "Failed to allocate %d DRC config texts\n",
2648                                 pdata->num_drc_cfgs);
2649                         return;
2650                 }
2651
2652                 for (i = 0; i < pdata->num_drc_cfgs; i++)
2653                         wm8994->drc_texts[i] = pdata->drc_cfgs[i].name;
2654
2655                 wm8994->drc_enum.max = pdata->num_drc_cfgs;
2656                 wm8994->drc_enum.texts = wm8994->drc_texts;
2657
2658                 ret = snd_soc_add_controls(wm8994->codec, controls,
2659                                            ARRAY_SIZE(controls));
2660                 if (ret != 0)
2661                         dev_err(wm8994->codec->dev,
2662                                 "Failed to add DRC mode controls: %d\n", ret);
2663
2664                 for (i = 0; i < WM8994_NUM_DRC; i++)
2665                         wm8994_set_drc(codec, i);
2666         }
2667
2668         dev_dbg(codec->dev, "%d ReTune Mobile configurations\n",
2669                 pdata->num_retune_mobile_cfgs);
2670
2671         if (pdata->num_mbc_cfgs) {
2672                 struct snd_kcontrol_new control[] = {
2673                         SOC_ENUM_EXT("MBC Mode", wm8994->mbc_enum,
2674                                      wm8958_get_mbc_enum, wm8958_put_mbc_enum),
2675                 };
2676
2677                 /* We need an array of texts for the enum API */
2678                 wm8994->mbc_texts = kmalloc(sizeof(char *)
2679                                             * pdata->num_mbc_cfgs, GFP_KERNEL);
2680                 if (!wm8994->mbc_texts) {
2681                         dev_err(wm8994->codec->dev,
2682                                 "Failed to allocate %d MBC config texts\n",
2683                                 pdata->num_mbc_cfgs);
2684                         return;
2685                 }
2686
2687                 for (i = 0; i < pdata->num_mbc_cfgs; i++)
2688                         wm8994->mbc_texts[i] = pdata->mbc_cfgs[i].name;
2689
2690                 wm8994->mbc_enum.max = pdata->num_mbc_cfgs;
2691                 wm8994->mbc_enum.texts = wm8994->mbc_texts;
2692
2693                 ret = snd_soc_add_controls(wm8994->codec, control, 1);
2694                 if (ret != 0)
2695                         dev_err(wm8994->codec->dev,
2696                                 "Failed to add MBC mode controls: %d\n", ret);
2697         }
2698
2699         if (pdata->num_retune_mobile_cfgs)
2700                 wm8994_handle_retune_mobile_pdata(wm8994);
2701         else
2702                 snd_soc_add_controls(wm8994->codec, wm8994_eq_controls,
2703                                      ARRAY_SIZE(wm8994_eq_controls));
2704 }
2705
2706 /**
2707  * wm8994_mic_detect - Enable microphone detection via the WM8994 IRQ
2708  *
2709  * @codec:   WM8994 codec
2710  * @jack:    jack to report detection events on
2711  * @micbias: microphone bias to detect on
2712  * @det:     value to report for presence detection
2713  * @shrt:    value to report for short detection
2714  *
2715  * Enable microphone detection via IRQ on the WM8994.  If GPIOs are
2716  * being used to bring out signals to the processor then only platform
2717  * data configuration is needed for WM8994 and processor GPIOs should
2718  * be configured using snd_soc_jack_add_gpios() instead.
2719  *
2720  * Configuration of detection levels is available via the micbias1_lvl
2721  * and micbias2_lvl platform data members.
2722  */
2723 int wm8994_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack,
2724                       int micbias, int det, int shrt)
2725 {
2726         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2727         struct wm8994_micdet *micdet;
2728         struct wm8994 *control = codec->control_data;
2729         int reg;
2730
2731         if (control->type != WM8994)
2732                 return -EINVAL;
2733
2734         switch (micbias) {
2735         case 1:
2736                 micdet = &wm8994->micdet[0];
2737                 break;
2738         case 2:
2739                 micdet = &wm8994->micdet[1];
2740                 break;
2741         default:
2742                 return -EINVAL;
2743         }
2744
2745         dev_dbg(codec->dev, "Configuring microphone detection on %d: %x %x\n",
2746                 micbias, det, shrt);
2747
2748         /* Store the configuration */
2749         micdet->jack = jack;
2750         micdet->det = det;
2751         micdet->shrt = shrt;
2752
2753         /* If either of the jacks is set up then enable detection */
2754         if (wm8994->micdet[0].jack || wm8994->micdet[1].jack)
2755                 reg = WM8994_MICD_ENA;
2756         else
2757                 reg = 0;
2758
2759         snd_soc_update_bits(codec, WM8994_MICBIAS, WM8994_MICD_ENA, reg);
2760
2761         return 0;
2762 }
2763 EXPORT_SYMBOL_GPL(wm8994_mic_detect);
2764
2765 static irqreturn_t wm8994_mic_irq(int irq, void *data)
2766 {
2767         struct wm8994_priv *priv = data;
2768         struct snd_soc_codec *codec = priv->codec;
2769         int reg;
2770         int report;
2771
2772 #ifndef CONFIG_SND_SOC_WM8994_MODULE
2773         trace_snd_soc_jack_irq(dev_name(codec->dev));
2774 #endif
2775
2776         reg = snd_soc_read(codec, WM8994_INTERRUPT_RAW_STATUS_2);
2777         if (reg < 0) {
2778                 dev_err(codec->dev, "Failed to read microphone status: %d\n",
2779                         reg);
2780                 return IRQ_HANDLED;
2781         }
2782
2783         dev_dbg(codec->dev, "Microphone status: %x\n", reg);
2784
2785         report = 0;
2786         if (reg & WM8994_MIC1_DET_STS)
2787                 report |= priv->micdet[0].det;
2788         if (reg & WM8994_MIC1_SHRT_STS)
2789                 report |= priv->micdet[0].shrt;
2790         snd_soc_jack_report(priv->micdet[0].jack, report,
2791                             priv->micdet[0].det | priv->micdet[0].shrt);
2792
2793         report = 0;
2794         if (reg & WM8994_MIC2_DET_STS)
2795                 report |= priv->micdet[1].det;
2796         if (reg & WM8994_MIC2_SHRT_STS)
2797                 report |= priv->micdet[1].shrt;
2798         snd_soc_jack_report(priv->micdet[1].jack, report,
2799                             priv->micdet[1].det | priv->micdet[1].shrt);
2800
2801         return IRQ_HANDLED;
2802 }
2803
2804 /* Default microphone detection handler for WM8958 - the user can
2805  * override this if they wish.
2806  */
2807 static void wm8958_default_micdet(u16 status, void *data)
2808 {
2809         struct snd_soc_codec *codec = data;
2810         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2811         int report = 0;
2812
2813         /* If nothing present then clear our statuses */
2814         if (!(status & WM8958_MICD_STS)) {
2815                 wm8994->jack_is_video = false;
2816                 wm8994->jack_is_mic = false;
2817                 goto done;
2818         }
2819
2820         /* Assume anything over 475 ohms is a microphone and remember
2821          * that we've seen one (since buttons override it) */
2822         if (status & 0x600)
2823                 wm8994->jack_is_mic = true;
2824         if (wm8994->jack_is_mic)
2825                 report |= SND_JACK_MICROPHONE;
2826
2827         /* Video has an impedence of approximately 75 ohms; assume
2828          * this isn't used as a button and remember it since buttons
2829          * override it. */
2830         if (status & 0x40)
2831                 wm8994->jack_is_video = true;
2832         if (wm8994->jack_is_video)
2833                 report |= SND_JACK_VIDEOOUT;
2834
2835         /* Everything else is buttons; just assign slots */
2836         if (status & 0x4)
2837                 report |= SND_JACK_BTN_0;
2838         if (status & 0x8)
2839                 report |= SND_JACK_BTN_1;
2840         if (status & 0x10)
2841                 report |= SND_JACK_BTN_2;
2842         if (status & 0x20)
2843                 report |= SND_JACK_BTN_3;
2844         if (status & 0x80)
2845                 report |= SND_JACK_BTN_4;
2846         if (status & 0x100)
2847                 report |= SND_JACK_BTN_5;
2848
2849 done:
2850         snd_soc_jack_report(wm8994->micdet[0].jack,
2851                             SND_JACK_BTN_0 | SND_JACK_BTN_1 | SND_JACK_BTN_2 |
2852                             SND_JACK_BTN_3 | SND_JACK_BTN_4 | SND_JACK_BTN_5 |
2853                             SND_JACK_MICROPHONE | SND_JACK_VIDEOOUT,
2854                             report);
2855 }
2856
2857 /**
2858  * wm8958_mic_detect - Enable microphone detection via the WM8958 IRQ
2859  *
2860  * @codec:   WM8958 codec
2861  * @jack:    jack to report detection events on
2862  *
2863  * Enable microphone detection functionality for the WM8958.  By
2864  * default simple detection which supports the detection of up to 6
2865  * buttons plus video and microphone functionality is supported.
2866  *
2867  * The WM8958 has an advanced jack detection facility which is able to
2868  * support complex accessory detection, especially when used in
2869  * conjunction with external circuitry.  In order to provide maximum
2870  * flexiblity a callback is provided which allows a completely custom
2871  * detection algorithm.
2872  */
2873 int wm8958_mic_detect(struct snd_soc_codec *codec, struct snd_soc_jack *jack,
2874                       wm8958_micdet_cb cb, void *cb_data)
2875 {
2876         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
2877         struct wm8994 *control = codec->control_data;
2878
2879         if (control->type != WM8958)
2880                 return -EINVAL;
2881
2882         if (jack) {
2883                 if (!cb) {
2884                         dev_dbg(codec->dev, "Using default micdet callback\n");
2885                         cb = wm8958_default_micdet;
2886                         cb_data = codec;
2887                 }
2888
2889                 wm8994->micdet[0].jack = jack;
2890                 wm8994->jack_cb = cb;
2891                 wm8994->jack_cb_data = cb_data;
2892
2893                 snd_soc_update_bits(codec, WM8958_MIC_DETECT_1,
2894                                     WM8958_MICD_ENA, WM8958_MICD_ENA);
2895         } else {
2896                 snd_soc_update_bits(codec, WM8958_MIC_DETECT_1,
2897                                     WM8958_MICD_ENA, 0);
2898         }
2899
2900         return 0;
2901 }
2902 EXPORT_SYMBOL_GPL(wm8958_mic_detect);
2903
2904 static irqreturn_t wm8958_mic_irq(int irq, void *data)
2905 {
2906         struct wm8994_priv *wm8994 = data;
2907         struct snd_soc_codec *codec = wm8994->codec;
2908         int reg;
2909
2910         reg = snd_soc_read(codec, WM8958_MIC_DETECT_3);
2911         if (reg < 0) {
2912                 dev_err(codec->dev, "Failed to read mic detect status: %d\n",
2913                         reg);
2914                 return IRQ_NONE;
2915         }
2916
2917         if (!(reg & WM8958_MICD_VALID)) {
2918                 dev_dbg(codec->dev, "Mic detect data not valid\n");
2919                 goto out;
2920         }
2921
2922 #ifndef CONFIG_SND_SOC_WM8994_MODULE
2923         trace_snd_soc_jack_irq(dev_name(codec->dev));
2924 #endif
2925
2926         if (wm8994->jack_cb)
2927                 wm8994->jack_cb(reg, wm8994->jack_cb_data);
2928         else
2929                 dev_warn(codec->dev, "Accessory detection with no callback\n");
2930
2931 out:
2932         return IRQ_HANDLED;
2933 }
2934
2935 static int wm8994_codec_probe(struct snd_soc_codec *codec)
2936 {
2937         struct wm8994 *control;
2938         struct wm8994_priv *wm8994;
2939         struct snd_soc_dapm_context *dapm = &codec->dapm;
2940         int ret, i;
2941
2942         codec->control_data = dev_get_drvdata(codec->dev->parent);
2943         control = codec->control_data;
2944
2945         wm8994 = kzalloc(sizeof(struct wm8994_priv), GFP_KERNEL);
2946         if (wm8994 == NULL)
2947                 return -ENOMEM;
2948         snd_soc_codec_set_drvdata(codec, wm8994);
2949
2950         wm8994->pdata = dev_get_platdata(codec->dev->parent);
2951         wm8994->codec = codec;
2952
2953         pm_runtime_enable(codec->dev);
2954         pm_runtime_resume(codec->dev);
2955
2956         /* Read our current status back from the chip - we don't want to
2957          * reset as this may interfere with the GPIO or LDO operation. */
2958         for (i = 0; i < WM8994_CACHE_SIZE; i++) {
2959                 if (!wm8994_readable(i) || wm8994_volatile(i))
2960                         continue;
2961
2962                 ret = wm8994_reg_read(codec->control_data, i);
2963                 if (ret <= 0)
2964                         continue;
2965
2966                 ret = snd_soc_cache_write(codec, i, ret);
2967                 if (ret != 0) {
2968                         dev_err(codec->dev,
2969                                 "Failed to initialise cache for 0x%x: %d\n",
2970                                 i, ret);
2971                         goto err;
2972                 }
2973         }
2974
2975         /* Set revision-specific configuration */
2976         wm8994->revision = snd_soc_read(codec, WM8994_CHIP_REVISION);
2977         switch (control->type) {
2978         case WM8994:
2979                 switch (wm8994->revision) {
2980                 case 2:
2981                 case 3:
2982                         wm8994->hubs.dcs_codes = -5;
2983                         wm8994->hubs.hp_startup_mode = 1;
2984                         wm8994->hubs.dcs_readback_mode = 1;
2985                         break;
2986                 default:
2987                         wm8994->hubs.dcs_readback_mode = 1;
2988                         break;
2989                 }
2990
2991         case WM8958:
2992                 wm8994->hubs.dcs_readback_mode = 1;
2993                 break;
2994
2995         default:
2996                 break;
2997         }
2998
2999         switch (control->type) {
3000         case WM8994:
3001                 ret = wm8994_request_irq(codec->control_data,
3002                                          WM8994_IRQ_MIC1_DET,
3003                                          wm8994_mic_irq, "Mic 1 detect",
3004                                          wm8994);
3005                 if (ret != 0)
3006                         dev_warn(codec->dev,
3007                                  "Failed to request Mic1 detect IRQ: %d\n",
3008                                  ret);
3009
3010                 ret = wm8994_request_irq(codec->control_data,
3011                                          WM8994_IRQ_MIC1_SHRT,
3012                                          wm8994_mic_irq, "Mic 1 short",
3013                                          wm8994);
3014                 if (ret != 0)
3015                         dev_warn(codec->dev,
3016                                  "Failed to request Mic1 short IRQ: %d\n",
3017                                  ret);
3018
3019                 ret = wm8994_request_irq(codec->control_data,
3020                                          WM8994_IRQ_MIC2_DET,
3021                                          wm8994_mic_irq, "Mic 2 detect",
3022                                          wm8994);
3023                 if (ret != 0)
3024                         dev_warn(codec->dev,
3025                                  "Failed to request Mic2 detect IRQ: %d\n",
3026                                  ret);
3027
3028                 ret = wm8994_request_irq(codec->control_data,
3029                                          WM8994_IRQ_MIC2_SHRT,
3030                                          wm8994_mic_irq, "Mic 2 short",
3031                                          wm8994);
3032                 if (ret != 0)
3033                         dev_warn(codec->dev,
3034                                  "Failed to request Mic2 short IRQ: %d\n",
3035                                  ret);
3036                 break;
3037
3038         case WM8958:
3039                 ret = wm8994_request_irq(codec->control_data,
3040                                          WM8994_IRQ_MIC1_DET,
3041                                          wm8958_mic_irq, "Mic detect",
3042                                          wm8994);
3043                 if (ret != 0)
3044                         dev_warn(codec->dev,
3045                                  "Failed to request Mic detect IRQ: %d\n",
3046                                  ret);
3047                 break;
3048         }
3049
3050         /* Remember if AIFnLRCLK is configured as a GPIO.  This should be
3051          * configured on init - if a system wants to do this dynamically
3052          * at runtime we can deal with that then.
3053          */
3054         ret = wm8994_reg_read(codec->control_data, WM8994_GPIO_1);
3055         if (ret < 0) {
3056                 dev_err(codec->dev, "Failed to read GPIO1 state: %d\n", ret);
3057                 goto err_irq;
3058         }
3059         if ((ret & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
3060                 wm8994->lrclk_shared[0] = 1;
3061                 wm8994_dai[0].symmetric_rates = 1;
3062         } else {
3063                 wm8994->lrclk_shared[0] = 0;
3064         }
3065
3066         ret = wm8994_reg_read(codec->control_data, WM8994_GPIO_6);
3067         if (ret < 0) {
3068                 dev_err(codec->dev, "Failed to read GPIO6 state: %d\n", ret);
3069                 goto err_irq;
3070         }
3071         if ((ret & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
3072                 wm8994->lrclk_shared[1] = 1;
3073                 wm8994_dai[1].symmetric_rates = 1;
3074         } else {
3075                 wm8994->lrclk_shared[1] = 0;
3076         }
3077
3078         wm8994_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
3079
3080         /* Latch volume updates (right only; we always do left then right). */
3081         snd_soc_update_bits(codec, WM8994_AIF1_DAC1_RIGHT_VOLUME,
3082                             WM8994_AIF1DAC1_VU, WM8994_AIF1DAC1_VU);
3083         snd_soc_update_bits(codec, WM8994_AIF1_DAC2_RIGHT_VOLUME,
3084                             WM8994_AIF1DAC2_VU, WM8994_AIF1DAC2_VU);
3085         snd_soc_update_bits(codec, WM8994_AIF2_DAC_RIGHT_VOLUME,
3086                             WM8994_AIF2DAC_VU, WM8994_AIF2DAC_VU);
3087         snd_soc_update_bits(codec, WM8994_AIF1_ADC1_RIGHT_VOLUME,
3088                             WM8994_AIF1ADC1_VU, WM8994_AIF1ADC1_VU);
3089         snd_soc_update_bits(codec, WM8994_AIF1_ADC2_RIGHT_VOLUME,
3090                             WM8994_AIF1ADC2_VU, WM8994_AIF1ADC2_VU);
3091         snd_soc_update_bits(codec, WM8994_AIF2_ADC_RIGHT_VOLUME,
3092                             WM8994_AIF2ADC_VU, WM8994_AIF1ADC2_VU);
3093         snd_soc_update_bits(codec, WM8994_DAC1_RIGHT_VOLUME,
3094                             WM8994_DAC1_VU, WM8994_DAC1_VU);
3095         snd_soc_update_bits(codec, WM8994_DAC2_RIGHT_VOLUME,
3096                             WM8994_DAC2_VU, WM8994_DAC2_VU);
3097
3098         /* Set the low bit of the 3D stereo depth so TLV matches */
3099         snd_soc_update_bits(codec, WM8994_AIF1_DAC1_FILTERS_2,
3100                             1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT,
3101                             1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT);
3102         snd_soc_update_bits(codec, WM8994_AIF1_DAC2_FILTERS_2,
3103                             1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT,
3104                             1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT);
3105         snd_soc_update_bits(codec, WM8994_AIF2_DAC_FILTERS_2,
3106                             1 << WM8994_AIF2DAC_3D_GAIN_SHIFT,
3107                             1 << WM8994_AIF2DAC_3D_GAIN_SHIFT);
3108
3109         /* Unconditionally enable AIF1 ADC TDM mode; it only affects
3110          * behaviour on idle TDM clock cycles. */
3111         snd_soc_update_bits(codec, WM8994_AIF1_CONTROL_1,
3112                             WM8994_AIF1ADC_TDM, WM8994_AIF1ADC_TDM);
3113
3114         wm8994_update_class_w(codec);
3115
3116         wm8994_handle_pdata(wm8994);
3117
3118         wm_hubs_add_analogue_controls(codec);
3119         snd_soc_add_controls(codec, wm8994_snd_controls,
3120                              ARRAY_SIZE(wm8994_snd_controls));
3121         snd_soc_dapm_new_controls(dapm, wm8994_dapm_widgets,
3122                                   ARRAY_SIZE(wm8994_dapm_widgets));
3123
3124         switch (control->type) {
3125         case WM8994:
3126                 snd_soc_dapm_new_controls(dapm, wm8994_specific_dapm_widgets,
3127                                           ARRAY_SIZE(wm8994_specific_dapm_widgets));
3128                 break;
3129         case WM8958:
3130                 snd_soc_add_controls(codec, wm8958_snd_controls,
3131                                      ARRAY_SIZE(wm8958_snd_controls));
3132                 snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets,
3133                                           ARRAY_SIZE(wm8958_dapm_widgets));
3134                 break;
3135         }
3136
3137
3138         wm_hubs_add_analogue_routes(codec, 0, 0);
3139         snd_soc_dapm_add_routes(dapm, intercon, ARRAY_SIZE(intercon));
3140
3141         switch (control->type) {
3142         case WM8994:
3143                 snd_soc_dapm_add_routes(dapm, wm8994_intercon,
3144                                         ARRAY_SIZE(wm8994_intercon));
3145
3146                 if (wm8994->revision < 4)
3147                         snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon,
3148                                                 ARRAY_SIZE(wm8994_revd_intercon));
3149
3150                 break;
3151         case WM8958:
3152                 snd_soc_dapm_add_routes(dapm, wm8958_intercon,
3153                                         ARRAY_SIZE(wm8958_intercon));
3154                 break;
3155         }
3156
3157         return 0;
3158
3159 err_irq:
3160         wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_SHRT, wm8994);
3161         wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_DET, wm8994);
3162         wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_SHRT, wm8994);
3163         wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_DET, wm8994);
3164 err:
3165         kfree(wm8994);
3166         return ret;
3167 }
3168
3169 static int  wm8994_codec_remove(struct snd_soc_codec *codec)
3170 {
3171         struct wm8994_priv *wm8994 = snd_soc_codec_get_drvdata(codec);
3172         struct wm8994 *control = codec->control_data;
3173
3174         wm8994_set_bias_level(codec, SND_SOC_BIAS_OFF);
3175
3176         pm_runtime_disable(codec->dev);
3177
3178         switch (control->type) {
3179         case WM8994:
3180                 wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_SHRT,
3181                                 wm8994);
3182                 wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC2_DET,
3183                                 wm8994);
3184                 wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_SHRT,
3185                                 wm8994);
3186                 wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_DET,
3187                                 wm8994);
3188                 break;
3189
3190         case WM8958:
3191                 wm8994_free_irq(codec->control_data, WM8994_IRQ_MIC1_DET,
3192                                 wm8994);
3193                 break;
3194         }
3195         kfree(wm8994->retune_mobile_texts);
3196         kfree(wm8994->drc_texts);
3197         kfree(wm8994);
3198
3199         return 0;
3200 }
3201
3202 static struct snd_soc_codec_driver soc_codec_dev_wm8994 = {
3203         .probe =        wm8994_codec_probe,
3204         .remove =       wm8994_codec_remove,
3205         .suspend =      wm8994_suspend,
3206         .resume =       wm8994_resume,
3207         .read =         wm8994_read,
3208         .write =        wm8994_write,
3209         .readable_register = wm8994_readable,
3210         .volatile_register = wm8994_volatile,
3211         .set_bias_level = wm8994_set_bias_level,
3212
3213         .reg_cache_size = WM8994_CACHE_SIZE,
3214         .reg_cache_default = wm8994_reg_defaults,
3215         .reg_word_size = 2,
3216         .compress_type = SND_SOC_RBTREE_COMPRESSION,
3217 };
3218
3219 static int __devinit wm8994_probe(struct platform_device *pdev)
3220 {
3221         return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_wm8994,
3222                         wm8994_dai, ARRAY_SIZE(wm8994_dai));
3223 }
3224
3225 static int __devexit wm8994_remove(struct platform_device *pdev)
3226 {
3227         snd_soc_unregister_codec(&pdev->dev);
3228         return 0;
3229 }
3230
3231 static struct platform_driver wm8994_codec_driver = {
3232         .driver = {
3233                    .name = "wm8994-codec",
3234                    .owner = THIS_MODULE,
3235                    },
3236         .probe = wm8994_probe,
3237         .remove = __devexit_p(wm8994_remove),
3238 };
3239
3240 static __init int wm8994_init(void)
3241 {
3242         return platform_driver_register(&wm8994_codec_driver);
3243 }
3244 module_init(wm8994_init);
3245
3246 static __exit void wm8994_exit(void)
3247 {
3248         platform_driver_unregister(&wm8994_codec_driver);
3249 }
3250 module_exit(wm8994_exit);
3251
3252
3253 MODULE_DESCRIPTION("ASoC WM8994 driver");
3254 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
3255 MODULE_LICENSE("GPL");
3256 MODULE_ALIAS("platform:wm8994-codec");