Linux Audio

Check our new training course

Buildroot integration, development and maintenance

Need a Buildroot system for your embedded project?
Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * wm8994.c  --  WM8994 ALSA SoC Audio driver
   4 *
   5 * Copyright 2009-12 Wolfson Microelectronics plc
   6 *
   7 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com>
 
 
 
 
 
   8 */
   9
  10#include <linux/module.h>
  11#include <linux/moduleparam.h>
  12#include <linux/init.h>
  13#include <linux/delay.h>
  14#include <linux/pm.h>
  15#include <linux/gcd.h>
  16#include <linux/i2c.h>
  17#include <linux/platform_device.h>
  18#include <linux/pm_runtime.h>
  19#include <linux/regulator/consumer.h>
  20#include <linux/slab.h>
  21#include <sound/core.h>
  22#include <sound/jack.h>
  23#include <sound/pcm.h>
  24#include <sound/pcm_params.h>
  25#include <sound/soc.h>
  26#include <sound/initval.h>
  27#include <sound/tlv.h>
  28#include <trace/events/asoc.h>
  29
  30#include <linux/mfd/wm8994/core.h>
  31#include <linux/mfd/wm8994/registers.h>
  32#include <linux/mfd/wm8994/pdata.h>
  33#include <linux/mfd/wm8994/gpio.h>
  34
  35#include "wm8994.h"
  36#include "wm_hubs.h"
  37
  38#define WM1811_JACKDET_MODE_NONE  0x0000
  39#define WM1811_JACKDET_MODE_JACK  0x0100
  40#define WM1811_JACKDET_MODE_MIC   0x0080
  41#define WM1811_JACKDET_MODE_AUDIO 0x0180
  42
  43#define WM8994_NUM_DRC 3
  44#define WM8994_NUM_EQ  3
  45
  46struct wm8994_reg_mask {
  47	unsigned int reg;
  48	unsigned int mask;
  49};
  50
  51static struct wm8994_reg_mask wm8994_vu_bits[] = {
  52	{ WM8994_LEFT_LINE_INPUT_1_2_VOLUME, WM8994_IN1_VU },
  53	{ WM8994_RIGHT_LINE_INPUT_1_2_VOLUME, WM8994_IN1_VU },
  54	{ WM8994_LEFT_LINE_INPUT_3_4_VOLUME, WM8994_IN2_VU },
  55	{ WM8994_RIGHT_LINE_INPUT_3_4_VOLUME, WM8994_IN2_VU },
  56	{ WM8994_SPEAKER_VOLUME_LEFT, WM8994_SPKOUT_VU },
  57	{ WM8994_SPEAKER_VOLUME_RIGHT, WM8994_SPKOUT_VU },
  58	{ WM8994_LEFT_OUTPUT_VOLUME, WM8994_HPOUT1_VU },
  59	{ WM8994_RIGHT_OUTPUT_VOLUME, WM8994_HPOUT1_VU },
  60	{ WM8994_LEFT_OPGA_VOLUME, WM8994_MIXOUT_VU },
  61	{ WM8994_RIGHT_OPGA_VOLUME, WM8994_MIXOUT_VU },
  62
  63	{ WM8994_AIF1_DAC1_LEFT_VOLUME, WM8994_AIF1DAC1_VU },
  64	{ WM8994_AIF1_DAC1_RIGHT_VOLUME, WM8994_AIF1DAC1_VU },
 
 
  65	{ WM8994_AIF2_DAC_LEFT_VOLUME, WM8994_AIF2DAC_VU },
  66	{ WM8994_AIF2_DAC_RIGHT_VOLUME, WM8994_AIF2DAC_VU },
  67	{ WM8994_AIF1_ADC1_LEFT_VOLUME, WM8994_AIF1ADC1_VU },
  68	{ WM8994_AIF1_ADC1_RIGHT_VOLUME, WM8994_AIF1ADC1_VU },
 
 
  69	{ WM8994_AIF2_ADC_LEFT_VOLUME, WM8994_AIF2ADC_VU },
  70	{ WM8994_AIF2_ADC_RIGHT_VOLUME, WM8994_AIF1ADC2_VU },
  71	{ WM8994_DAC1_LEFT_VOLUME, WM8994_DAC1_VU },
  72	{ WM8994_DAC1_RIGHT_VOLUME, WM8994_DAC1_VU },
  73	{ WM8994_DAC2_LEFT_VOLUME, WM8994_DAC2_VU },
  74	{ WM8994_DAC2_RIGHT_VOLUME, WM8994_DAC2_VU },
  75};
  76
  77/* VU bitfields for ADC2, DAC2 not available on WM1811 */
  78static struct wm8994_reg_mask wm8994_adc2_dac2_vu_bits[] = {
  79	{ WM8994_AIF1_DAC2_LEFT_VOLUME, WM8994_AIF1DAC2_VU },
  80	{ WM8994_AIF1_DAC2_RIGHT_VOLUME, WM8994_AIF1DAC2_VU },
  81	{ WM8994_AIF1_ADC2_LEFT_VOLUME, WM8994_AIF1ADC2_VU },
  82	{ WM8994_AIF1_ADC2_RIGHT_VOLUME, WM8994_AIF1ADC2_VU },
  83};
  84
  85static int wm8994_drc_base[] = {
  86	WM8994_AIF1_DRC1_1,
  87	WM8994_AIF1_DRC2_1,
  88	WM8994_AIF2_DRC_1,
  89};
  90
  91static int wm8994_retune_mobile_base[] = {
  92	WM8994_AIF1_DAC1_EQ_GAINS_1,
  93	WM8994_AIF1_DAC2_EQ_GAINS_1,
  94	WM8994_AIF2_EQ_GAINS_1,
  95};
  96
  97static const struct wm8958_micd_rate micdet_rates[] = {
  98	{ 32768,       true,  1, 4 },
  99	{ 32768,       false, 1, 1 },
 100	{ 44100 * 256, true,  7, 10 },
 101	{ 44100 * 256, false, 7, 10 },
 102};
 103
 104static const struct wm8958_micd_rate jackdet_rates[] = {
 105	{ 32768,       true,  0, 1 },
 106	{ 32768,       false, 0, 1 },
 107	{ 44100 * 256, true,  10, 10 },
 108	{ 44100 * 256, false, 7, 8 },
 109};
 110
 111static void wm8958_micd_set_rate(struct snd_soc_component *component)
 112{
 113	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 114	struct wm8994 *control = wm8994->wm8994;
 115	int best, i, sysclk, val;
 116	bool idle;
 117	const struct wm8958_micd_rate *rates;
 118	int num_rates;
 119
 120	idle = !wm8994->jack_mic;
 121
 122	sysclk = snd_soc_component_read(component, WM8994_CLOCKING_1);
 123	if (sysclk & WM8994_SYSCLK_SRC)
 124		sysclk = wm8994->aifclk[1];
 125	else
 126		sysclk = wm8994->aifclk[0];
 127
 128	if (control->pdata.micd_rates) {
 129		rates = control->pdata.micd_rates;
 130		num_rates = control->pdata.num_micd_rates;
 131	} else if (wm8994->jackdet) {
 132		rates = jackdet_rates;
 133		num_rates = ARRAY_SIZE(jackdet_rates);
 134	} else {
 135		rates = micdet_rates;
 136		num_rates = ARRAY_SIZE(micdet_rates);
 137	}
 138
 139	best = 0;
 140	for (i = 0; i < num_rates; i++) {
 141		if (rates[i].idle != idle)
 142			continue;
 143		if (abs(rates[i].sysclk - sysclk) <
 144		    abs(rates[best].sysclk - sysclk))
 145			best = i;
 146		else if (rates[best].idle != idle)
 147			best = i;
 148	}
 149
 150	val = rates[best].start << WM8958_MICD_BIAS_STARTTIME_SHIFT
 151		| rates[best].rate << WM8958_MICD_RATE_SHIFT;
 152
 153	dev_dbg(component->dev, "MICD rate %d,%d for %dHz %s\n",
 154		rates[best].start, rates[best].rate, sysclk,
 155		idle ? "idle" : "active");
 156
 157	snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
 158			    WM8958_MICD_BIAS_STARTTIME_MASK |
 159			    WM8958_MICD_RATE_MASK, val);
 160}
 161
 162static int configure_aif_clock(struct snd_soc_component *component, int aif)
 163{
 164	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 165	int rate;
 166	int reg1 = 0;
 167	int offset;
 168
 169	if (aif)
 170		offset = 4;
 171	else
 172		offset = 0;
 173
 174	switch (wm8994->sysclk[aif]) {
 175	case WM8994_SYSCLK_MCLK1:
 176		rate = wm8994->mclk_rate[0];
 177		break;
 178
 179	case WM8994_SYSCLK_MCLK2:
 180		reg1 |= 0x8;
 181		rate = wm8994->mclk_rate[1];
 182		break;
 183
 184	case WM8994_SYSCLK_FLL1:
 185		reg1 |= 0x10;
 186		rate = wm8994->fll[0].out;
 187		break;
 188
 189	case WM8994_SYSCLK_FLL2:
 190		reg1 |= 0x18;
 191		rate = wm8994->fll[1].out;
 192		break;
 193
 194	default:
 195		return -EINVAL;
 196	}
 197
 198	if (rate >= 13500000) {
 199		rate /= 2;
 200		reg1 |= WM8994_AIF1CLK_DIV;
 201
 202		dev_dbg(component->dev, "Dividing AIF%d clock to %dHz\n",
 203			aif + 1, rate);
 204	}
 205
 206	wm8994->aifclk[aif] = rate;
 207
 208	snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1 + offset,
 209			    WM8994_AIF1CLK_SRC_MASK | WM8994_AIF1CLK_DIV,
 210			    reg1);
 211
 212	return 0;
 213}
 214
 215static int configure_clock(struct snd_soc_component *component)
 216{
 217	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
 218	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 219	int change, new;
 220
 221	/* Bring up the AIF clocks first */
 222	configure_aif_clock(component, 0);
 223	configure_aif_clock(component, 1);
 224
 225	/* Then switch CLK_SYS over to the higher of them; a change
 226	 * can only happen as a result of a clocking change which can
 227	 * only be made outside of DAPM so we can safely redo the
 228	 * clocking.
 229	 */
 230
 231	/* If they're equal it doesn't matter which is used */
 232	if (wm8994->aifclk[0] == wm8994->aifclk[1]) {
 233		wm8958_micd_set_rate(component);
 234		return 0;
 235	}
 236
 237	if (wm8994->aifclk[0] < wm8994->aifclk[1])
 238		new = WM8994_SYSCLK_SRC;
 239	else
 240		new = 0;
 241
 242	change = snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
 243				     WM8994_SYSCLK_SRC, new);
 244	if (change)
 245		snd_soc_dapm_sync(dapm);
 246
 247	wm8958_micd_set_rate(component);
 248
 249	return 0;
 250}
 251
 252static int check_clk_sys(struct snd_soc_dapm_widget *source,
 253			 struct snd_soc_dapm_widget *sink)
 254{
 255	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);
 256	int reg = snd_soc_component_read(component, WM8994_CLOCKING_1);
 257	const char *clk;
 258
 259	/* Check what we're currently using for CLK_SYS */
 260	if (reg & WM8994_SYSCLK_SRC)
 261		clk = "AIF2CLK";
 262	else
 263		clk = "AIF1CLK";
 264
 265	return snd_soc_dapm_widget_name_cmp(source, clk) == 0;
 266}
 267
 268static const char *sidetone_hpf_text[] = {
 269	"2.7kHz", "1.35kHz", "675Hz", "370Hz", "180Hz", "90Hz", "45Hz"
 270};
 271
 272static SOC_ENUM_SINGLE_DECL(sidetone_hpf,
 273			    WM8994_SIDETONE, 7, sidetone_hpf_text);
 274
 275static const char *adc_hpf_text[] = {
 276	"HiFi", "Voice 1", "Voice 2", "Voice 3"
 277};
 278
 279static SOC_ENUM_SINGLE_DECL(aif1adc1_hpf,
 280			    WM8994_AIF1_ADC1_FILTERS, 13, adc_hpf_text);
 281
 282static SOC_ENUM_SINGLE_DECL(aif1adc2_hpf,
 283			    WM8994_AIF1_ADC2_FILTERS, 13, adc_hpf_text);
 284
 285static SOC_ENUM_SINGLE_DECL(aif2adc_hpf,
 286			    WM8994_AIF2_ADC_FILTERS, 13, adc_hpf_text);
 287
 288static const DECLARE_TLV_DB_SCALE(aif_tlv, 0, 600, 0);
 289static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
 290static const DECLARE_TLV_DB_SCALE(st_tlv, -3600, 300, 0);
 291static const DECLARE_TLV_DB_SCALE(wm8994_3d_tlv, -1600, 183, 0);
 292static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0);
 293static const DECLARE_TLV_DB_SCALE(ng_tlv, -10200, 600, 0);
 
 294
 295#define WM8994_DRC_SWITCH(xname, reg, shift) \
 296	SOC_SINGLE_EXT(xname, reg, shift, 1, 0, \
 297		snd_soc_get_volsw, wm8994_put_drc_sw)
 298
 299static int wm8994_put_drc_sw(struct snd_kcontrol *kcontrol,
 300			     struct snd_ctl_elem_value *ucontrol)
 301{
 302	struct soc_mixer_control *mc =
 303		(struct soc_mixer_control *)kcontrol->private_value;
 304	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 305	int mask, ret;
 306
 307	/* Can't enable both ADC and DAC paths simultaneously */
 308	if (mc->shift == WM8994_AIF1DAC1_DRC_ENA_SHIFT)
 309		mask = WM8994_AIF1ADC1L_DRC_ENA_MASK |
 310			WM8994_AIF1ADC1R_DRC_ENA_MASK;
 311	else
 312		mask = WM8994_AIF1DAC1_DRC_ENA_MASK;
 313
 314	ret = snd_soc_component_read(component, mc->reg);
 315	if (ret < 0)
 316		return ret;
 317	if (ret & mask)
 318		return -EINVAL;
 319
 320	return snd_soc_put_volsw(kcontrol, ucontrol);
 321}
 322
 323static void wm8994_set_drc(struct snd_soc_component *component, int drc)
 324{
 325	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 326	struct wm8994 *control = wm8994->wm8994;
 327	struct wm8994_pdata *pdata = &control->pdata;
 328	int base = wm8994_drc_base[drc];
 329	int cfg = wm8994->drc_cfg[drc];
 330	int save, i;
 331
 332	/* Save any enables; the configuration should clear them. */
 333	save = snd_soc_component_read(component, base);
 334	save &= WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA |
 335		WM8994_AIF1ADC1R_DRC_ENA;
 336
 337	for (i = 0; i < WM8994_DRC_REGS; i++)
 338		snd_soc_component_update_bits(component, base + i, 0xffff,
 339				    pdata->drc_cfgs[cfg].regs[i]);
 340
 341	snd_soc_component_update_bits(component, base, WM8994_AIF1DAC1_DRC_ENA |
 342			     WM8994_AIF1ADC1L_DRC_ENA |
 343			     WM8994_AIF1ADC1R_DRC_ENA, save);
 344}
 345
 346/* Icky as hell but saves code duplication */
 347static int wm8994_get_drc(const char *name)
 348{
 349	if (strcmp(name, "AIF1DRC1 Mode") == 0)
 350		return 0;
 351	if (strcmp(name, "AIF1DRC2 Mode") == 0)
 352		return 1;
 353	if (strcmp(name, "AIF2DRC Mode") == 0)
 354		return 2;
 355	return -EINVAL;
 356}
 357
 358static int wm8994_put_drc_enum(struct snd_kcontrol *kcontrol,
 359			       struct snd_ctl_elem_value *ucontrol)
 360{
 361	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 362	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 363	struct wm8994 *control = wm8994->wm8994;
 364	struct wm8994_pdata *pdata = &control->pdata;
 365	int drc = wm8994_get_drc(kcontrol->id.name);
 366	int value = ucontrol->value.enumerated.item[0];
 367
 368	if (drc < 0)
 369		return drc;
 370
 371	if (value >= pdata->num_drc_cfgs)
 372		return -EINVAL;
 373
 374	wm8994->drc_cfg[drc] = value;
 375
 376	wm8994_set_drc(component, drc);
 377
 378	return 0;
 379}
 380
 381static int wm8994_get_drc_enum(struct snd_kcontrol *kcontrol,
 382			       struct snd_ctl_elem_value *ucontrol)
 383{
 384	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 385	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 386	int drc = wm8994_get_drc(kcontrol->id.name);
 387
 388	if (drc < 0)
 389		return drc;
 390	ucontrol->value.enumerated.item[0] = wm8994->drc_cfg[drc];
 391
 392	return 0;
 393}
 394
 395static void wm8994_set_retune_mobile(struct snd_soc_component *component, int block)
 396{
 397	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 398	struct wm8994 *control = wm8994->wm8994;
 399	struct wm8994_pdata *pdata = &control->pdata;
 400	int base = wm8994_retune_mobile_base[block];
 401	int iface, best, best_val, save, i, cfg;
 402
 403	if (!pdata || !wm8994->num_retune_mobile_texts)
 404		return;
 405
 406	switch (block) {
 407	case 0:
 408	case 1:
 409		iface = 0;
 410		break;
 411	case 2:
 412		iface = 1;
 413		break;
 414	default:
 415		return;
 416	}
 417
 418	/* Find the version of the currently selected configuration
 419	 * with the nearest sample rate. */
 420	cfg = wm8994->retune_mobile_cfg[block];
 421	best = 0;
 422	best_val = INT_MAX;
 423	for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
 424		if (strcmp(pdata->retune_mobile_cfgs[i].name,
 425			   wm8994->retune_mobile_texts[cfg]) == 0 &&
 426		    abs(pdata->retune_mobile_cfgs[i].rate
 427			- wm8994->dac_rates[iface]) < best_val) {
 428			best = i;
 429			best_val = abs(pdata->retune_mobile_cfgs[i].rate
 430				       - wm8994->dac_rates[iface]);
 431		}
 432	}
 433
 434	dev_dbg(component->dev, "ReTune Mobile %d %s/%dHz for %dHz sample rate\n",
 435		block,
 436		pdata->retune_mobile_cfgs[best].name,
 437		pdata->retune_mobile_cfgs[best].rate,
 438		wm8994->dac_rates[iface]);
 439
 440	/* The EQ will be disabled while reconfiguring it, remember the
 441	 * current configuration.
 442	 */
 443	save = snd_soc_component_read(component, base);
 444	save &= WM8994_AIF1DAC1_EQ_ENA;
 445
 446	for (i = 0; i < WM8994_EQ_REGS; i++)
 447		snd_soc_component_update_bits(component, base + i, 0xffff,
 448				pdata->retune_mobile_cfgs[best].regs[i]);
 449
 450	snd_soc_component_update_bits(component, base, WM8994_AIF1DAC1_EQ_ENA, save);
 451}
 452
 453/* Icky as hell but saves code duplication */
 454static int wm8994_get_retune_mobile_block(const char *name)
 455{
 456	if (strcmp(name, "AIF1.1 EQ Mode") == 0)
 457		return 0;
 458	if (strcmp(name, "AIF1.2 EQ Mode") == 0)
 459		return 1;
 460	if (strcmp(name, "AIF2 EQ Mode") == 0)
 461		return 2;
 462	return -EINVAL;
 463}
 464
 465static int wm8994_put_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 466					 struct snd_ctl_elem_value *ucontrol)
 467{
 468	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 469	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 470	struct wm8994 *control = wm8994->wm8994;
 471	struct wm8994_pdata *pdata = &control->pdata;
 472	int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 473	int value = ucontrol->value.enumerated.item[0];
 474
 475	if (block < 0)
 476		return block;
 477
 478	if (value >= pdata->num_retune_mobile_cfgs)
 479		return -EINVAL;
 480
 481	wm8994->retune_mobile_cfg[block] = value;
 482
 483	wm8994_set_retune_mobile(component, block);
 484
 485	return 0;
 486}
 487
 488static int wm8994_get_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 489					 struct snd_ctl_elem_value *ucontrol)
 490{
 491	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 492	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 493	int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 494
 495	if (block < 0)
 496		return block;
 497
 498	ucontrol->value.enumerated.item[0] = wm8994->retune_mobile_cfg[block];
 499
 500	return 0;
 501}
 502
 503static const char *aif_chan_src_text[] = {
 504	"Left", "Right"
 505};
 506
 507static SOC_ENUM_SINGLE_DECL(aif1adcl_src,
 508			    WM8994_AIF1_CONTROL_1, 15, aif_chan_src_text);
 509
 510static SOC_ENUM_SINGLE_DECL(aif1adcr_src,
 511			    WM8994_AIF1_CONTROL_1, 14, aif_chan_src_text);
 512
 513static SOC_ENUM_SINGLE_DECL(aif2adcl_src,
 514			    WM8994_AIF2_CONTROL_1, 15, aif_chan_src_text);
 515
 516static SOC_ENUM_SINGLE_DECL(aif2adcr_src,
 517			    WM8994_AIF2_CONTROL_1, 14, aif_chan_src_text);
 518
 519static SOC_ENUM_SINGLE_DECL(aif1dacl_src,
 520			    WM8994_AIF1_CONTROL_2, 15, aif_chan_src_text);
 521
 522static SOC_ENUM_SINGLE_DECL(aif1dacr_src,
 523			    WM8994_AIF1_CONTROL_2, 14, aif_chan_src_text);
 524
 525static SOC_ENUM_SINGLE_DECL(aif2dacl_src,
 526			    WM8994_AIF2_CONTROL_2, 15, aif_chan_src_text);
 527
 528static SOC_ENUM_SINGLE_DECL(aif2dacr_src,
 529			    WM8994_AIF2_CONTROL_2, 14, aif_chan_src_text);
 530
 531static const char *osr_text[] = {
 532	"Low Power", "High Performance",
 533};
 534
 535static SOC_ENUM_SINGLE_DECL(dac_osr,
 536			    WM8994_OVERSAMPLING, 0, osr_text);
 537
 538static SOC_ENUM_SINGLE_DECL(adc_osr,
 539			    WM8994_OVERSAMPLING, 1, osr_text);
 540
 541static const struct snd_kcontrol_new wm8994_common_snd_controls[] = {
 542SOC_DOUBLE_R_TLV("AIF1ADC1 Volume", WM8994_AIF1_ADC1_LEFT_VOLUME,
 543		 WM8994_AIF1_ADC1_RIGHT_VOLUME,
 544		 1, 119, 0, digital_tlv),
 
 
 
 545SOC_DOUBLE_R_TLV("AIF2ADC Volume", WM8994_AIF2_ADC_LEFT_VOLUME,
 546		 WM8994_AIF2_ADC_RIGHT_VOLUME,
 547		 1, 119, 0, digital_tlv),
 548
 549SOC_ENUM("AIF1ADCL Source", aif1adcl_src),
 550SOC_ENUM("AIF1ADCR Source", aif1adcr_src),
 551SOC_ENUM("AIF2ADCL Source", aif2adcl_src),
 552SOC_ENUM("AIF2ADCR Source", aif2adcr_src),
 553
 554SOC_ENUM("AIF1DACL Source", aif1dacl_src),
 555SOC_ENUM("AIF1DACR Source", aif1dacr_src),
 556SOC_ENUM("AIF2DACL Source", aif2dacl_src),
 557SOC_ENUM("AIF2DACR Source", aif2dacr_src),
 558
 559SOC_DOUBLE_R_TLV("AIF1DAC1 Volume", WM8994_AIF1_DAC1_LEFT_VOLUME,
 560		 WM8994_AIF1_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 
 
 561SOC_DOUBLE_R_TLV("AIF2DAC Volume", WM8994_AIF2_DAC_LEFT_VOLUME,
 562		 WM8994_AIF2_DAC_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 563
 564SOC_SINGLE_TLV("AIF1 Boost Volume", WM8994_AIF1_CONTROL_2, 10, 3, 0, aif_tlv),
 565SOC_SINGLE_TLV("AIF2 Boost Volume", WM8994_AIF2_CONTROL_2, 10, 3, 0, aif_tlv),
 566
 567SOC_SINGLE("AIF1DAC1 EQ Switch", WM8994_AIF1_DAC1_EQ_GAINS_1, 0, 1, 0),
 
 568SOC_SINGLE("AIF2 EQ Switch", WM8994_AIF2_EQ_GAINS_1, 0, 1, 0),
 569
 570WM8994_DRC_SWITCH("AIF1DAC1 DRC Switch", WM8994_AIF1_DRC1_1, 2),
 571WM8994_DRC_SWITCH("AIF1ADC1L DRC Switch", WM8994_AIF1_DRC1_1, 1),
 572WM8994_DRC_SWITCH("AIF1ADC1R DRC Switch", WM8994_AIF1_DRC1_1, 0),
 573
 
 
 
 
 574WM8994_DRC_SWITCH("AIF2DAC DRC Switch", WM8994_AIF2_DRC_1, 2),
 575WM8994_DRC_SWITCH("AIF2ADCL DRC Switch", WM8994_AIF2_DRC_1, 1),
 576WM8994_DRC_SWITCH("AIF2ADCR DRC Switch", WM8994_AIF2_DRC_1, 0),
 577
 578SOC_SINGLE_TLV("DAC1 Right Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 579	       5, 12, 0, st_tlv),
 580SOC_SINGLE_TLV("DAC1 Left Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 581	       0, 12, 0, st_tlv),
 582SOC_SINGLE_TLV("DAC2 Right Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 583	       5, 12, 0, st_tlv),
 584SOC_SINGLE_TLV("DAC2 Left Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 585	       0, 12, 0, st_tlv),
 586SOC_ENUM("Sidetone HPF Mux", sidetone_hpf),
 587SOC_SINGLE("Sidetone HPF Switch", WM8994_SIDETONE, 6, 1, 0),
 588
 589SOC_ENUM("AIF1ADC1 HPF Mode", aif1adc1_hpf),
 590SOC_DOUBLE("AIF1ADC1 HPF Switch", WM8994_AIF1_ADC1_FILTERS, 12, 11, 1, 0),
 591
 
 
 
 592SOC_ENUM("AIF2ADC HPF Mode", aif2adc_hpf),
 593SOC_DOUBLE("AIF2ADC HPF Switch", WM8994_AIF2_ADC_FILTERS, 12, 11, 1, 0),
 594
 595SOC_ENUM("ADC OSR", adc_osr),
 596SOC_ENUM("DAC OSR", dac_osr),
 597
 598SOC_DOUBLE_R_TLV("DAC1 Volume", WM8994_DAC1_LEFT_VOLUME,
 599		 WM8994_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 600SOC_DOUBLE_R("DAC1 Switch", WM8994_DAC1_LEFT_VOLUME,
 601	     WM8994_DAC1_RIGHT_VOLUME, 9, 1, 1),
 602
 603SOC_DOUBLE_R_TLV("DAC2 Volume", WM8994_DAC2_LEFT_VOLUME,
 604		 WM8994_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 605SOC_DOUBLE_R("DAC2 Switch", WM8994_DAC2_LEFT_VOLUME,
 606	     WM8994_DAC2_RIGHT_VOLUME, 9, 1, 1),
 607
 608SOC_SINGLE_TLV("SPKL DAC2 Volume", WM8994_SPKMIXL_ATTENUATION,
 609	       6, 1, 1, wm_hubs_spkmix_tlv),
 610SOC_SINGLE_TLV("SPKL DAC1 Volume", WM8994_SPKMIXL_ATTENUATION,
 611	       2, 1, 1, wm_hubs_spkmix_tlv),
 612
 613SOC_SINGLE_TLV("SPKR DAC2 Volume", WM8994_SPKMIXR_ATTENUATION,
 614	       6, 1, 1, wm_hubs_spkmix_tlv),
 615SOC_SINGLE_TLV("SPKR DAC1 Volume", WM8994_SPKMIXR_ATTENUATION,
 616	       2, 1, 1, wm_hubs_spkmix_tlv),
 617
 618SOC_SINGLE_TLV("AIF1DAC1 3D Stereo Volume", WM8994_AIF1_DAC1_FILTERS_2,
 619	       10, 15, 0, wm8994_3d_tlv),
 620SOC_SINGLE("AIF1DAC1 3D Stereo Switch", WM8994_AIF1_DAC1_FILTERS_2,
 621	   8, 1, 0),
 622SOC_SINGLE_TLV("AIF1DAC2 3D Stereo Volume", WM8994_AIF1_DAC2_FILTERS_2,
 623	       10, 15, 0, wm8994_3d_tlv),
 624SOC_SINGLE("AIF1DAC2 3D Stereo Switch", WM8994_AIF1_DAC2_FILTERS_2,
 625	   8, 1, 0),
 626SOC_SINGLE_TLV("AIF2DAC 3D Stereo Volume", WM8994_AIF2_DAC_FILTERS_2,
 627	       10, 15, 0, wm8994_3d_tlv),
 628SOC_SINGLE("AIF2DAC 3D Stereo Switch", WM8994_AIF2_DAC_FILTERS_2,
 629	   8, 1, 0),
 630};
 631
 632/* Controls not available on WM1811 */
 633static const struct snd_kcontrol_new wm8994_snd_controls[] = {
 634SOC_DOUBLE_R_TLV("AIF1ADC2 Volume", WM8994_AIF1_ADC2_LEFT_VOLUME,
 635		 WM8994_AIF1_ADC2_RIGHT_VOLUME,
 636		 1, 119, 0, digital_tlv),
 637SOC_DOUBLE_R_TLV("AIF1DAC2 Volume", WM8994_AIF1_DAC2_LEFT_VOLUME,
 638		 WM8994_AIF1_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 639
 640SOC_SINGLE("AIF1DAC2 EQ Switch", WM8994_AIF1_DAC2_EQ_GAINS_1, 0, 1, 0),
 641
 642WM8994_DRC_SWITCH("AIF1DAC2 DRC Switch", WM8994_AIF1_DRC2_1, 2),
 643WM8994_DRC_SWITCH("AIF1ADC2L DRC Switch", WM8994_AIF1_DRC2_1, 1),
 644WM8994_DRC_SWITCH("AIF1ADC2R DRC Switch", WM8994_AIF1_DRC2_1, 0),
 645
 646SOC_ENUM("AIF1ADC2 HPF Mode", aif1adc2_hpf),
 647SOC_DOUBLE("AIF1ADC2 HPF Switch", WM8994_AIF1_ADC2_FILTERS, 12, 11, 1, 0),
 648};
 649
 650static const struct snd_kcontrol_new wm8994_eq_controls[] = {
 651SOC_SINGLE_TLV("AIF1DAC1 EQ1 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 11, 31, 0,
 652	       eq_tlv),
 653SOC_SINGLE_TLV("AIF1DAC1 EQ2 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 6, 31, 0,
 654	       eq_tlv),
 655SOC_SINGLE_TLV("AIF1DAC1 EQ3 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 1, 31, 0,
 656	       eq_tlv),
 657SOC_SINGLE_TLV("AIF1DAC1 EQ4 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 11, 31, 0,
 658	       eq_tlv),
 659SOC_SINGLE_TLV("AIF1DAC1 EQ5 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 6, 31, 0,
 660	       eq_tlv),
 661
 662SOC_SINGLE_TLV("AIF1DAC2 EQ1 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 11, 31, 0,
 663	       eq_tlv),
 664SOC_SINGLE_TLV("AIF1DAC2 EQ2 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 6, 31, 0,
 665	       eq_tlv),
 666SOC_SINGLE_TLV("AIF1DAC2 EQ3 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 1, 31, 0,
 667	       eq_tlv),
 668SOC_SINGLE_TLV("AIF1DAC2 EQ4 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 11, 31, 0,
 669	       eq_tlv),
 670SOC_SINGLE_TLV("AIF1DAC2 EQ5 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 6, 31, 0,
 671	       eq_tlv),
 672
 673SOC_SINGLE_TLV("AIF2 EQ1 Volume", WM8994_AIF2_EQ_GAINS_1, 11, 31, 0,
 674	       eq_tlv),
 675SOC_SINGLE_TLV("AIF2 EQ2 Volume", WM8994_AIF2_EQ_GAINS_1, 6, 31, 0,
 676	       eq_tlv),
 677SOC_SINGLE_TLV("AIF2 EQ3 Volume", WM8994_AIF2_EQ_GAINS_1, 1, 31, 0,
 678	       eq_tlv),
 679SOC_SINGLE_TLV("AIF2 EQ4 Volume", WM8994_AIF2_EQ_GAINS_2, 11, 31, 0,
 680	       eq_tlv),
 681SOC_SINGLE_TLV("AIF2 EQ5 Volume", WM8994_AIF2_EQ_GAINS_2, 6, 31, 0,
 682	       eq_tlv),
 683};
 684
 685static const struct snd_kcontrol_new wm8994_drc_controls[] = {
 686SND_SOC_BYTES_MASK("AIF1.1 DRC", WM8994_AIF1_DRC1_1, 5,
 687		   WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA |
 688		   WM8994_AIF1ADC1R_DRC_ENA),
 689SND_SOC_BYTES_MASK("AIF1.2 DRC", WM8994_AIF1_DRC2_1, 5,
 690		   WM8994_AIF1DAC2_DRC_ENA | WM8994_AIF1ADC2L_DRC_ENA |
 691		   WM8994_AIF1ADC2R_DRC_ENA),
 692SND_SOC_BYTES_MASK("AIF2 DRC", WM8994_AIF2_DRC_1, 5,
 693		   WM8994_AIF2DAC_DRC_ENA | WM8994_AIF2ADCL_DRC_ENA |
 694		   WM8994_AIF2ADCR_DRC_ENA),
 695};
 696
 697static const char *wm8958_ng_text[] = {
 698	"30ms", "125ms", "250ms", "500ms",
 699};
 700
 701static SOC_ENUM_SINGLE_DECL(wm8958_aif1dac1_ng_hold,
 702			    WM8958_AIF1_DAC1_NOISE_GATE,
 703			    WM8958_AIF1DAC1_NG_THR_SHIFT,
 704			    wm8958_ng_text);
 705
 706static SOC_ENUM_SINGLE_DECL(wm8958_aif1dac2_ng_hold,
 707			    WM8958_AIF1_DAC2_NOISE_GATE,
 708			    WM8958_AIF1DAC2_NG_THR_SHIFT,
 709			    wm8958_ng_text);
 710
 711static SOC_ENUM_SINGLE_DECL(wm8958_aif2dac_ng_hold,
 712			    WM8958_AIF2_DAC_NOISE_GATE,
 713			    WM8958_AIF2DAC_NG_THR_SHIFT,
 714			    wm8958_ng_text);
 715
 716static const struct snd_kcontrol_new wm8958_snd_controls[] = {
 717SOC_SINGLE_TLV("AIF3 Boost Volume", WM8958_AIF3_CONTROL_2, 10, 3, 0, aif_tlv),
 718
 719SOC_SINGLE("AIF1DAC1 Noise Gate Switch", WM8958_AIF1_DAC1_NOISE_GATE,
 720	   WM8958_AIF1DAC1_NG_ENA_SHIFT, 1, 0),
 721SOC_ENUM("AIF1DAC1 Noise Gate Hold Time", wm8958_aif1dac1_ng_hold),
 722SOC_SINGLE_TLV("AIF1DAC1 Noise Gate Threshold Volume",
 723	       WM8958_AIF1_DAC1_NOISE_GATE, WM8958_AIF1DAC1_NG_THR_SHIFT,
 724	       7, 1, ng_tlv),
 725
 726SOC_SINGLE("AIF1DAC2 Noise Gate Switch", WM8958_AIF1_DAC2_NOISE_GATE,
 727	   WM8958_AIF1DAC2_NG_ENA_SHIFT, 1, 0),
 728SOC_ENUM("AIF1DAC2 Noise Gate Hold Time", wm8958_aif1dac2_ng_hold),
 729SOC_SINGLE_TLV("AIF1DAC2 Noise Gate Threshold Volume",
 730	       WM8958_AIF1_DAC2_NOISE_GATE, WM8958_AIF1DAC2_NG_THR_SHIFT,
 731	       7, 1, ng_tlv),
 732
 733SOC_SINGLE("AIF2DAC Noise Gate Switch", WM8958_AIF2_DAC_NOISE_GATE,
 734	   WM8958_AIF2DAC_NG_ENA_SHIFT, 1, 0),
 735SOC_ENUM("AIF2DAC Noise Gate Hold Time", wm8958_aif2dac_ng_hold),
 736SOC_SINGLE_TLV("AIF2DAC Noise Gate Threshold Volume",
 737	       WM8958_AIF2_DAC_NOISE_GATE, WM8958_AIF2DAC_NG_THR_SHIFT,
 738	       7, 1, ng_tlv),
 739};
 740
 
 
 
 
 
 
 
 741/* We run all mode setting through a function to enforce audio mode */
 742static void wm1811_jackdet_set_mode(struct snd_soc_component *component, u16 mode)
 743{
 744	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 745
 746	if (!wm8994->jackdet || !wm8994->micdet[0].jack)
 747		return;
 748
 749	if (wm8994->active_refcount)
 750		mode = WM1811_JACKDET_MODE_AUDIO;
 751
 752	if (mode == wm8994->jackdet_mode)
 753		return;
 754
 755	wm8994->jackdet_mode = mode;
 756
 757	/* Always use audio mode to detect while the system is active */
 758	if (mode != WM1811_JACKDET_MODE_NONE)
 759		mode = WM1811_JACKDET_MODE_AUDIO;
 760
 761	snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 762			    WM1811_JACKDET_MODE_MASK, mode);
 763}
 764
 765static void active_reference(struct snd_soc_component *component)
 766{
 767	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 768
 769	mutex_lock(&wm8994->accdet_lock);
 770
 771	wm8994->active_refcount++;
 772
 773	dev_dbg(component->dev, "Active refcount incremented, now %d\n",
 774		wm8994->active_refcount);
 775
 776	/* If we're using jack detection go into audio mode */
 777	wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_AUDIO);
 778
 779	mutex_unlock(&wm8994->accdet_lock);
 780}
 781
 782static void active_dereference(struct snd_soc_component *component)
 783{
 784	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 785	u16 mode;
 786
 787	mutex_lock(&wm8994->accdet_lock);
 788
 789	wm8994->active_refcount--;
 790
 791	dev_dbg(component->dev, "Active refcount decremented, now %d\n",
 792		wm8994->active_refcount);
 793
 794	if (wm8994->active_refcount == 0) {
 795		/* Go into appropriate detection only mode */
 796		if (wm8994->jack_mic || wm8994->mic_detecting)
 797			mode = WM1811_JACKDET_MODE_MIC;
 798		else
 799			mode = WM1811_JACKDET_MODE_JACK;
 800
 801		wm1811_jackdet_set_mode(component, mode);
 802	}
 803
 804	mutex_unlock(&wm8994->accdet_lock);
 805}
 806
 807static int clk_sys_event(struct snd_soc_dapm_widget *w,
 808			 struct snd_kcontrol *kcontrol, int event)
 809{
 810	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 811	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 812
 813	switch (event) {
 814	case SND_SOC_DAPM_PRE_PMU:
 815		return configure_clock(component);
 816
 817	case SND_SOC_DAPM_POST_PMU:
 818		/*
 819		 * JACKDET won't run until we start the clock and it
 820		 * only reports deltas, make sure we notify the state
 821		 * up the stack on startup.  Use a *very* generous
 822		 * timeout for paranoia, there's no urgency and we
 823		 * don't want false reports.
 824		 */
 825		if (wm8994->jackdet && !wm8994->clk_has_run) {
 826			queue_delayed_work(system_power_efficient_wq,
 827					   &wm8994->jackdet_bootstrap,
 828					   msecs_to_jiffies(1000));
 829			wm8994->clk_has_run = true;
 830		}
 831		break;
 832
 833	case SND_SOC_DAPM_POST_PMD:
 834		configure_clock(component);
 835		break;
 836	}
 837
 838	return 0;
 839}
 840
 841static void vmid_reference(struct snd_soc_component *component)
 842{
 843	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 844
 845	pm_runtime_get_sync(component->dev);
 846
 847	wm8994->vmid_refcount++;
 848
 849	dev_dbg(component->dev, "Referencing VMID, refcount is now %d\n",
 850		wm8994->vmid_refcount);
 851
 852	if (wm8994->vmid_refcount == 1) {
 853		snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
 854				    WM8994_LINEOUT1_DISCH |
 855				    WM8994_LINEOUT2_DISCH, 0);
 856
 857		wm_hubs_vmid_ena(component);
 858
 859		switch (wm8994->vmid_mode) {
 860		default:
 861			WARN_ON(NULL == "Invalid VMID mode");
 862			fallthrough;
 863		case WM8994_VMID_NORMAL:
 864			/* Startup bias, VMID ramp & buffer */
 865			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 866					    WM8994_BIAS_SRC |
 867					    WM8994_VMID_DISCH |
 868					    WM8994_STARTUP_BIAS_ENA |
 869					    WM8994_VMID_BUF_ENA |
 870					    WM8994_VMID_RAMP_MASK,
 871					    WM8994_BIAS_SRC |
 872					    WM8994_STARTUP_BIAS_ENA |
 873					    WM8994_VMID_BUF_ENA |
 874					    (0x2 << WM8994_VMID_RAMP_SHIFT));
 875
 876			/* Main bias enable, VMID=2x40k */
 877			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 878					    WM8994_BIAS_ENA |
 879					    WM8994_VMID_SEL_MASK,
 880					    WM8994_BIAS_ENA | 0x2);
 881
 882			msleep(300);
 883
 884			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 885					    WM8994_VMID_RAMP_MASK |
 886					    WM8994_BIAS_SRC,
 887					    0);
 888			break;
 889
 890		case WM8994_VMID_FORCE:
 891			/* Startup bias, slow VMID ramp & buffer */
 892			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 893					    WM8994_BIAS_SRC |
 894					    WM8994_VMID_DISCH |
 895					    WM8994_STARTUP_BIAS_ENA |
 896					    WM8994_VMID_BUF_ENA |
 897					    WM8994_VMID_RAMP_MASK,
 898					    WM8994_BIAS_SRC |
 899					    WM8994_STARTUP_BIAS_ENA |
 900					    WM8994_VMID_BUF_ENA |
 901					    (0x2 << WM8994_VMID_RAMP_SHIFT));
 902
 903			/* Main bias enable, VMID=2x40k */
 904			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 905					    WM8994_BIAS_ENA |
 906					    WM8994_VMID_SEL_MASK,
 907					    WM8994_BIAS_ENA | 0x2);
 908
 909			msleep(400);
 910
 911			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 912					    WM8994_VMID_RAMP_MASK |
 913					    WM8994_BIAS_SRC,
 914					    0);
 915			break;
 916		}
 917	}
 918}
 919
 920static void vmid_dereference(struct snd_soc_component *component)
 921{
 922	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 923
 924	wm8994->vmid_refcount--;
 925
 926	dev_dbg(component->dev, "Dereferencing VMID, refcount is now %d\n",
 927		wm8994->vmid_refcount);
 928
 929	if (wm8994->vmid_refcount == 0) {
 930		if (wm8994->hubs.lineout1_se)
 931			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 932					    WM8994_LINEOUT1N_ENA |
 933					    WM8994_LINEOUT1P_ENA,
 934					    WM8994_LINEOUT1N_ENA |
 935					    WM8994_LINEOUT1P_ENA);
 936
 937		if (wm8994->hubs.lineout2_se)
 938			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 939					    WM8994_LINEOUT2N_ENA |
 940					    WM8994_LINEOUT2P_ENA,
 941					    WM8994_LINEOUT2N_ENA |
 942					    WM8994_LINEOUT2P_ENA);
 943
 944		/* Start discharging VMID */
 945		snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 946				    WM8994_BIAS_SRC |
 947				    WM8994_VMID_DISCH,
 948				    WM8994_BIAS_SRC |
 949				    WM8994_VMID_DISCH);
 950
 951		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 952				    WM8994_VMID_SEL_MASK, 0);
 953
 954		msleep(400);
 955
 956		/* Active discharge */
 957		snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
 958				    WM8994_LINEOUT1_DISCH |
 959				    WM8994_LINEOUT2_DISCH,
 960				    WM8994_LINEOUT1_DISCH |
 961				    WM8994_LINEOUT2_DISCH);
 962
 963		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 964				    WM8994_LINEOUT1N_ENA |
 965				    WM8994_LINEOUT1P_ENA |
 966				    WM8994_LINEOUT2N_ENA |
 967				    WM8994_LINEOUT2P_ENA, 0);
 968
 969		/* Switch off startup biases */
 970		snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 971				    WM8994_BIAS_SRC |
 972				    WM8994_STARTUP_BIAS_ENA |
 973				    WM8994_VMID_BUF_ENA |
 974				    WM8994_VMID_RAMP_MASK, 0);
 975
 976		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 977				    WM8994_VMID_SEL_MASK, 0);
 978	}
 979
 980	pm_runtime_put(component->dev);
 981}
 982
 983static int vmid_event(struct snd_soc_dapm_widget *w,
 984		      struct snd_kcontrol *kcontrol, int event)
 985{
 986	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 987
 988	switch (event) {
 989	case SND_SOC_DAPM_PRE_PMU:
 990		vmid_reference(component);
 991		break;
 992
 993	case SND_SOC_DAPM_POST_PMD:
 994		vmid_dereference(component);
 995		break;
 996	}
 997
 998	return 0;
 999}
1000
1001static bool wm8994_check_class_w_digital(struct snd_soc_component *component)
1002{
1003	int source = 0;  /* GCC flow analysis can't track enable */
1004	int reg, reg_r;
1005
1006	/* We also need the same AIF source for L/R and only one path */
1007	reg = snd_soc_component_read(component, WM8994_DAC1_LEFT_MIXER_ROUTING);
1008	switch (reg) {
1009	case WM8994_AIF2DACL_TO_DAC1L:
1010		dev_vdbg(component->dev, "Class W source AIF2DAC\n");
1011		source = 2 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1012		break;
1013	case WM8994_AIF1DAC2L_TO_DAC1L:
1014		dev_vdbg(component->dev, "Class W source AIF1DAC2\n");
1015		source = 1 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1016		break;
1017	case WM8994_AIF1DAC1L_TO_DAC1L:
1018		dev_vdbg(component->dev, "Class W source AIF1DAC1\n");
1019		source = 0 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1020		break;
1021	default:
1022		dev_vdbg(component->dev, "DAC mixer setting: %x\n", reg);
1023		return false;
1024	}
1025
1026	reg_r = snd_soc_component_read(component, WM8994_DAC1_RIGHT_MIXER_ROUTING);
1027	if (reg_r != reg) {
1028		dev_vdbg(component->dev, "Left and right DAC mixers different\n");
1029		return false;
1030	}
1031
1032	/* Set the source up */
1033	snd_soc_component_update_bits(component, WM8994_CLASS_W_1,
1034			    WM8994_CP_DYN_SRC_SEL_MASK, source);
1035
1036	return true;
1037}
1038
1039static void wm8994_update_vu_bits(struct snd_soc_component *component)
1040{
1041	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1042	struct wm8994 *control = wm8994->wm8994;
1043	int i;
1044
1045	for (i = 0; i < ARRAY_SIZE(wm8994_vu_bits); i++)
1046		snd_soc_component_write(component, wm8994_vu_bits[i].reg,
1047					snd_soc_component_read(component,
1048						       wm8994_vu_bits[i].reg));
1049	if (control->type == WM1811)
1050		return;
1051
1052	for (i = 0; i < ARRAY_SIZE(wm8994_adc2_dac2_vu_bits); i++)
1053		snd_soc_component_write(component,
1054				wm8994_adc2_dac2_vu_bits[i].reg,
1055				snd_soc_component_read(component,
1056					wm8994_adc2_dac2_vu_bits[i].reg));
1057}
1058
1059static int aif_mclk_set(struct snd_soc_component *component, int aif, bool enable)
1060{
1061	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1062	unsigned int offset, val, clk_idx;
1063	int ret;
1064
1065	if (aif)
1066		offset = 4;
1067	else
1068		offset = 0;
1069
1070	val = snd_soc_component_read(component, WM8994_AIF1_CLOCKING_1 + offset);
1071	val &= WM8994_AIF1CLK_SRC_MASK;
1072
1073	switch (val) {
1074	case 0:
1075		clk_idx = WM8994_MCLK1;
1076		break;
1077	case 1:
1078		clk_idx = WM8994_MCLK2;
1079		break;
1080	default:
1081		return 0;
1082	}
1083
1084	if (enable) {
1085		ret = clk_prepare_enable(wm8994->mclk[clk_idx].clk);
1086		if (ret < 0) {
1087			dev_err(component->dev,	"Failed to enable MCLK%d\n",
1088				clk_idx);
1089			return ret;
1090		}
1091	} else {
1092		clk_disable_unprepare(wm8994->mclk[clk_idx].clk);
1093	}
1094
1095	return 0;
1096}
1097
1098static int aif1clk_ev(struct snd_soc_dapm_widget *w,
1099		      struct snd_kcontrol *kcontrol, int event)
1100{
1101	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1102	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1103	struct wm8994 *control = wm8994->wm8994;
1104	int mask = WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA;
1105	int ret;
1106	int dac;
1107	int adc;
1108	int val;
1109
1110	switch (control->type) {
1111	case WM8994:
1112	case WM8958:
1113		mask |= WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA;
1114		break;
1115	default:
1116		break;
1117	}
1118
1119	switch (event) {
1120	case SND_SOC_DAPM_PRE_PMU:
1121		ret = aif_mclk_set(component, 0, true);
1122		if (ret < 0)
1123			return ret;
1124
1125		/* Don't enable timeslot 2 if not in use */
1126		if (wm8994->channels[0] <= 2)
1127			mask &= ~(WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA);
1128
1129		val = snd_soc_component_read(component, WM8994_AIF1_CONTROL_1);
1130		if ((val & WM8994_AIF1ADCL_SRC) &&
1131		    (val & WM8994_AIF1ADCR_SRC))
1132			adc = WM8994_AIF1ADC1R_ENA | WM8994_AIF1ADC2R_ENA;
1133		else if (!(val & WM8994_AIF1ADCL_SRC) &&
1134			 !(val & WM8994_AIF1ADCR_SRC))
1135			adc = WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC2L_ENA;
1136		else
1137			adc = WM8994_AIF1ADC1R_ENA | WM8994_AIF1ADC2R_ENA |
1138				WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC2L_ENA;
1139
1140		val = snd_soc_component_read(component, WM8994_AIF1_CONTROL_2);
1141		if ((val & WM8994_AIF1DACL_SRC) &&
1142		    (val & WM8994_AIF1DACR_SRC))
1143			dac = WM8994_AIF1DAC1R_ENA | WM8994_AIF1DAC2R_ENA;
1144		else if (!(val & WM8994_AIF1DACL_SRC) &&
1145			 !(val & WM8994_AIF1DACR_SRC))
1146			dac = WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC2L_ENA;
1147		else
1148			dac = WM8994_AIF1DAC1R_ENA | WM8994_AIF1DAC2R_ENA |
1149				WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC2L_ENA;
1150
1151		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1152				    mask, adc);
1153		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1154				    mask, dac);
1155		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1156				    WM8994_AIF1DSPCLK_ENA |
1157				    WM8994_SYSDSPCLK_ENA,
1158				    WM8994_AIF1DSPCLK_ENA |
1159				    WM8994_SYSDSPCLK_ENA);
1160		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4, mask,
1161				    WM8994_AIF1ADC1R_ENA |
1162				    WM8994_AIF1ADC1L_ENA |
1163				    WM8994_AIF1ADC2R_ENA |
1164				    WM8994_AIF1ADC2L_ENA);
1165		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5, mask,
1166				    WM8994_AIF1DAC1R_ENA |
1167				    WM8994_AIF1DAC1L_ENA |
1168				    WM8994_AIF1DAC2R_ENA |
1169				    WM8994_AIF1DAC2L_ENA);
1170		break;
1171
1172	case SND_SOC_DAPM_POST_PMU:
1173		wm8994_update_vu_bits(component);
 
 
 
1174		break;
1175
1176	case SND_SOC_DAPM_PRE_PMD:
1177	case SND_SOC_DAPM_POST_PMD:
1178		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1179				    mask, 0);
1180		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1181				    mask, 0);
1182
1183		val = snd_soc_component_read(component, WM8994_CLOCKING_1);
1184		if (val & WM8994_AIF2DSPCLK_ENA)
1185			val = WM8994_SYSDSPCLK_ENA;
1186		else
1187			val = 0;
1188		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1189				    WM8994_SYSDSPCLK_ENA |
1190				    WM8994_AIF1DSPCLK_ENA, val);
1191		break;
1192	}
1193
1194	switch (event) {
1195	case SND_SOC_DAPM_POST_PMD:
1196		aif_mclk_set(component, 0, false);
1197		break;
1198	}
1199
1200	return 0;
1201}
1202
1203static int aif2clk_ev(struct snd_soc_dapm_widget *w,
1204		      struct snd_kcontrol *kcontrol, int event)
1205{
1206	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1207	int ret;
1208	int dac;
1209	int adc;
1210	int val;
1211
1212	switch (event) {
1213	case SND_SOC_DAPM_PRE_PMU:
1214		ret = aif_mclk_set(component, 1, true);
1215		if (ret < 0)
1216			return ret;
1217
1218		val = snd_soc_component_read(component, WM8994_AIF2_CONTROL_1);
1219		if ((val & WM8994_AIF2ADCL_SRC) &&
1220		    (val & WM8994_AIF2ADCR_SRC))
1221			adc = WM8994_AIF2ADCR_ENA;
1222		else if (!(val & WM8994_AIF2ADCL_SRC) &&
1223			 !(val & WM8994_AIF2ADCR_SRC))
1224			adc = WM8994_AIF2ADCL_ENA;
1225		else
1226			adc = WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA;
1227
1228
1229		val = snd_soc_component_read(component, WM8994_AIF2_CONTROL_2);
1230		if ((val & WM8994_AIF2DACL_SRC) &&
1231		    (val & WM8994_AIF2DACR_SRC))
1232			dac = WM8994_AIF2DACR_ENA;
1233		else if (!(val & WM8994_AIF2DACL_SRC) &&
1234			 !(val & WM8994_AIF2DACR_SRC))
1235			dac = WM8994_AIF2DACL_ENA;
1236		else
1237			dac = WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA;
1238
1239		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1240				    WM8994_AIF2ADCL_ENA |
1241				    WM8994_AIF2ADCR_ENA, adc);
1242		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1243				    WM8994_AIF2DACL_ENA |
1244				    WM8994_AIF2DACR_ENA, dac);
1245		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1246				    WM8994_AIF2DSPCLK_ENA |
1247				    WM8994_SYSDSPCLK_ENA,
1248				    WM8994_AIF2DSPCLK_ENA |
1249				    WM8994_SYSDSPCLK_ENA);
1250		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1251				    WM8994_AIF2ADCL_ENA |
1252				    WM8994_AIF2ADCR_ENA,
1253				    WM8994_AIF2ADCL_ENA |
1254				    WM8994_AIF2ADCR_ENA);
1255		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1256				    WM8994_AIF2DACL_ENA |
1257				    WM8994_AIF2DACR_ENA,
1258				    WM8994_AIF2DACL_ENA |
1259				    WM8994_AIF2DACR_ENA);
1260		break;
1261
1262	case SND_SOC_DAPM_POST_PMU:
1263		wm8994_update_vu_bits(component);
 
 
 
1264		break;
1265
1266	case SND_SOC_DAPM_PRE_PMD:
1267	case SND_SOC_DAPM_POST_PMD:
1268		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1269				    WM8994_AIF2DACL_ENA |
1270				    WM8994_AIF2DACR_ENA, 0);
1271		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1272				    WM8994_AIF2ADCL_ENA |
1273				    WM8994_AIF2ADCR_ENA, 0);
1274
1275		val = snd_soc_component_read(component, WM8994_CLOCKING_1);
1276		if (val & WM8994_AIF1DSPCLK_ENA)
1277			val = WM8994_SYSDSPCLK_ENA;
1278		else
1279			val = 0;
1280		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1281				    WM8994_SYSDSPCLK_ENA |
1282				    WM8994_AIF2DSPCLK_ENA, val);
1283		break;
1284	}
1285
1286	switch (event) {
1287	case SND_SOC_DAPM_POST_PMD:
1288		aif_mclk_set(component, 1, false);
1289		break;
1290	}
1291
1292	return 0;
1293}
1294
1295static int aif1clk_late_ev(struct snd_soc_dapm_widget *w,
1296			   struct snd_kcontrol *kcontrol, int event)
1297{
1298	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1299	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1300
1301	switch (event) {
1302	case SND_SOC_DAPM_PRE_PMU:
1303		wm8994->aif1clk_enable = 1;
1304		break;
1305	case SND_SOC_DAPM_POST_PMD:
1306		wm8994->aif1clk_disable = 1;
1307		break;
1308	}
1309
1310	return 0;
1311}
1312
1313static int aif2clk_late_ev(struct snd_soc_dapm_widget *w,
1314			   struct snd_kcontrol *kcontrol, int event)
1315{
1316	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1317	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1318
1319	switch (event) {
1320	case SND_SOC_DAPM_PRE_PMU:
1321		wm8994->aif2clk_enable = 1;
1322		break;
1323	case SND_SOC_DAPM_POST_PMD:
1324		wm8994->aif2clk_disable = 1;
1325		break;
1326	}
1327
1328	return 0;
1329}
1330
1331static int late_enable_ev(struct snd_soc_dapm_widget *w,
1332			  struct snd_kcontrol *kcontrol, int event)
1333{
1334	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1335	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1336
1337	switch (event) {
1338	case SND_SOC_DAPM_PRE_PMU:
1339		if (wm8994->aif1clk_enable) {
1340			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMU);
1341			snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1,
1342					    WM8994_AIF1CLK_ENA_MASK,
1343					    WM8994_AIF1CLK_ENA);
1344			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMU);
1345			wm8994->aif1clk_enable = 0;
1346		}
1347		if (wm8994->aif2clk_enable) {
1348			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMU);
1349			snd_soc_component_update_bits(component, WM8994_AIF2_CLOCKING_1,
1350					    WM8994_AIF2CLK_ENA_MASK,
1351					    WM8994_AIF2CLK_ENA);
1352			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMU);
1353			wm8994->aif2clk_enable = 0;
1354		}
1355		break;
1356	}
1357
1358	/* We may also have postponed startup of DSP, handle that. */
1359	wm8958_aif_ev(w, kcontrol, event);
1360
1361	return 0;
1362}
1363
1364static int late_disable_ev(struct snd_soc_dapm_widget *w,
1365			   struct snd_kcontrol *kcontrol, int event)
1366{
1367	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1368	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1369
1370	switch (event) {
1371	case SND_SOC_DAPM_POST_PMD:
1372		if (wm8994->aif1clk_disable) {
1373			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMD);
1374			snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1,
1375					    WM8994_AIF1CLK_ENA_MASK, 0);
1376			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMD);
1377			wm8994->aif1clk_disable = 0;
1378		}
1379		if (wm8994->aif2clk_disable) {
1380			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMD);
1381			snd_soc_component_update_bits(component, WM8994_AIF2_CLOCKING_1,
1382					    WM8994_AIF2CLK_ENA_MASK, 0);
1383			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMD);
1384			wm8994->aif2clk_disable = 0;
1385		}
1386		break;
1387	}
1388
1389	return 0;
1390}
1391
1392static int adc_mux_ev(struct snd_soc_dapm_widget *w,
1393		      struct snd_kcontrol *kcontrol, int event)
1394{
1395	late_enable_ev(w, kcontrol, event);
1396	return 0;
1397}
1398
1399static int micbias_ev(struct snd_soc_dapm_widget *w,
1400		      struct snd_kcontrol *kcontrol, int event)
1401{
1402	late_enable_ev(w, kcontrol, event);
1403	return 0;
1404}
1405
1406static int dac_ev(struct snd_soc_dapm_widget *w,
1407		  struct snd_kcontrol *kcontrol, int event)
1408{
1409	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1410	unsigned int mask = 1 << w->shift;
1411
1412	snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1413			    mask, mask);
1414	return 0;
1415}
1416
1417static const char *adc_mux_text[] = {
1418	"ADC",
1419	"DMIC",
1420};
1421
1422static SOC_ENUM_SINGLE_VIRT_DECL(adc_enum, adc_mux_text);
1423
1424static const struct snd_kcontrol_new adcl_mux =
1425	SOC_DAPM_ENUM("ADCL Mux", adc_enum);
1426
1427static const struct snd_kcontrol_new adcr_mux =
1428	SOC_DAPM_ENUM("ADCR Mux", adc_enum);
1429
1430static const struct snd_kcontrol_new left_speaker_mixer[] = {
1431SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 9, 1, 0),
1432SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 7, 1, 0),
1433SOC_DAPM_SINGLE("IN1LP Switch", WM8994_SPEAKER_MIXER, 5, 1, 0),
1434SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 3, 1, 0),
1435SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 1, 1, 0),
1436};
1437
1438static const struct snd_kcontrol_new right_speaker_mixer[] = {
1439SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 8, 1, 0),
1440SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 6, 1, 0),
1441SOC_DAPM_SINGLE("IN1RP Switch", WM8994_SPEAKER_MIXER, 4, 1, 0),
1442SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 2, 1, 0),
1443SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 0, 1, 0),
1444};
1445
1446/* Debugging; dump chip status after DAPM transitions */
1447static int post_ev(struct snd_soc_dapm_widget *w,
1448	    struct snd_kcontrol *kcontrol, int event)
1449{
1450	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1451	dev_dbg(component->dev, "SRC status: %x\n",
1452		snd_soc_component_read(component,
1453			     WM8994_RATE_STATUS));
1454	return 0;
1455}
1456
1457static const struct snd_kcontrol_new aif1adc1l_mix[] = {
1458SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1459		1, 1, 0),
1460SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1461		0, 1, 0),
1462};
1463
1464static const struct snd_kcontrol_new aif1adc1r_mix[] = {
1465SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1466		1, 1, 0),
1467SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1468		0, 1, 0),
1469};
1470
1471static const struct snd_kcontrol_new aif1adc2l_mix[] = {
1472SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1473		1, 1, 0),
1474SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1475		0, 1, 0),
1476};
1477
1478static const struct snd_kcontrol_new aif1adc2r_mix[] = {
1479SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1480		1, 1, 0),
1481SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1482		0, 1, 0),
1483};
1484
1485static const struct snd_kcontrol_new aif2dac2l_mix[] = {
1486SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1487		5, 1, 0),
1488SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1489		4, 1, 0),
1490SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1491		2, 1, 0),
1492SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1493		1, 1, 0),
1494SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1495		0, 1, 0),
1496};
1497
1498static const struct snd_kcontrol_new aif2dac2r_mix[] = {
1499SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1500		5, 1, 0),
1501SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1502		4, 1, 0),
1503SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1504		2, 1, 0),
1505SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1506		1, 1, 0),
1507SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1508		0, 1, 0),
1509};
1510
1511#define WM8994_CLASS_W_SWITCH(xname, reg, shift, max, invert) \
1512	SOC_SINGLE_EXT(xname, reg, shift, max, invert, \
1513		snd_soc_dapm_get_volsw, wm8994_put_class_w)
1514
1515static int wm8994_put_class_w(struct snd_kcontrol *kcontrol,
1516			      struct snd_ctl_elem_value *ucontrol)
1517{
1518	struct snd_soc_component *component = snd_soc_dapm_kcontrol_component(kcontrol);
1519	int ret;
1520
1521	ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol);
1522
1523	wm_hubs_update_class_w(component);
1524
1525	return ret;
1526}
1527
1528static const struct snd_kcontrol_new dac1l_mix[] = {
1529WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1530		      5, 1, 0),
1531WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1532		      4, 1, 0),
1533WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1534		      2, 1, 0),
1535WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1536		      1, 1, 0),
1537WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1538		      0, 1, 0),
1539};
1540
1541static const struct snd_kcontrol_new dac1r_mix[] = {
1542WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1543		      5, 1, 0),
1544WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1545		      4, 1, 0),
1546WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1547		      2, 1, 0),
1548WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1549		      1, 1, 0),
1550WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1551		      0, 1, 0),
1552};
1553
1554static const char *sidetone_text[] = {
1555	"ADC/DMIC1", "DMIC2",
1556};
1557
1558static SOC_ENUM_SINGLE_DECL(sidetone1_enum,
1559			    WM8994_SIDETONE, 0, sidetone_text);
1560
1561static const struct snd_kcontrol_new sidetone1_mux =
1562	SOC_DAPM_ENUM("Left Sidetone Mux", sidetone1_enum);
1563
1564static SOC_ENUM_SINGLE_DECL(sidetone2_enum,
1565			    WM8994_SIDETONE, 1, sidetone_text);
1566
1567static const struct snd_kcontrol_new sidetone2_mux =
1568	SOC_DAPM_ENUM("Right Sidetone Mux", sidetone2_enum);
1569
1570static const char *aif1dac_text[] = {
1571	"AIF1DACDAT", "AIF3DACDAT",
1572};
1573
1574static const char *loopback_text[] = {
1575	"None", "ADCDAT",
1576};
1577
1578static SOC_ENUM_SINGLE_DECL(aif1_loopback_enum,
1579			    WM8994_AIF1_CONTROL_2,
1580			    WM8994_AIF1_LOOPBACK_SHIFT,
1581			    loopback_text);
1582
1583static const struct snd_kcontrol_new aif1_loopback =
1584	SOC_DAPM_ENUM("AIF1 Loopback", aif1_loopback_enum);
1585
1586static SOC_ENUM_SINGLE_DECL(aif2_loopback_enum,
1587			    WM8994_AIF2_CONTROL_2,
1588			    WM8994_AIF2_LOOPBACK_SHIFT,
1589			    loopback_text);
1590
1591static const struct snd_kcontrol_new aif2_loopback =
1592	SOC_DAPM_ENUM("AIF2 Loopback", aif2_loopback_enum);
1593
1594static SOC_ENUM_SINGLE_DECL(aif1dac_enum,
1595			    WM8994_POWER_MANAGEMENT_6, 0, aif1dac_text);
1596
1597static const struct snd_kcontrol_new aif1dac_mux =
1598	SOC_DAPM_ENUM("AIF1DAC Mux", aif1dac_enum);
1599
1600static const char *aif2dac_text[] = {
1601	"AIF2DACDAT", "AIF3DACDAT",
1602};
1603
1604static SOC_ENUM_SINGLE_DECL(aif2dac_enum,
1605			    WM8994_POWER_MANAGEMENT_6, 1, aif2dac_text);
1606
1607static const struct snd_kcontrol_new aif2dac_mux =
1608	SOC_DAPM_ENUM("AIF2DAC Mux", aif2dac_enum);
1609
1610static const char *aif2adc_text[] = {
1611	"AIF2ADCDAT", "AIF3DACDAT",
1612};
1613
1614static SOC_ENUM_SINGLE_DECL(aif2adc_enum,
1615			    WM8994_POWER_MANAGEMENT_6, 2, aif2adc_text);
1616
1617static const struct snd_kcontrol_new aif2adc_mux =
1618	SOC_DAPM_ENUM("AIF2ADC Mux", aif2adc_enum);
1619
1620static const char *aif3adc_text[] = {
1621	"AIF1ADCDAT", "AIF2ADCDAT", "AIF2DACDAT", "Mono PCM",
1622};
1623
1624static SOC_ENUM_SINGLE_DECL(wm8994_aif3adc_enum,
1625			    WM8994_POWER_MANAGEMENT_6, 3, aif3adc_text);
1626
1627static const struct snd_kcontrol_new wm8994_aif3adc_mux =
1628	SOC_DAPM_ENUM("AIF3ADC Mux", wm8994_aif3adc_enum);
1629
1630static SOC_ENUM_SINGLE_DECL(wm8958_aif3adc_enum,
1631			    WM8994_POWER_MANAGEMENT_6, 3, aif3adc_text);
1632
1633static const struct snd_kcontrol_new wm8958_aif3adc_mux =
1634	SOC_DAPM_ENUM("AIF3ADC Mux", wm8958_aif3adc_enum);
1635
1636static const char *mono_pcm_out_text[] = {
1637	"None", "AIF2ADCL", "AIF2ADCR",
1638};
1639
1640static SOC_ENUM_SINGLE_DECL(mono_pcm_out_enum,
1641			    WM8994_POWER_MANAGEMENT_6, 9, mono_pcm_out_text);
1642
1643static const struct snd_kcontrol_new mono_pcm_out_mux =
1644	SOC_DAPM_ENUM("Mono PCM Out Mux", mono_pcm_out_enum);
1645
1646static const char *aif2dac_src_text[] = {
1647	"AIF2", "AIF3",
1648};
1649
1650/* Note that these two control shouldn't be simultaneously switched to AIF3 */
1651static SOC_ENUM_SINGLE_DECL(aif2dacl_src_enum,
1652			    WM8994_POWER_MANAGEMENT_6, 7, aif2dac_src_text);
1653
1654static const struct snd_kcontrol_new aif2dacl_src_mux =
1655	SOC_DAPM_ENUM("AIF2DACL Mux", aif2dacl_src_enum);
1656
1657static SOC_ENUM_SINGLE_DECL(aif2dacr_src_enum,
1658			    WM8994_POWER_MANAGEMENT_6, 8, aif2dac_src_text);
1659
1660static const struct snd_kcontrol_new aif2dacr_src_mux =
1661	SOC_DAPM_ENUM("AIF2DACR Mux", aif2dacr_src_enum);
1662
1663static const struct snd_soc_dapm_widget wm8994_lateclk_revd_widgets[] = {
1664SND_SOC_DAPM_SUPPLY("AIF1CLK", SND_SOC_NOPM, 0, 0, aif1clk_late_ev,
1665	SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1666SND_SOC_DAPM_SUPPLY("AIF2CLK", SND_SOC_NOPM, 0, 0, aif2clk_late_ev,
1667	SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1668
1669SND_SOC_DAPM_PGA_E("Late DAC1L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1670	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1671SND_SOC_DAPM_PGA_E("Late DAC1R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1672	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1673SND_SOC_DAPM_PGA_E("Late DAC2L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1674	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1675SND_SOC_DAPM_PGA_E("Late DAC2R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1676	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1677SND_SOC_DAPM_PGA_E("Direct Voice", SND_SOC_NOPM, 0, 0, NULL, 0,
1678	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1679
1680SND_SOC_DAPM_MIXER_E("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0,
1681		     left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer),
1682		     late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1683SND_SOC_DAPM_MIXER_E("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0,
1684		     right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer),
1685		     late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1686SND_SOC_DAPM_MUX_E("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpl_mux,
1687		   late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1688SND_SOC_DAPM_MUX_E("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpr_mux,
1689		   late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1690
1691SND_SOC_DAPM_POST("Late Disable PGA", late_disable_ev)
1692};
1693
1694static const struct snd_soc_dapm_widget wm8994_lateclk_widgets[] = {
1695SND_SOC_DAPM_SUPPLY("AIF1CLK", WM8994_AIF1_CLOCKING_1, 0, 0, aif1clk_ev,
1696		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1697		    SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1698SND_SOC_DAPM_SUPPLY("AIF2CLK", WM8994_AIF2_CLOCKING_1, 0, 0, aif2clk_ev,
1699		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1700		    SND_SOC_DAPM_PRE_PMD | SND_SOC_DAPM_POST_PMD),
1701SND_SOC_DAPM_PGA("Direct Voice", SND_SOC_NOPM, 0, 0, NULL, 0),
1702SND_SOC_DAPM_MIXER("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0,
1703		   left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)),
1704SND_SOC_DAPM_MIXER("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0,
1705		   right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)),
1706SND_SOC_DAPM_MUX("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpl_mux),
1707SND_SOC_DAPM_MUX("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpr_mux),
1708};
1709
1710static const struct snd_soc_dapm_widget wm8994_dac_revd_widgets[] = {
1711SND_SOC_DAPM_DAC_E("DAC2L", NULL, SND_SOC_NOPM, 3, 0,
1712	dac_ev, SND_SOC_DAPM_PRE_PMU),
1713SND_SOC_DAPM_DAC_E("DAC2R", NULL, SND_SOC_NOPM, 2, 0,
1714	dac_ev, SND_SOC_DAPM_PRE_PMU),
1715SND_SOC_DAPM_DAC_E("DAC1L", NULL, SND_SOC_NOPM, 1, 0,
1716	dac_ev, SND_SOC_DAPM_PRE_PMU),
1717SND_SOC_DAPM_DAC_E("DAC1R", NULL, SND_SOC_NOPM, 0, 0,
1718	dac_ev, SND_SOC_DAPM_PRE_PMU),
1719};
1720
1721static const struct snd_soc_dapm_widget wm8994_dac_widgets[] = {
1722SND_SOC_DAPM_DAC("DAC2L", NULL, WM8994_POWER_MANAGEMENT_5, 3, 0),
1723SND_SOC_DAPM_DAC("DAC2R", NULL, WM8994_POWER_MANAGEMENT_5, 2, 0),
1724SND_SOC_DAPM_DAC("DAC1L", NULL, WM8994_POWER_MANAGEMENT_5, 1, 0),
1725SND_SOC_DAPM_DAC("DAC1R", NULL, WM8994_POWER_MANAGEMENT_5, 0, 0),
1726};
1727
1728static const struct snd_soc_dapm_widget wm8994_adc_revd_widgets[] = {
1729SND_SOC_DAPM_MUX_E("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux,
1730			adc_mux_ev, SND_SOC_DAPM_PRE_PMU),
1731SND_SOC_DAPM_MUX_E("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux,
1732			adc_mux_ev, SND_SOC_DAPM_PRE_PMU),
1733};
1734
1735static const struct snd_soc_dapm_widget wm8994_adc_widgets[] = {
1736SND_SOC_DAPM_MUX("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux),
1737SND_SOC_DAPM_MUX("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux),
1738};
1739
1740static const struct snd_soc_dapm_widget wm8994_dapm_widgets[] = {
1741SND_SOC_DAPM_INPUT("DMIC1DAT"),
1742SND_SOC_DAPM_INPUT("DMIC2DAT"),
1743SND_SOC_DAPM_INPUT("Clock"),
1744
1745SND_SOC_DAPM_SUPPLY_S("MICBIAS Supply", 1, SND_SOC_NOPM, 0, 0, micbias_ev,
1746		      SND_SOC_DAPM_PRE_PMU),
1747SND_SOC_DAPM_SUPPLY("VMID", SND_SOC_NOPM, 0, 0, vmid_event,
1748		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1749
1750SND_SOC_DAPM_SUPPLY("CLK_SYS", SND_SOC_NOPM, 0, 0, clk_sys_event,
1751		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1752		    SND_SOC_DAPM_PRE_PMD),
1753
1754SND_SOC_DAPM_SUPPLY("DSP1CLK", SND_SOC_NOPM, 3, 0, NULL, 0),
1755SND_SOC_DAPM_SUPPLY("DSP2CLK", SND_SOC_NOPM, 2, 0, NULL, 0),
1756SND_SOC_DAPM_SUPPLY("DSPINTCLK", SND_SOC_NOPM, 1, 0, NULL, 0),
1757
1758SND_SOC_DAPM_AIF_OUT("AIF1ADC1L", NULL,
1759		     0, SND_SOC_NOPM, 9, 0),
1760SND_SOC_DAPM_AIF_OUT("AIF1ADC1R", NULL,
1761		     0, SND_SOC_NOPM, 8, 0),
1762SND_SOC_DAPM_AIF_IN_E("AIF1DAC1L", NULL, 0,
1763		      SND_SOC_NOPM, 9, 0, wm8958_aif_ev,
1764		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1765SND_SOC_DAPM_AIF_IN_E("AIF1DAC1R", NULL, 0,
1766		      SND_SOC_NOPM, 8, 0, wm8958_aif_ev,
1767		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1768
1769SND_SOC_DAPM_AIF_OUT("AIF1ADC2L", NULL,
1770		     0, SND_SOC_NOPM, 11, 0),
1771SND_SOC_DAPM_AIF_OUT("AIF1ADC2R", NULL,
1772		     0, SND_SOC_NOPM, 10, 0),
1773SND_SOC_DAPM_AIF_IN_E("AIF1DAC2L", NULL, 0,
1774		      SND_SOC_NOPM, 11, 0, wm8958_aif_ev,
1775		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1776SND_SOC_DAPM_AIF_IN_E("AIF1DAC2R", NULL, 0,
1777		      SND_SOC_NOPM, 10, 0, wm8958_aif_ev,
1778		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1779
1780SND_SOC_DAPM_MIXER("AIF1ADC1L Mixer", SND_SOC_NOPM, 0, 0,
1781		   aif1adc1l_mix, ARRAY_SIZE(aif1adc1l_mix)),
1782SND_SOC_DAPM_MIXER("AIF1ADC1R Mixer", SND_SOC_NOPM, 0, 0,
1783		   aif1adc1r_mix, ARRAY_SIZE(aif1adc1r_mix)),
1784
1785SND_SOC_DAPM_MIXER("AIF1ADC2L Mixer", SND_SOC_NOPM, 0, 0,
1786		   aif1adc2l_mix, ARRAY_SIZE(aif1adc2l_mix)),
1787SND_SOC_DAPM_MIXER("AIF1ADC2R Mixer", SND_SOC_NOPM, 0, 0,
1788		   aif1adc2r_mix, ARRAY_SIZE(aif1adc2r_mix)),
1789
1790SND_SOC_DAPM_MIXER("AIF2DAC2L Mixer", SND_SOC_NOPM, 0, 0,
1791		   aif2dac2l_mix, ARRAY_SIZE(aif2dac2l_mix)),
1792SND_SOC_DAPM_MIXER("AIF2DAC2R Mixer", SND_SOC_NOPM, 0, 0,
1793		   aif2dac2r_mix, ARRAY_SIZE(aif2dac2r_mix)),
1794
1795SND_SOC_DAPM_MUX("Left Sidetone", SND_SOC_NOPM, 0, 0, &sidetone1_mux),
1796SND_SOC_DAPM_MUX("Right Sidetone", SND_SOC_NOPM, 0, 0, &sidetone2_mux),
1797
1798SND_SOC_DAPM_MIXER("DAC1L Mixer", SND_SOC_NOPM, 0, 0,
1799		   dac1l_mix, ARRAY_SIZE(dac1l_mix)),
1800SND_SOC_DAPM_MIXER("DAC1R Mixer", SND_SOC_NOPM, 0, 0,
1801		   dac1r_mix, ARRAY_SIZE(dac1r_mix)),
1802
1803SND_SOC_DAPM_AIF_OUT("AIF2ADCL", NULL, 0,
1804		     SND_SOC_NOPM, 13, 0),
1805SND_SOC_DAPM_AIF_OUT("AIF2ADCR", NULL, 0,
1806		     SND_SOC_NOPM, 12, 0),
1807SND_SOC_DAPM_AIF_IN_E("AIF2DACL", NULL, 0,
1808		      SND_SOC_NOPM, 13, 0, wm8958_aif_ev,
1809		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1810SND_SOC_DAPM_AIF_IN_E("AIF2DACR", NULL, 0,
1811		      SND_SOC_NOPM, 12, 0, wm8958_aif_ev,
1812		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1813
1814SND_SOC_DAPM_AIF_IN("AIF1DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1815SND_SOC_DAPM_AIF_IN("AIF2DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1816SND_SOC_DAPM_AIF_OUT("AIF1ADCDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1817SND_SOC_DAPM_AIF_OUT("AIF2ADCDAT",  NULL, 0, SND_SOC_NOPM, 0, 0),
1818
1819SND_SOC_DAPM_MUX("AIF1DAC Mux", SND_SOC_NOPM, 0, 0, &aif1dac_mux),
1820SND_SOC_DAPM_MUX("AIF2DAC Mux", SND_SOC_NOPM, 0, 0, &aif2dac_mux),
1821SND_SOC_DAPM_MUX("AIF2ADC Mux", SND_SOC_NOPM, 0, 0, &aif2adc_mux),
1822
1823SND_SOC_DAPM_AIF_IN("AIF3DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1824SND_SOC_DAPM_AIF_OUT("AIF3ADCDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1825
1826SND_SOC_DAPM_SUPPLY("TOCLK", WM8994_CLOCKING_1, 4, 0, NULL, 0),
1827
1828SND_SOC_DAPM_ADC("DMIC2L", NULL, WM8994_POWER_MANAGEMENT_4, 5, 0),
1829SND_SOC_DAPM_ADC("DMIC2R", NULL, WM8994_POWER_MANAGEMENT_4, 4, 0),
1830SND_SOC_DAPM_ADC("DMIC1L", NULL, WM8994_POWER_MANAGEMENT_4, 3, 0),
1831SND_SOC_DAPM_ADC("DMIC1R", NULL, WM8994_POWER_MANAGEMENT_4, 2, 0),
1832
1833/* Power is done with the muxes since the ADC power also controls the
1834 * downsampling chain, the chip will automatically manage the analogue
1835 * specific portions.
1836 */
1837SND_SOC_DAPM_ADC("ADCL", NULL, SND_SOC_NOPM, 1, 0),
1838SND_SOC_DAPM_ADC("ADCR", NULL, SND_SOC_NOPM, 0, 0),
1839
1840SND_SOC_DAPM_MUX("AIF1 Loopback", SND_SOC_NOPM, 0, 0, &aif1_loopback),
1841SND_SOC_DAPM_MUX("AIF2 Loopback", SND_SOC_NOPM, 0, 0, &aif2_loopback),
1842
1843SND_SOC_DAPM_POST("Debug log", post_ev),
1844};
1845
1846static const struct snd_soc_dapm_widget wm8994_specific_dapm_widgets[] = {
1847SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8994_aif3adc_mux),
1848};
1849
1850static const struct snd_soc_dapm_widget wm8958_dapm_widgets[] = {
1851SND_SOC_DAPM_SUPPLY("AIF3", WM8994_POWER_MANAGEMENT_6, 5, 1, NULL, 0),
1852SND_SOC_DAPM_MUX("Mono PCM Out Mux", SND_SOC_NOPM, 0, 0, &mono_pcm_out_mux),
1853SND_SOC_DAPM_MUX("AIF2DACL Mux", SND_SOC_NOPM, 0, 0, &aif2dacl_src_mux),
1854SND_SOC_DAPM_MUX("AIF2DACR Mux", SND_SOC_NOPM, 0, 0, &aif2dacr_src_mux),
1855SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8958_aif3adc_mux),
1856};
1857
1858static const struct snd_soc_dapm_route intercon[] = {
1859	{ "CLK_SYS", NULL, "AIF1CLK", check_clk_sys },
1860	{ "CLK_SYS", NULL, "AIF2CLK", check_clk_sys },
1861
1862	{ "DSP1CLK", NULL, "CLK_SYS" },
1863	{ "DSP2CLK", NULL, "CLK_SYS" },
1864	{ "DSPINTCLK", NULL, "CLK_SYS" },
1865
1866	{ "AIF1ADC1L", NULL, "AIF1CLK" },
1867	{ "AIF1ADC1L", NULL, "DSP1CLK" },
1868	{ "AIF1ADC1R", NULL, "AIF1CLK" },
1869	{ "AIF1ADC1R", NULL, "DSP1CLK" },
1870	{ "AIF1ADC1R", NULL, "DSPINTCLK" },
1871
1872	{ "AIF1DAC1L", NULL, "AIF1CLK" },
1873	{ "AIF1DAC1L", NULL, "DSP1CLK" },
1874	{ "AIF1DAC1R", NULL, "AIF1CLK" },
1875	{ "AIF1DAC1R", NULL, "DSP1CLK" },
1876	{ "AIF1DAC1R", NULL, "DSPINTCLK" },
1877
1878	{ "AIF1ADC2L", NULL, "AIF1CLK" },
1879	{ "AIF1ADC2L", NULL, "DSP1CLK" },
1880	{ "AIF1ADC2R", NULL, "AIF1CLK" },
1881	{ "AIF1ADC2R", NULL, "DSP1CLK" },
1882	{ "AIF1ADC2R", NULL, "DSPINTCLK" },
1883
1884	{ "AIF1DAC2L", NULL, "AIF1CLK" },
1885	{ "AIF1DAC2L", NULL, "DSP1CLK" },
1886	{ "AIF1DAC2R", NULL, "AIF1CLK" },
1887	{ "AIF1DAC2R", NULL, "DSP1CLK" },
1888	{ "AIF1DAC2R", NULL, "DSPINTCLK" },
1889
1890	{ "AIF2ADCL", NULL, "AIF2CLK" },
1891	{ "AIF2ADCL", NULL, "DSP2CLK" },
1892	{ "AIF2ADCR", NULL, "AIF2CLK" },
1893	{ "AIF2ADCR", NULL, "DSP2CLK" },
1894	{ "AIF2ADCR", NULL, "DSPINTCLK" },
1895
1896	{ "AIF2DACL", NULL, "AIF2CLK" },
1897	{ "AIF2DACL", NULL, "DSP2CLK" },
1898	{ "AIF2DACR", NULL, "AIF2CLK" },
1899	{ "AIF2DACR", NULL, "DSP2CLK" },
1900	{ "AIF2DACR", NULL, "DSPINTCLK" },
1901
1902	{ "DMIC1L", NULL, "DMIC1DAT" },
1903	{ "DMIC1L", NULL, "CLK_SYS" },
1904	{ "DMIC1R", NULL, "DMIC1DAT" },
1905	{ "DMIC1R", NULL, "CLK_SYS" },
1906	{ "DMIC2L", NULL, "DMIC2DAT" },
1907	{ "DMIC2L", NULL, "CLK_SYS" },
1908	{ "DMIC2R", NULL, "DMIC2DAT" },
1909	{ "DMIC2R", NULL, "CLK_SYS" },
1910
1911	{ "ADCL", NULL, "AIF1CLK" },
1912	{ "ADCL", NULL, "DSP1CLK" },
1913	{ "ADCL", NULL, "DSPINTCLK" },
1914
1915	{ "ADCR", NULL, "AIF1CLK" },
1916	{ "ADCR", NULL, "DSP1CLK" },
1917	{ "ADCR", NULL, "DSPINTCLK" },
1918
1919	{ "ADCL Mux", "ADC", "ADCL" },
1920	{ "ADCL Mux", "DMIC", "DMIC1L" },
1921	{ "ADCR Mux", "ADC", "ADCR" },
1922	{ "ADCR Mux", "DMIC", "DMIC1R" },
1923
1924	{ "DAC1L", NULL, "AIF1CLK" },
1925	{ "DAC1L", NULL, "DSP1CLK" },
1926	{ "DAC1L", NULL, "DSPINTCLK" },
1927
1928	{ "DAC1R", NULL, "AIF1CLK" },
1929	{ "DAC1R", NULL, "DSP1CLK" },
1930	{ "DAC1R", NULL, "DSPINTCLK" },
1931
1932	{ "DAC2L", NULL, "AIF2CLK" },
1933	{ "DAC2L", NULL, "DSP2CLK" },
1934	{ "DAC2L", NULL, "DSPINTCLK" },
1935
1936	{ "DAC2R", NULL, "AIF2DACR" },
1937	{ "DAC2R", NULL, "AIF2CLK" },
1938	{ "DAC2R", NULL, "DSP2CLK" },
1939	{ "DAC2R", NULL, "DSPINTCLK" },
1940
1941	{ "TOCLK", NULL, "CLK_SYS" },
1942
1943	{ "AIF1DACDAT", NULL, "AIF1 Playback" },
1944	{ "AIF2DACDAT", NULL, "AIF2 Playback" },
1945	{ "AIF3DACDAT", NULL, "AIF3 Playback" },
1946
1947	{ "AIF1 Capture", NULL, "AIF1ADCDAT" },
1948	{ "AIF2 Capture", NULL, "AIF2ADCDAT" },
1949	{ "AIF3 Capture", NULL, "AIF3ADCDAT" },
1950
1951	/* AIF1 outputs */
1952	{ "AIF1ADC1L", NULL, "AIF1ADC1L Mixer" },
1953	{ "AIF1ADC1L Mixer", "ADC/DMIC Switch", "ADCL Mux" },
1954	{ "AIF1ADC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1955
1956	{ "AIF1ADC1R", NULL, "AIF1ADC1R Mixer" },
1957	{ "AIF1ADC1R Mixer", "ADC/DMIC Switch", "ADCR Mux" },
1958	{ "AIF1ADC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1959
1960	{ "AIF1ADC2L", NULL, "AIF1ADC2L Mixer" },
1961	{ "AIF1ADC2L Mixer", "DMIC Switch", "DMIC2L" },
1962	{ "AIF1ADC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1963
1964	{ "AIF1ADC2R", NULL, "AIF1ADC2R Mixer" },
1965	{ "AIF1ADC2R Mixer", "DMIC Switch", "DMIC2R" },
1966	{ "AIF1ADC2R Mixer", "AIF2 Switch", "AIF2DACR" },
1967
1968	/* Pin level routing for AIF3 */
1969	{ "AIF1DAC1L", NULL, "AIF1DAC Mux" },
1970	{ "AIF1DAC1R", NULL, "AIF1DAC Mux" },
1971	{ "AIF1DAC2L", NULL, "AIF1DAC Mux" },
1972	{ "AIF1DAC2R", NULL, "AIF1DAC Mux" },
1973
1974	{ "AIF1DAC Mux", "AIF1DACDAT", "AIF1 Loopback" },
1975	{ "AIF1DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1976	{ "AIF2DAC Mux", "AIF2DACDAT", "AIF2 Loopback" },
1977	{ "AIF2DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1978	{ "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCL" },
1979	{ "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCR" },
1980	{ "AIF2ADC Mux", "AIF3DACDAT", "AIF3ADCDAT" },
1981
1982	/* DAC1 inputs */
1983	{ "DAC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1984	{ "DAC1L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1985	{ "DAC1L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
1986	{ "DAC1L Mixer", "Left Sidetone Switch", "Left Sidetone" },
1987	{ "DAC1L Mixer", "Right Sidetone Switch", "Right Sidetone" },
1988
1989	{ "DAC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1990	{ "DAC1R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
1991	{ "DAC1R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
1992	{ "DAC1R Mixer", "Left Sidetone Switch", "Left Sidetone" },
1993	{ "DAC1R Mixer", "Right Sidetone Switch", "Right Sidetone" },
1994
1995	/* DAC2/AIF2 outputs  */
1996	{ "AIF2ADCL", NULL, "AIF2DAC2L Mixer" },
1997	{ "AIF2DAC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1998	{ "AIF2DAC2L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1999	{ "AIF2DAC2L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
2000	{ "AIF2DAC2L Mixer", "Left Sidetone Switch", "Left Sidetone" },
2001	{ "AIF2DAC2L Mixer", "Right Sidetone Switch", "Right Sidetone" },
2002
2003	{ "AIF2ADCR", NULL, "AIF2DAC2R Mixer" },
2004	{ "AIF2DAC2R Mixer", "AIF2 Switch", "AIF2DACR" },
2005	{ "AIF2DAC2R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
2006	{ "AIF2DAC2R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
2007	{ "AIF2DAC2R Mixer", "Left Sidetone Switch", "Left Sidetone" },
2008	{ "AIF2DAC2R Mixer", "Right Sidetone Switch", "Right Sidetone" },
2009
2010	{ "AIF1ADCDAT", NULL, "AIF1ADC1L" },
2011	{ "AIF1ADCDAT", NULL, "AIF1ADC1R" },
2012	{ "AIF1ADCDAT", NULL, "AIF1ADC2L" },
2013	{ "AIF1ADCDAT", NULL, "AIF1ADC2R" },
2014
2015	{ "AIF2ADCDAT", NULL, "AIF2ADC Mux" },
2016
2017	/* AIF3 output */
2018	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC1L" },
2019	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC1R" },
2020	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC2L" },
2021	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC2R" },
2022	{ "AIF3ADC Mux", "AIF2ADCDAT", "AIF2ADCL" },
2023	{ "AIF3ADC Mux", "AIF2ADCDAT", "AIF2ADCR" },
2024	{ "AIF3ADC Mux", "AIF2DACDAT", "AIF2DACL" },
2025	{ "AIF3ADC Mux", "AIF2DACDAT", "AIF2DACR" },
2026
2027	{ "AIF3ADCDAT", NULL, "AIF3ADC Mux" },
2028
2029	/* Loopback */
2030	{ "AIF1 Loopback", "ADCDAT", "AIF1ADCDAT" },
2031	{ "AIF1 Loopback", "None", "AIF1DACDAT" },
2032	{ "AIF2 Loopback", "ADCDAT", "AIF2ADCDAT" },
2033	{ "AIF2 Loopback", "None", "AIF2DACDAT" },
2034
2035	/* Sidetone */
2036	{ "Left Sidetone", "ADC/DMIC1", "ADCL Mux" },
2037	{ "Left Sidetone", "DMIC2", "DMIC2L" },
2038	{ "Right Sidetone", "ADC/DMIC1", "ADCR Mux" },
2039	{ "Right Sidetone", "DMIC2", "DMIC2R" },
2040
2041	/* Output stages */
2042	{ "Left Output Mixer", "DAC Switch", "DAC1L" },
2043	{ "Right Output Mixer", "DAC Switch", "DAC1R" },
2044
2045	{ "SPKL", "DAC1 Switch", "DAC1L" },
2046	{ "SPKL", "DAC2 Switch", "DAC2L" },
2047
2048	{ "SPKR", "DAC1 Switch", "DAC1R" },
2049	{ "SPKR", "DAC2 Switch", "DAC2R" },
2050
2051	{ "Left Headphone Mux", "DAC", "DAC1L" },
2052	{ "Right Headphone Mux", "DAC", "DAC1R" },
2053};
2054
2055static const struct snd_soc_dapm_route wm8994_lateclk_revd_intercon[] = {
2056	{ "DAC1L", NULL, "Late DAC1L Enable PGA" },
2057	{ "Late DAC1L Enable PGA", NULL, "DAC1L Mixer" },
2058	{ "DAC1R", NULL, "Late DAC1R Enable PGA" },
2059	{ "Late DAC1R Enable PGA", NULL, "DAC1R Mixer" },
2060	{ "DAC2L", NULL, "Late DAC2L Enable PGA" },
2061	{ "Late DAC2L Enable PGA", NULL, "AIF2DAC2L Mixer" },
2062	{ "DAC2R", NULL, "Late DAC2R Enable PGA" },
2063	{ "Late DAC2R Enable PGA", NULL, "AIF2DAC2R Mixer" }
2064};
2065
2066static const struct snd_soc_dapm_route wm8994_lateclk_intercon[] = {
2067	{ "DAC1L", NULL, "DAC1L Mixer" },
2068	{ "DAC1R", NULL, "DAC1R Mixer" },
2069	{ "DAC2L", NULL, "AIF2DAC2L Mixer" },
2070	{ "DAC2R", NULL, "AIF2DAC2R Mixer" },
2071};
2072
2073static const struct snd_soc_dapm_route wm8994_revd_intercon[] = {
2074	{ "AIF1DACDAT", NULL, "AIF2DACDAT" },
2075	{ "AIF2DACDAT", NULL, "AIF1DACDAT" },
2076	{ "AIF1ADCDAT", NULL, "AIF2ADCDAT" },
2077	{ "AIF2ADCDAT", NULL, "AIF1ADCDAT" },
2078	{ "MICBIAS1", NULL, "CLK_SYS" },
2079	{ "MICBIAS1", NULL, "MICBIAS Supply" },
2080	{ "MICBIAS2", NULL, "CLK_SYS" },
2081	{ "MICBIAS2", NULL, "MICBIAS Supply" },
2082};
2083
2084static const struct snd_soc_dapm_route wm8994_intercon[] = {
2085	{ "AIF2DACL", NULL, "AIF2DAC Mux" },
2086	{ "AIF2DACR", NULL, "AIF2DAC Mux" },
2087	{ "MICBIAS1", NULL, "VMID" },
2088	{ "MICBIAS2", NULL, "VMID" },
2089};
2090
2091static const struct snd_soc_dapm_route wm8958_intercon[] = {
2092	{ "AIF2DACL", NULL, "AIF2DACL Mux" },
2093	{ "AIF2DACR", NULL, "AIF2DACR Mux" },
2094
2095	{ "AIF2DACL Mux", "AIF2", "AIF2DAC Mux" },
2096	{ "AIF2DACL Mux", "AIF3", "AIF3DACDAT" },
2097	{ "AIF2DACR Mux", "AIF2", "AIF2DAC Mux" },
2098	{ "AIF2DACR Mux", "AIF3", "AIF3DACDAT" },
2099
2100	{ "AIF3DACDAT", NULL, "AIF3" },
2101	{ "AIF3ADCDAT", NULL, "AIF3" },
2102
2103	{ "Mono PCM Out Mux", "AIF2ADCL", "AIF2ADCL" },
2104	{ "Mono PCM Out Mux", "AIF2ADCR", "AIF2ADCR" },
2105
2106	{ "AIF3ADC Mux", "Mono PCM", "Mono PCM Out Mux" },
2107};
2108
2109/* The size in bits of the FLL divide multiplied by 10
2110 * to allow rounding later */
2111#define FIXED_FLL_SIZE ((1 << 16) * 10)
2112
2113struct fll_div {
2114	u16 outdiv;
2115	u16 n;
2116	u16 k;
2117	u16 lambda;
2118	u16 clk_ref_div;
2119	u16 fll_fratio;
2120};
2121
2122static int wm8994_get_fll_config(struct wm8994 *control, struct fll_div *fll,
2123				 int freq_in, int freq_out)
2124{
2125	u64 Kpart;
2126	unsigned int K, Ndiv, Nmod, gcd_fll;
2127
2128	pr_debug("FLL input=%dHz, output=%dHz\n", freq_in, freq_out);
2129
2130	/* Scale the input frequency down to <= 13.5MHz */
2131	fll->clk_ref_div = 0;
2132	while (freq_in > 13500000) {
2133		fll->clk_ref_div++;
2134		freq_in /= 2;
2135
2136		if (fll->clk_ref_div > 3)
2137			return -EINVAL;
2138	}
2139	pr_debug("CLK_REF_DIV=%d, Fref=%dHz\n", fll->clk_ref_div, freq_in);
2140
2141	/* Scale the output to give 90MHz<=Fvco<=100MHz */
2142	fll->outdiv = 3;
2143	while (freq_out * (fll->outdiv + 1) < 90000000) {
2144		fll->outdiv++;
2145		if (fll->outdiv > 63)
2146			return -EINVAL;
2147	}
2148	freq_out *= fll->outdiv + 1;
2149	pr_debug("OUTDIV=%d, Fvco=%dHz\n", fll->outdiv, freq_out);
2150
2151	if (freq_in > 1000000) {
2152		fll->fll_fratio = 0;
2153	} else if (freq_in > 256000) {
2154		fll->fll_fratio = 1;
2155		freq_in *= 2;
2156	} else if (freq_in > 128000) {
2157		fll->fll_fratio = 2;
2158		freq_in *= 4;
2159	} else if (freq_in > 64000) {
2160		fll->fll_fratio = 3;
2161		freq_in *= 8;
2162	} else {
2163		fll->fll_fratio = 4;
2164		freq_in *= 16;
2165	}
2166	pr_debug("FLL_FRATIO=%d, Fref=%dHz\n", fll->fll_fratio, freq_in);
2167
2168	/* Now, calculate N.K */
2169	Ndiv = freq_out / freq_in;
2170
2171	fll->n = Ndiv;
2172	Nmod = freq_out % freq_in;
2173	pr_debug("Nmod=%d\n", Nmod);
2174
2175	switch (control->type) {
2176	case WM8994:
2177		/* Calculate fractional part - scale up so we can round. */
2178		Kpart = FIXED_FLL_SIZE * (long long)Nmod;
2179
2180		do_div(Kpart, freq_in);
2181
2182		K = Kpart & 0xFFFFFFFF;
2183
2184		if ((K % 10) >= 5)
2185			K += 5;
2186
2187		/* Move down to proper range now rounding is done */
2188		fll->k = K / 10;
2189		fll->lambda = 0;
2190
2191		pr_debug("N=%x K=%x\n", fll->n, fll->k);
2192		break;
2193
2194	default:
2195		gcd_fll = gcd(freq_out, freq_in);
2196
2197		fll->k = (freq_out - (freq_in * fll->n)) / gcd_fll;
2198		fll->lambda = freq_in / gcd_fll;
2199		
2200	}
2201
2202	return 0;
2203}
2204
2205static int _wm8994_set_fll(struct snd_soc_component *component, int id, int src,
2206			  unsigned int freq_in, unsigned int freq_out)
2207{
2208	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2209	struct wm8994 *control = wm8994->wm8994;
2210	int reg_offset, ret;
2211	struct fll_div fll;
2212	u16 reg, clk1, aif_reg, aif_src;
2213	unsigned long time_left;
2214	bool was_enabled;
2215	struct clk *mclk;
2216
2217	switch (id) {
2218	case WM8994_FLL1:
2219		reg_offset = 0;
2220		id = 0;
2221		aif_src = 0x10;
2222		break;
2223	case WM8994_FLL2:
2224		reg_offset = 0x20;
2225		id = 1;
2226		aif_src = 0x18;
2227		break;
2228	default:
2229		return -EINVAL;
2230	}
2231
2232	reg = snd_soc_component_read(component, WM8994_FLL1_CONTROL_1 + reg_offset);
2233	was_enabled = reg & WM8994_FLL1_ENA;
2234
2235	switch (src) {
2236	case 0:
2237		/* Allow no source specification when stopping */
2238		if (freq_out)
2239			return -EINVAL;
2240		src = wm8994->fll[id].src;
2241		break;
2242	case WM8994_FLL_SRC_MCLK1:
2243	case WM8994_FLL_SRC_MCLK2:
2244	case WM8994_FLL_SRC_LRCLK:
2245	case WM8994_FLL_SRC_BCLK:
2246		break;
2247	case WM8994_FLL_SRC_INTERNAL:
2248		freq_in = 12000000;
2249		freq_out = 12000000;
2250		break;
2251	default:
2252		return -EINVAL;
2253	}
2254
2255	/* Are we changing anything? */
2256	if (wm8994->fll[id].src == src &&
2257	    wm8994->fll[id].in == freq_in && wm8994->fll[id].out == freq_out)
2258		return 0;
2259
2260	/* If we're stopping the FLL redo the old config - no
2261	 * registers will actually be written but we avoid GCC flow
2262	 * analysis bugs spewing warnings.
2263	 */
2264	if (freq_out)
2265		ret = wm8994_get_fll_config(control, &fll, freq_in, freq_out);
2266	else
2267		ret = wm8994_get_fll_config(control, &fll, wm8994->fll[id].in,
2268					    wm8994->fll[id].out);
2269	if (ret < 0)
2270		return ret;
2271
2272	/* Make sure that we're not providing SYSCLK right now */
2273	clk1 = snd_soc_component_read(component, WM8994_CLOCKING_1);
2274	if (clk1 & WM8994_SYSCLK_SRC)
2275		aif_reg = WM8994_AIF2_CLOCKING_1;
2276	else
2277		aif_reg = WM8994_AIF1_CLOCKING_1;
2278	reg = snd_soc_component_read(component, aif_reg);
2279
2280	if ((reg & WM8994_AIF1CLK_ENA) &&
2281	    (reg & WM8994_AIF1CLK_SRC_MASK) == aif_src) {
2282		dev_err(component->dev, "FLL%d is currently providing SYSCLK\n",
2283			id + 1);
2284		return -EBUSY;
2285	}
2286
2287	/* We always need to disable the FLL while reconfiguring */
2288	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_1 + reg_offset,
2289			    WM8994_FLL1_ENA, 0);
2290
2291	/* Disable MCLK if needed before we possibly change to new clock parent */
2292	if (was_enabled) {
2293		reg = snd_soc_component_read(component, WM8994_FLL1_CONTROL_5
2294							+ reg_offset);
2295		reg = ((reg & WM8994_FLL1_REFCLK_SRC_MASK)
2296			>> WM8994_FLL1_REFCLK_SRC_SHIFT) + 1;
2297
2298		switch (reg) {
2299		case WM8994_FLL_SRC_MCLK1:
2300			mclk = wm8994->mclk[WM8994_MCLK1].clk;
2301			break;
2302		case WM8994_FLL_SRC_MCLK2:
2303			mclk = wm8994->mclk[WM8994_MCLK2].clk;
2304			break;
2305		default:
2306			mclk = NULL;
2307		}
2308
2309		clk_disable_unprepare(mclk);
2310	}
2311
2312	if (wm8994->fll_byp && src == WM8994_FLL_SRC_BCLK &&
2313	    freq_in == freq_out && freq_out) {
2314		dev_dbg(component->dev, "Bypassing FLL%d\n", id + 1);
2315		snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_5 + reg_offset,
2316				    WM8958_FLL1_BYP, WM8958_FLL1_BYP);
2317		goto out;
2318	}
2319
2320	reg = (fll.outdiv << WM8994_FLL1_OUTDIV_SHIFT) |
2321		(fll.fll_fratio << WM8994_FLL1_FRATIO_SHIFT);
2322	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_2 + reg_offset,
2323			    WM8994_FLL1_OUTDIV_MASK |
2324			    WM8994_FLL1_FRATIO_MASK, reg);
2325
2326	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_3 + reg_offset,
2327			    WM8994_FLL1_K_MASK, fll.k);
2328
2329	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_4 + reg_offset,
2330			    WM8994_FLL1_N_MASK,
2331			    fll.n << WM8994_FLL1_N_SHIFT);
2332
2333	if (fll.lambda) {
2334		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_1 + reg_offset,
2335				    WM8958_FLL1_LAMBDA_MASK,
2336				    fll.lambda);
2337		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_2 + reg_offset,
2338				    WM8958_FLL1_EFS_ENA, WM8958_FLL1_EFS_ENA);
2339	} else {
2340		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_2 + reg_offset,
2341				    WM8958_FLL1_EFS_ENA, 0);
2342	}
2343
2344	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_5 + reg_offset,
2345			    WM8994_FLL1_FRC_NCO | WM8958_FLL1_BYP |
2346			    WM8994_FLL1_REFCLK_DIV_MASK |
2347			    WM8994_FLL1_REFCLK_SRC_MASK,
2348			    ((src == WM8994_FLL_SRC_INTERNAL)
2349			     << WM8994_FLL1_FRC_NCO_SHIFT) |
2350			    (fll.clk_ref_div << WM8994_FLL1_REFCLK_DIV_SHIFT) |
2351			    (src - 1));
2352
2353	/* Clear any pending completion from a previous failure */
2354	try_wait_for_completion(&wm8994->fll_locked[id]);
2355
2356	switch (src) {
2357	case WM8994_FLL_SRC_MCLK1:
2358		mclk = wm8994->mclk[WM8994_MCLK1].clk;
2359		break;
2360	case WM8994_FLL_SRC_MCLK2:
2361		mclk = wm8994->mclk[WM8994_MCLK2].clk;
2362		break;
2363	default:
2364		mclk = NULL;
2365	}
2366
2367	/* Enable (with fractional mode if required) */
2368	if (freq_out) {
2369		ret = clk_prepare_enable(mclk);
2370		if (ret < 0) {
2371			dev_err(component->dev, "Failed to enable MCLK for FLL%d\n",
2372				id + 1);
2373			return ret;
2374		}
2375
2376		/* Enable VMID if we need it */
2377		if (!was_enabled) {
2378
2379			active_reference(component);
2380
2381			switch (control->type) {
2382			case WM8994:
2383				vmid_reference(component);
2384				break;
2385			case WM8958:
2386				if (control->revision < 1)
2387					vmid_reference(component);
2388				break;
2389			default:
2390				break;
2391			}
2392		}
2393
2394		reg = WM8994_FLL1_ENA;
2395
2396		if (fll.k)
2397			reg |= WM8994_FLL1_FRAC;
2398		if (src == WM8994_FLL_SRC_INTERNAL)
2399			reg |= WM8994_FLL1_OSC_ENA;
2400
2401		snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_1 + reg_offset,
2402				    WM8994_FLL1_ENA | WM8994_FLL1_OSC_ENA |
2403				    WM8994_FLL1_FRAC, reg);
2404
2405		if (wm8994->fll_locked_irq) {
2406			time_left = wait_for_completion_timeout(&wm8994->fll_locked[id],
2407								msecs_to_jiffies(10));
2408			if (time_left == 0)
2409				dev_warn(component->dev,
2410					 "Timed out waiting for FLL lock\n");
2411		} else {
2412			msleep(5);
2413		}
2414	} else {
2415		if (was_enabled) {
2416			switch (control->type) {
2417			case WM8994:
2418				vmid_dereference(component);
2419				break;
2420			case WM8958:
2421				if (control->revision < 1)
2422					vmid_dereference(component);
2423				break;
2424			default:
2425				break;
2426			}
2427
2428			active_dereference(component);
2429		}
2430	}
2431
2432out:
2433	wm8994->fll[id].in = freq_in;
2434	wm8994->fll[id].out = freq_out;
2435	wm8994->fll[id].src = src;
2436
2437	configure_clock(component);
2438
2439	/*
2440	 * If SYSCLK will be less than 50kHz adjust AIFnCLK dividers
2441	 * for detection.
2442	 */
2443	if (max(wm8994->aifclk[0], wm8994->aifclk[1]) < 50000) {
2444		dev_dbg(component->dev, "Configuring AIFs for 128fs\n");
2445
2446		wm8994->aifdiv[0] = snd_soc_component_read(component, WM8994_AIF1_RATE)
2447			& WM8994_AIF1CLK_RATE_MASK;
2448		wm8994->aifdiv[1] = snd_soc_component_read(component, WM8994_AIF2_RATE)
2449			& WM8994_AIF1CLK_RATE_MASK;
2450
2451		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2452				    WM8994_AIF1CLK_RATE_MASK, 0x1);
2453		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2454				    WM8994_AIF2CLK_RATE_MASK, 0x1);
2455	} else if (wm8994->aifdiv[0]) {
2456		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2457				    WM8994_AIF1CLK_RATE_MASK,
2458				    wm8994->aifdiv[0]);
2459		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2460				    WM8994_AIF2CLK_RATE_MASK,
2461				    wm8994->aifdiv[1]);
2462
2463		wm8994->aifdiv[0] = 0;
2464		wm8994->aifdiv[1] = 0;
2465	}
2466
2467	return 0;
2468}
2469
2470static irqreturn_t wm8994_fll_locked_irq(int irq, void *data)
2471{
2472	struct completion *completion = data;
2473
2474	complete(completion);
2475
2476	return IRQ_HANDLED;
2477}
2478
2479static int opclk_divs[] = { 10, 20, 30, 40, 55, 60, 80, 120, 160 };
2480
2481static int wm8994_set_fll(struct snd_soc_dai *dai, int id, int src,
2482			  unsigned int freq_in, unsigned int freq_out)
2483{
2484	return _wm8994_set_fll(dai->component, id, src, freq_in, freq_out);
2485}
2486
2487static int wm8994_set_mclk_rate(struct wm8994_priv *wm8994, unsigned int id,
2488				unsigned int *freq)
2489{
2490	int ret;
2491
2492	if (!wm8994->mclk[id].clk || *freq == wm8994->mclk_rate[id])
2493		return 0;
2494
2495	ret = clk_set_rate(wm8994->mclk[id].clk, *freq);
2496	if (ret < 0)
2497		return ret;
2498
2499	*freq = clk_get_rate(wm8994->mclk[id].clk);
2500
2501	return 0;
2502}
2503
2504static int wm8994_set_dai_sysclk(struct snd_soc_dai *dai,
2505		int clk_id, unsigned int freq, int dir)
2506{
2507	struct snd_soc_component *component = dai->component;
2508	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2509	int ret, i;
2510
2511	switch (dai->id) {
2512	case 1:
2513	case 2:
2514		break;
2515
2516	default:
2517		/* AIF3 shares clocking with AIF1/2 */
2518		return -EINVAL;
2519	}
2520
2521	switch (clk_id) {
2522	case WM8994_SYSCLK_MCLK1:
2523		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK1;
2524
2525		ret = wm8994_set_mclk_rate(wm8994, dai->id - 1, &freq);
2526		if (ret < 0)
2527			return ret;
2528
2529		wm8994->mclk_rate[0] = freq;
2530		dev_dbg(dai->dev, "AIF%d using MCLK1 at %uHz\n",
2531			dai->id, freq);
2532		break;
2533
2534	case WM8994_SYSCLK_MCLK2:
2535		/* TODO: Set GPIO AF */
2536		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK2;
2537
2538		ret = wm8994_set_mclk_rate(wm8994, dai->id - 1, &freq);
2539		if (ret < 0)
2540			return ret;
2541
2542		wm8994->mclk_rate[1] = freq;
2543		dev_dbg(dai->dev, "AIF%d using MCLK2 at %uHz\n",
2544			dai->id, freq);
2545		break;
2546
2547	case WM8994_SYSCLK_FLL1:
2548		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL1;
2549		dev_dbg(dai->dev, "AIF%d using FLL1\n", dai->id);
2550		break;
2551
2552	case WM8994_SYSCLK_FLL2:
2553		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL2;
2554		dev_dbg(dai->dev, "AIF%d using FLL2\n", dai->id);
2555		break;
2556
2557	case WM8994_SYSCLK_OPCLK:
2558		/* Special case - a division (times 10) is given and
2559		 * no effect on main clocking.
2560		 */
2561		if (freq) {
2562			for (i = 0; i < ARRAY_SIZE(opclk_divs); i++)
2563				if (opclk_divs[i] == freq)
2564					break;
2565			if (i == ARRAY_SIZE(opclk_divs))
2566				return -EINVAL;
2567			snd_soc_component_update_bits(component, WM8994_CLOCKING_2,
2568					    WM8994_OPCLK_DIV_MASK, i);
2569			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_2,
2570					    WM8994_OPCLK_ENA, WM8994_OPCLK_ENA);
2571		} else {
2572			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_2,
2573					    WM8994_OPCLK_ENA, 0);
2574		}
2575		break;
2576
2577	default:
2578		return -EINVAL;
2579	}
2580
2581	configure_clock(component);
2582
2583	/*
2584	 * If SYSCLK will be less than 50kHz adjust AIFnCLK dividers
2585	 * for detection.
2586	 */
2587	if (max(wm8994->aifclk[0], wm8994->aifclk[1]) < 50000) {
2588		dev_dbg(component->dev, "Configuring AIFs for 128fs\n");
2589
2590		wm8994->aifdiv[0] = snd_soc_component_read(component, WM8994_AIF1_RATE)
2591			& WM8994_AIF1CLK_RATE_MASK;
2592		wm8994->aifdiv[1] = snd_soc_component_read(component, WM8994_AIF2_RATE)
2593			& WM8994_AIF1CLK_RATE_MASK;
2594
2595		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2596				    WM8994_AIF1CLK_RATE_MASK, 0x1);
2597		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2598				    WM8994_AIF2CLK_RATE_MASK, 0x1);
2599	} else if (wm8994->aifdiv[0]) {
2600		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2601				    WM8994_AIF1CLK_RATE_MASK,
2602				    wm8994->aifdiv[0]);
2603		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2604				    WM8994_AIF2CLK_RATE_MASK,
2605				    wm8994->aifdiv[1]);
2606
2607		wm8994->aifdiv[0] = 0;
2608		wm8994->aifdiv[1] = 0;
2609	}
2610
2611	return 0;
2612}
2613
2614static int wm8994_set_bias_level(struct snd_soc_component *component,
2615				 enum snd_soc_bias_level level)
2616{
2617	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2618	struct wm8994 *control = wm8994->wm8994;
2619
2620	wm_hubs_set_bias_level(component, level);
2621
2622	switch (level) {
2623	case SND_SOC_BIAS_ON:
2624		break;
2625
2626	case SND_SOC_BIAS_PREPARE:
2627		/* MICBIAS into regulating mode */
2628		switch (control->type) {
2629		case WM8958:
2630		case WM1811:
2631			snd_soc_component_update_bits(component, WM8958_MICBIAS1,
2632					    WM8958_MICB1_MODE, 0);
2633			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
2634					    WM8958_MICB2_MODE, 0);
2635			break;
2636		default:
2637			break;
2638		}
2639
2640		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_STANDBY)
2641			active_reference(component);
2642		break;
2643
2644	case SND_SOC_BIAS_STANDBY:
2645		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
2646			switch (control->type) {
2647			case WM8958:
2648				if (control->revision == 0) {
2649					/* Optimise performance for rev A */
2650					snd_soc_component_update_bits(component,
2651							    WM8958_CHARGE_PUMP_2,
2652							    WM8958_CP_DISCH,
2653							    WM8958_CP_DISCH);
2654				}
2655				break;
2656
2657			default:
2658				break;
2659			}
2660
2661			/* Discharge LINEOUT1 & 2 */
2662			snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
2663					    WM8994_LINEOUT1_DISCH |
2664					    WM8994_LINEOUT2_DISCH,
2665					    WM8994_LINEOUT1_DISCH |
2666					    WM8994_LINEOUT2_DISCH);
2667		}
2668
2669		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_PREPARE)
2670			active_dereference(component);
2671
2672		/* MICBIAS into bypass mode on newer devices */
2673		switch (control->type) {
2674		case WM8958:
2675		case WM1811:
2676			snd_soc_component_update_bits(component, WM8958_MICBIAS1,
2677					    WM8958_MICB1_MODE,
2678					    WM8958_MICB1_MODE);
2679			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
2680					    WM8958_MICB2_MODE,
2681					    WM8958_MICB2_MODE);
2682			break;
2683		default:
2684			break;
2685		}
2686		break;
2687
2688	case SND_SOC_BIAS_OFF:
2689		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_STANDBY)
2690			wm8994->cur_fw = NULL;
2691		break;
2692	}
2693
2694	return 0;
2695}
2696
2697int wm8994_vmid_mode(struct snd_soc_component *component, enum wm8994_vmid_mode mode)
2698{
2699	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2700	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
2701
2702	switch (mode) {
2703	case WM8994_VMID_NORMAL:
2704		snd_soc_dapm_mutex_lock(dapm);
2705
2706		if (wm8994->hubs.lineout1_se) {
2707			snd_soc_dapm_disable_pin_unlocked(dapm,
2708							  "LINEOUT1N Driver");
2709			snd_soc_dapm_disable_pin_unlocked(dapm,
2710							  "LINEOUT1P Driver");
2711		}
2712		if (wm8994->hubs.lineout2_se) {
2713			snd_soc_dapm_disable_pin_unlocked(dapm,
2714							  "LINEOUT2N Driver");
2715			snd_soc_dapm_disable_pin_unlocked(dapm,
2716							  "LINEOUT2P Driver");
2717		}
2718
2719		/* Do the sync with the old mode to allow it to clean up */
2720		snd_soc_dapm_sync_unlocked(dapm);
2721		wm8994->vmid_mode = mode;
2722
2723		snd_soc_dapm_mutex_unlock(dapm);
2724		break;
2725
2726	case WM8994_VMID_FORCE:
2727		snd_soc_dapm_mutex_lock(dapm);
2728
2729		if (wm8994->hubs.lineout1_se) {
2730			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2731							       "LINEOUT1N Driver");
2732			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2733							       "LINEOUT1P Driver");
2734		}
2735		if (wm8994->hubs.lineout2_se) {
2736			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2737							       "LINEOUT2N Driver");
2738			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2739							       "LINEOUT2P Driver");
2740		}
2741
2742		wm8994->vmid_mode = mode;
2743		snd_soc_dapm_sync_unlocked(dapm);
2744
2745		snd_soc_dapm_mutex_unlock(dapm);
2746		break;
2747
2748	default:
2749		return -EINVAL;
2750	}
2751
2752	return 0;
2753}
2754
2755static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2756{
2757	struct snd_soc_component *component = dai->component;
2758	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2759	struct wm8994 *control = wm8994->wm8994;
2760	int ms_reg;
2761	int aif1_reg;
2762	int dac_reg;
2763	int adc_reg;
2764	int ms = 0;
2765	int aif1 = 0;
2766	int lrclk = 0;
2767
2768	switch (dai->id) {
2769	case 1:
2770		ms_reg = WM8994_AIF1_MASTER_SLAVE;
2771		aif1_reg = WM8994_AIF1_CONTROL_1;
2772		dac_reg = WM8994_AIF1DAC_LRCLK;
2773		adc_reg = WM8994_AIF1ADC_LRCLK;
2774		break;
2775	case 2:
2776		ms_reg = WM8994_AIF2_MASTER_SLAVE;
2777		aif1_reg = WM8994_AIF2_CONTROL_1;
2778		dac_reg = WM8994_AIF1DAC_LRCLK;
2779		adc_reg = WM8994_AIF1ADC_LRCLK;
2780		break;
2781	default:
2782		return -EINVAL;
2783	}
2784
2785	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2786	case SND_SOC_DAIFMT_CBS_CFS:
2787		break;
2788	case SND_SOC_DAIFMT_CBM_CFM:
2789		ms = WM8994_AIF1_MSTR;
2790		break;
2791	default:
2792		return -EINVAL;
2793	}
2794
2795	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2796	case SND_SOC_DAIFMT_DSP_B:
2797		aif1 |= WM8994_AIF1_LRCLK_INV;
2798		lrclk |= WM8958_AIF1_LRCLK_INV;
2799		fallthrough;
2800	case SND_SOC_DAIFMT_DSP_A:
2801		aif1 |= 0x18;
2802		break;
2803	case SND_SOC_DAIFMT_I2S:
2804		aif1 |= 0x10;
2805		break;
2806	case SND_SOC_DAIFMT_RIGHT_J:
2807		break;
2808	case SND_SOC_DAIFMT_LEFT_J:
2809		aif1 |= 0x8;
2810		break;
2811	default:
2812		return -EINVAL;
2813	}
2814
2815	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2816	case SND_SOC_DAIFMT_DSP_A:
2817	case SND_SOC_DAIFMT_DSP_B:
2818		/* frame inversion not valid for DSP modes */
2819		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2820		case SND_SOC_DAIFMT_NB_NF:
2821			break;
2822		case SND_SOC_DAIFMT_IB_NF:
2823			aif1 |= WM8994_AIF1_BCLK_INV;
2824			break;
2825		default:
2826			return -EINVAL;
2827		}
2828		break;
2829
2830	case SND_SOC_DAIFMT_I2S:
2831	case SND_SOC_DAIFMT_RIGHT_J:
2832	case SND_SOC_DAIFMT_LEFT_J:
2833		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2834		case SND_SOC_DAIFMT_NB_NF:
2835			break;
2836		case SND_SOC_DAIFMT_IB_IF:
2837			aif1 |= WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV;
2838			lrclk |= WM8958_AIF1_LRCLK_INV;
2839			break;
2840		case SND_SOC_DAIFMT_IB_NF:
2841			aif1 |= WM8994_AIF1_BCLK_INV;
2842			break;
2843		case SND_SOC_DAIFMT_NB_IF:
2844			aif1 |= WM8994_AIF1_LRCLK_INV;
2845			lrclk |= WM8958_AIF1_LRCLK_INV;
2846			break;
2847		default:
2848			return -EINVAL;
2849		}
2850		break;
2851	default:
2852		return -EINVAL;
2853	}
2854
2855	/* The AIF2 format configuration needs to be mirrored to AIF3
2856	 * on WM8958 if it's in use so just do it all the time. */
2857	switch (control->type) {
2858	case WM1811:
2859	case WM8958:
2860		if (dai->id == 2)
2861			snd_soc_component_update_bits(component, WM8958_AIF3_CONTROL_1,
2862					    WM8994_AIF1_LRCLK_INV |
2863					    WM8958_AIF3_FMT_MASK, aif1);
2864		break;
2865
2866	default:
2867		break;
2868	}
2869
2870	snd_soc_component_update_bits(component, aif1_reg,
2871			    WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV |
2872			    WM8994_AIF1_FMT_MASK,
2873			    aif1);
2874	snd_soc_component_update_bits(component, ms_reg, WM8994_AIF1_MSTR,
2875			    ms);
2876	snd_soc_component_update_bits(component, dac_reg,
2877			    WM8958_AIF1_LRCLK_INV, lrclk);
2878	snd_soc_component_update_bits(component, adc_reg,
2879			    WM8958_AIF1_LRCLK_INV, lrclk);
2880
2881	return 0;
2882}
2883
2884static struct {
2885	int val, rate;
2886} srs[] = {
2887	{ 0,   8000 },
2888	{ 1,  11025 },
2889	{ 2,  12000 },
2890	{ 3,  16000 },
2891	{ 4,  22050 },
2892	{ 5,  24000 },
2893	{ 6,  32000 },
2894	{ 7,  44100 },
2895	{ 8,  48000 },
2896	{ 9,  88200 },
2897	{ 10, 96000 },
2898};
2899
2900static int fs_ratios[] = {
2901	64, 128, 192, 256, 384, 512, 768, 1024, 1408, 1536
2902};
2903
2904static int bclk_divs[] = {
2905	10, 15, 20, 30, 40, 50, 60, 80, 110, 120, 160, 220, 240, 320, 440, 480,
2906	640, 880, 960, 1280, 1760, 1920
2907};
2908
2909static int wm8994_hw_params(struct snd_pcm_substream *substream,
2910			    struct snd_pcm_hw_params *params,
2911			    struct snd_soc_dai *dai)
2912{
2913	struct snd_soc_component *component = dai->component;
2914	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2915	struct wm8994 *control = wm8994->wm8994;
2916	struct wm8994_pdata *pdata = &control->pdata;
2917	int aif1_reg;
2918	int aif2_reg;
2919	int bclk_reg;
2920	int lrclk_reg;
2921	int rate_reg;
2922	int aif1 = 0;
2923	int aif2 = 0;
2924	int bclk = 0;
2925	int lrclk = 0;
2926	int rate_val = 0;
2927	int id = dai->id - 1;
2928
2929	int i, cur_val, best_val, bclk_rate, best;
2930
2931	switch (dai->id) {
2932	case 1:
2933		aif1_reg = WM8994_AIF1_CONTROL_1;
2934		aif2_reg = WM8994_AIF1_CONTROL_2;
2935		bclk_reg = WM8994_AIF1_BCLK;
2936		rate_reg = WM8994_AIF1_RATE;
2937		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2938		    wm8994->lrclk_shared[0]) {
2939			lrclk_reg = WM8994_AIF1DAC_LRCLK;
2940		} else {
2941			lrclk_reg = WM8994_AIF1ADC_LRCLK;
2942			dev_dbg(component->dev, "AIF1 using split LRCLK\n");
2943		}
2944		break;
2945	case 2:
2946		aif1_reg = WM8994_AIF2_CONTROL_1;
2947		aif2_reg = WM8994_AIF2_CONTROL_2;
2948		bclk_reg = WM8994_AIF2_BCLK;
2949		rate_reg = WM8994_AIF2_RATE;
2950		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2951		    wm8994->lrclk_shared[1]) {
2952			lrclk_reg = WM8994_AIF2DAC_LRCLK;
2953		} else {
2954			lrclk_reg = WM8994_AIF2ADC_LRCLK;
2955			dev_dbg(component->dev, "AIF2 using split LRCLK\n");
2956		}
2957		break;
2958	default:
2959		return -EINVAL;
2960	}
2961
2962	bclk_rate = params_rate(params);
2963	switch (params_width(params)) {
2964	case 16:
2965		bclk_rate *= 16;
2966		break;
2967	case 20:
2968		bclk_rate *= 20;
2969		aif1 |= 0x20;
2970		break;
2971	case 24:
2972		bclk_rate *= 24;
2973		aif1 |= 0x40;
2974		break;
2975	case 32:
2976		bclk_rate *= 32;
2977		aif1 |= 0x60;
2978		break;
2979	default:
2980		return -EINVAL;
2981	}
2982
2983	wm8994->channels[id] = params_channels(params);
2984	if (pdata->max_channels_clocked[id] &&
2985	    wm8994->channels[id] > pdata->max_channels_clocked[id]) {
2986		dev_dbg(dai->dev, "Constraining channels to %d from %d\n",
2987			pdata->max_channels_clocked[id], wm8994->channels[id]);
2988		wm8994->channels[id] = pdata->max_channels_clocked[id];
2989	}
2990
2991	switch (wm8994->channels[id]) {
2992	case 1:
2993	case 2:
2994		bclk_rate *= 2;
2995		break;
2996	default:
2997		bclk_rate *= 4;
2998		break;
2999	}
3000
3001	/* Try to find an appropriate sample rate; look for an exact match. */
3002	for (i = 0; i < ARRAY_SIZE(srs); i++)
3003		if (srs[i].rate == params_rate(params))
3004			break;
3005	if (i == ARRAY_SIZE(srs))
3006		return -EINVAL;
3007	rate_val |= srs[i].val << WM8994_AIF1_SR_SHIFT;
3008
3009	dev_dbg(dai->dev, "Sample rate is %dHz\n", srs[i].rate);
3010	dev_dbg(dai->dev, "AIF%dCLK is %dHz, target BCLK %dHz\n",
3011		dai->id, wm8994->aifclk[id], bclk_rate);
3012
3013	if (wm8994->channels[id] == 1 &&
3014	    (snd_soc_component_read(component, aif1_reg) & 0x18) == 0x18)
3015		aif2 |= WM8994_AIF1_MONO;
3016
3017	if (wm8994->aifclk[id] == 0) {
3018		dev_err(dai->dev, "AIF%dCLK not configured\n", dai->id);
3019		return -EINVAL;
3020	}
3021
3022	/* AIFCLK/fs ratio; look for a close match in either direction */
3023	best = 0;
3024	best_val = abs((fs_ratios[0] * params_rate(params))
3025		       - wm8994->aifclk[id]);
3026	for (i = 1; i < ARRAY_SIZE(fs_ratios); i++) {
3027		cur_val = abs((fs_ratios[i] * params_rate(params))
3028			      - wm8994->aifclk[id]);
3029		if (cur_val >= best_val)
3030			continue;
3031		best = i;
3032		best_val = cur_val;
3033	}
3034	dev_dbg(dai->dev, "Selected AIF%dCLK/fs = %d\n",
3035		dai->id, fs_ratios[best]);
3036	rate_val |= best;
3037
3038	/* We may not get quite the right frequency if using
3039	 * approximate clocks so look for the closest match that is
3040	 * higher than the target (we need to ensure that there enough
3041	 * BCLKs to clock out the samples).
3042	 */
3043	best = 0;
3044	for (i = 0; i < ARRAY_SIZE(bclk_divs); i++) {
3045		cur_val = (wm8994->aifclk[id] * 10 / bclk_divs[i]) - bclk_rate;
3046		if (cur_val < 0) /* BCLK table is sorted */
3047			break;
3048		best = i;
3049	}
3050	bclk_rate = wm8994->aifclk[id] * 10 / bclk_divs[best];
3051	dev_dbg(dai->dev, "Using BCLK_DIV %d for actual BCLK %dHz\n",
3052		bclk_divs[best], bclk_rate);
3053	bclk |= best << WM8994_AIF1_BCLK_DIV_SHIFT;
3054
3055	lrclk = bclk_rate / params_rate(params);
3056	if (!lrclk) {
3057		dev_err(dai->dev, "Unable to generate LRCLK from %dHz BCLK\n",
3058			bclk_rate);
3059		return -EINVAL;
3060	}
3061	dev_dbg(dai->dev, "Using LRCLK rate %d for actual LRCLK %dHz\n",
3062		lrclk, bclk_rate / lrclk);
3063
3064	snd_soc_component_update_bits(component, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
3065	snd_soc_component_update_bits(component, aif2_reg, WM8994_AIF1_MONO, aif2);
3066	snd_soc_component_update_bits(component, bclk_reg, WM8994_AIF1_BCLK_DIV_MASK, bclk);
3067	snd_soc_component_update_bits(component, lrclk_reg, WM8994_AIF1DAC_RATE_MASK,
3068			    lrclk);
3069	snd_soc_component_update_bits(component, rate_reg, WM8994_AIF1_SR_MASK |
3070			    WM8994_AIF1CLK_RATE_MASK, rate_val);
3071
3072	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
3073		switch (dai->id) {
3074		case 1:
3075			wm8994->dac_rates[0] = params_rate(params);
3076			wm8994_set_retune_mobile(component, 0);
3077			wm8994_set_retune_mobile(component, 1);
3078			break;
3079		case 2:
3080			wm8994->dac_rates[1] = params_rate(params);
3081			wm8994_set_retune_mobile(component, 2);
3082			break;
3083		}
3084	}
3085
3086	return 0;
3087}
3088
3089static int wm8994_aif3_hw_params(struct snd_pcm_substream *substream,
3090				 struct snd_pcm_hw_params *params,
3091				 struct snd_soc_dai *dai)
3092{
3093	struct snd_soc_component *component = dai->component;
3094	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3095	struct wm8994 *control = wm8994->wm8994;
3096	int aif1_reg;
3097	int aif1 = 0;
3098
3099	switch (dai->id) {
3100	case 3:
3101		switch (control->type) {
3102		case WM1811:
3103		case WM8958:
3104			aif1_reg = WM8958_AIF3_CONTROL_1;
3105			break;
3106		default:
3107			return 0;
3108		}
3109		break;
3110	default:
3111		return 0;
3112	}
3113
3114	switch (params_width(params)) {
3115	case 16:
3116		break;
3117	case 20:
3118		aif1 |= 0x20;
3119		break;
3120	case 24:
3121		aif1 |= 0x40;
3122		break;
3123	case 32:
3124		aif1 |= 0x60;
3125		break;
3126	default:
3127		return -EINVAL;
3128	}
3129
3130	return snd_soc_component_update_bits(component, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
3131}
3132
3133static int wm8994_aif_mute(struct snd_soc_dai *codec_dai, int mute,
3134			   int direction)
3135{
3136	struct snd_soc_component *component = codec_dai->component;
3137	int mute_reg;
3138	int reg;
3139
3140	switch (codec_dai->id) {
3141	case 1:
3142		mute_reg = WM8994_AIF1_DAC1_FILTERS_1;
3143		break;
3144	case 2:
3145		mute_reg = WM8994_AIF2_DAC_FILTERS_1;
3146		break;
3147	default:
3148		return -EINVAL;
3149	}
3150
3151	if (mute)
3152		reg = WM8994_AIF1DAC1_MUTE;
3153	else
3154		reg = 0;
3155
3156	snd_soc_component_update_bits(component, mute_reg, WM8994_AIF1DAC1_MUTE, reg);
3157
3158	return 0;
3159}
3160
3161static int wm8994_set_tristate(struct snd_soc_dai *codec_dai, int tristate)
3162{
3163	struct snd_soc_component *component = codec_dai->component;
3164	int reg, val, mask;
3165
3166	switch (codec_dai->id) {
3167	case 1:
3168		reg = WM8994_AIF1_MASTER_SLAVE;
3169		mask = WM8994_AIF1_TRI;
3170		break;
3171	case 2:
3172		reg = WM8994_AIF2_MASTER_SLAVE;
3173		mask = WM8994_AIF2_TRI;
3174		break;
3175	default:
3176		return -EINVAL;
3177	}
3178
3179	if (tristate)
3180		val = mask;
3181	else
3182		val = 0;
3183
3184	return snd_soc_component_update_bits(component, reg, mask, val);
3185}
3186
3187static int wm8994_aif2_probe(struct snd_soc_dai *dai)
3188{
3189	struct snd_soc_component *component = dai->component;
3190
3191	/* Disable the pulls on the AIF if we're using it to save power. */
3192	snd_soc_component_update_bits(component, WM8994_GPIO_3,
3193			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3194	snd_soc_component_update_bits(component, WM8994_GPIO_4,
3195			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3196	snd_soc_component_update_bits(component, WM8994_GPIO_5,
3197			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3198
3199	return 0;
3200}
3201
3202#define WM8994_RATES SNDRV_PCM_RATE_8000_96000
3203
3204#define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
3205			SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
3206
3207static const struct snd_soc_dai_ops wm8994_aif1_dai_ops = {
3208	.set_sysclk	= wm8994_set_dai_sysclk,
3209	.set_fmt	= wm8994_set_dai_fmt,
3210	.hw_params	= wm8994_hw_params,
3211	.mute_stream	= wm8994_aif_mute,
3212	.set_pll	= wm8994_set_fll,
3213	.set_tristate	= wm8994_set_tristate,
3214	.no_capture_mute = 1,
3215};
3216
3217static const struct snd_soc_dai_ops wm8994_aif2_dai_ops = {
3218	.probe		= wm8994_aif2_probe,
3219	.set_sysclk	= wm8994_set_dai_sysclk,
3220	.set_fmt	= wm8994_set_dai_fmt,
3221	.hw_params	= wm8994_hw_params,
3222	.mute_stream	= wm8994_aif_mute,
3223	.set_pll	= wm8994_set_fll,
3224	.set_tristate	= wm8994_set_tristate,
3225	.no_capture_mute = 1,
3226};
3227
3228static const struct snd_soc_dai_ops wm8994_aif3_dai_ops = {
3229	.hw_params	= wm8994_aif3_hw_params,
3230};
3231
3232static struct snd_soc_dai_driver wm8994_dai[] = {
3233	{
3234		.name = "wm8994-aif1",
3235		.id = 1,
3236		.playback = {
3237			.stream_name = "AIF1 Playback",
3238			.channels_min = 1,
3239			.channels_max = 2,
3240			.rates = WM8994_RATES,
3241			.formats = WM8994_FORMATS,
3242			.sig_bits = 24,
3243		},
3244		.capture = {
3245			.stream_name = "AIF1 Capture",
3246			.channels_min = 1,
3247			.channels_max = 2,
3248			.rates = WM8994_RATES,
3249			.formats = WM8994_FORMATS,
3250			.sig_bits = 24,
3251		 },
3252		.ops = &wm8994_aif1_dai_ops,
3253	},
3254	{
3255		.name = "wm8994-aif2",
3256		.id = 2,
3257		.playback = {
3258			.stream_name = "AIF2 Playback",
3259			.channels_min = 1,
3260			.channels_max = 2,
3261			.rates = WM8994_RATES,
3262			.formats = WM8994_FORMATS,
3263			.sig_bits = 24,
3264		},
3265		.capture = {
3266			.stream_name = "AIF2 Capture",
3267			.channels_min = 1,
3268			.channels_max = 2,
3269			.rates = WM8994_RATES,
3270			.formats = WM8994_FORMATS,
3271			.sig_bits = 24,
3272		},
 
3273		.ops = &wm8994_aif2_dai_ops,
3274	},
3275	{
3276		.name = "wm8994-aif3",
3277		.id = 3,
3278		.playback = {
3279			.stream_name = "AIF3 Playback",
3280			.channels_min = 1,
3281			.channels_max = 2,
3282			.rates = WM8994_RATES,
3283			.formats = WM8994_FORMATS,
3284			.sig_bits = 24,
3285		},
3286		.capture = {
3287			.stream_name = "AIF3 Capture",
3288			.channels_min = 1,
3289			.channels_max = 2,
3290			.rates = WM8994_RATES,
3291			.formats = WM8994_FORMATS,
3292			.sig_bits = 24,
3293		 },
3294		.ops = &wm8994_aif3_dai_ops,
3295	}
3296};
3297
3298#ifdef CONFIG_PM
3299static int wm8994_component_suspend(struct snd_soc_component *component)
3300{
3301	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3302	int i, ret;
3303
3304	for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
3305		memcpy(&wm8994->fll_suspend[i], &wm8994->fll[i],
3306		       sizeof(struct wm8994_fll_config));
3307		ret = _wm8994_set_fll(component, i + 1, 0, 0, 0);
3308		if (ret < 0)
3309			dev_warn(component->dev, "Failed to stop FLL%d: %d\n",
3310				 i + 1, ret);
3311	}
3312
3313	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
3314
3315	return 0;
3316}
3317
3318static int wm8994_component_resume(struct snd_soc_component *component)
3319{
3320	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3321	int i, ret;
3322
3323	for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
3324		if (!wm8994->fll_suspend[i].out)
3325			continue;
3326
3327		ret = _wm8994_set_fll(component, i + 1,
3328				     wm8994->fll_suspend[i].src,
3329				     wm8994->fll_suspend[i].in,
3330				     wm8994->fll_suspend[i].out);
3331		if (ret < 0)
3332			dev_warn(component->dev, "Failed to restore FLL%d: %d\n",
3333				 i + 1, ret);
3334	}
3335
3336	return 0;
3337}
3338#else
3339#define wm8994_component_suspend NULL
3340#define wm8994_component_resume NULL
3341#endif
3342
3343static void wm8994_handle_retune_mobile_pdata(struct wm8994_priv *wm8994)
3344{
3345	struct snd_soc_component *component = wm8994->hubs.component;
3346	struct wm8994 *control = wm8994->wm8994;
3347	struct wm8994_pdata *pdata = &control->pdata;
3348	struct snd_kcontrol_new controls[] = {
3349		SOC_ENUM_EXT("AIF1.1 EQ Mode",
3350			     wm8994->retune_mobile_enum,
3351			     wm8994_get_retune_mobile_enum,
3352			     wm8994_put_retune_mobile_enum),
3353		SOC_ENUM_EXT("AIF1.2 EQ Mode",
3354			     wm8994->retune_mobile_enum,
3355			     wm8994_get_retune_mobile_enum,
3356			     wm8994_put_retune_mobile_enum),
3357		SOC_ENUM_EXT("AIF2 EQ Mode",
3358			     wm8994->retune_mobile_enum,
3359			     wm8994_get_retune_mobile_enum,
3360			     wm8994_put_retune_mobile_enum),
3361	};
3362	int ret, i, j;
3363	const char **t;
3364
3365	/* We need an array of texts for the enum API but the number
3366	 * of texts is likely to be less than the number of
3367	 * configurations due to the sample rate dependency of the
3368	 * configurations. */
3369	wm8994->num_retune_mobile_texts = 0;
3370	wm8994->retune_mobile_texts = NULL;
3371	for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
3372		for (j = 0; j < wm8994->num_retune_mobile_texts; j++) {
3373			if (strcmp(pdata->retune_mobile_cfgs[i].name,
3374				   wm8994->retune_mobile_texts[j]) == 0)
3375				break;
3376		}
3377
3378		if (j != wm8994->num_retune_mobile_texts)
3379			continue;
3380
3381		/* Expand the array... */
3382		t = krealloc(wm8994->retune_mobile_texts,
3383			     sizeof(char *) *
3384			     (wm8994->num_retune_mobile_texts + 1),
3385			     GFP_KERNEL);
3386		if (t == NULL)
3387			continue;
3388
3389		/* ...store the new entry... */
3390		t[wm8994->num_retune_mobile_texts] =
3391			pdata->retune_mobile_cfgs[i].name;
3392
3393		/* ...and remember the new version. */
3394		wm8994->num_retune_mobile_texts++;
3395		wm8994->retune_mobile_texts = t;
3396	}
3397
3398	dev_dbg(component->dev, "Allocated %d unique ReTune Mobile names\n",
3399		wm8994->num_retune_mobile_texts);
3400
3401	wm8994->retune_mobile_enum.items = wm8994->num_retune_mobile_texts;
3402	wm8994->retune_mobile_enum.texts = wm8994->retune_mobile_texts;
3403
3404	ret = snd_soc_add_component_controls(wm8994->hubs.component, controls,
3405				   ARRAY_SIZE(controls));
3406	if (ret != 0)
3407		dev_err(wm8994->hubs.component->dev,
3408			"Failed to add ReTune Mobile controls: %d\n", ret);
3409}
3410
3411static void wm8994_handle_pdata(struct wm8994_priv *wm8994)
3412{
3413	struct snd_soc_component *component = wm8994->hubs.component;
3414	struct wm8994 *control = wm8994->wm8994;
3415	struct wm8994_pdata *pdata = &control->pdata;
3416	int ret, i;
3417
3418	if (!pdata)
3419		return;
3420
3421	wm_hubs_handle_analogue_pdata(component, pdata->lineout1_diff,
3422				      pdata->lineout2_diff,
3423				      pdata->lineout1fb,
3424				      pdata->lineout2fb,
3425				      pdata->jd_scthr,
3426				      pdata->jd_thr,
3427				      pdata->micb1_delay,
3428				      pdata->micb2_delay,
3429				      pdata->micbias1_lvl,
3430				      pdata->micbias2_lvl);
3431
3432	dev_dbg(component->dev, "%d DRC configurations\n", pdata->num_drc_cfgs);
3433
3434	if (pdata->num_drc_cfgs) {
3435		struct snd_kcontrol_new controls[] = {
3436			SOC_ENUM_EXT("AIF1DRC1 Mode", wm8994->drc_enum,
3437				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3438			SOC_ENUM_EXT("AIF1DRC2 Mode", wm8994->drc_enum,
3439				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3440			SOC_ENUM_EXT("AIF2DRC Mode", wm8994->drc_enum,
3441				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3442		};
3443
3444		/* We need an array of texts for the enum API */
3445		wm8994->drc_texts = devm_kcalloc(wm8994->hubs.component->dev,
3446			    pdata->num_drc_cfgs, sizeof(char *), GFP_KERNEL);
3447		if (!wm8994->drc_texts)
3448			return;
3449
3450		for (i = 0; i < pdata->num_drc_cfgs; i++)
3451			wm8994->drc_texts[i] = pdata->drc_cfgs[i].name;
3452
3453		wm8994->drc_enum.items = pdata->num_drc_cfgs;
3454		wm8994->drc_enum.texts = wm8994->drc_texts;
3455
3456		ret = snd_soc_add_component_controls(wm8994->hubs.component, controls,
3457					   ARRAY_SIZE(controls));
3458		for (i = 0; i < WM8994_NUM_DRC; i++)
3459			wm8994_set_drc(component, i);
3460	} else {
3461		ret = snd_soc_add_component_controls(wm8994->hubs.component,
3462						 wm8994_drc_controls,
3463						 ARRAY_SIZE(wm8994_drc_controls));
3464	}
3465
3466	if (ret != 0)
3467		dev_err(wm8994->hubs.component->dev,
3468			"Failed to add DRC mode controls: %d\n", ret);
3469
3470
3471	dev_dbg(component->dev, "%d ReTune Mobile configurations\n",
3472		pdata->num_retune_mobile_cfgs);
3473
3474	if (pdata->num_retune_mobile_cfgs)
3475		wm8994_handle_retune_mobile_pdata(wm8994);
3476	else
3477		snd_soc_add_component_controls(wm8994->hubs.component, wm8994_eq_controls,
3478				     ARRAY_SIZE(wm8994_eq_controls));
3479
3480	for (i = 0; i < ARRAY_SIZE(pdata->micbias); i++) {
3481		if (pdata->micbias[i]) {
3482			snd_soc_component_write(component, WM8958_MICBIAS1 + i,
3483				pdata->micbias[i] & 0xffff);
3484		}
3485	}
3486}
3487
3488/**
3489 * wm8994_mic_detect - Enable microphone detection via the WM8994 IRQ
3490 *
3491 * @component:   WM8994 component
3492 * @jack:    jack to report detection events on
3493 * @micbias: microphone bias to detect on
3494 *
3495 * Enable microphone detection via IRQ on the WM8994.  If GPIOs are
3496 * being used to bring out signals to the processor then only platform
3497 * data configuration is needed for WM8994 and processor GPIOs should
3498 * be configured using snd_soc_jack_add_gpios() instead.
3499 *
3500 * Configuration of detection levels is available via the micbias1_lvl
3501 * and micbias2_lvl platform data members.
3502 */
3503int wm8994_mic_detect(struct snd_soc_component *component, struct snd_soc_jack *jack,
3504		      int micbias)
3505{
3506	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3507	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3508	struct wm8994_micdet *micdet;
3509	struct wm8994 *control = wm8994->wm8994;
3510	int reg, ret;
3511
3512	if (control->type != WM8994) {
3513		dev_warn(component->dev, "Not a WM8994\n");
3514		return -EINVAL;
3515	}
3516
3517	pm_runtime_get_sync(component->dev);
3518
3519	switch (micbias) {
3520	case 1:
3521		micdet = &wm8994->micdet[0];
3522		if (jack)
3523			ret = snd_soc_dapm_force_enable_pin(dapm, "MICBIAS1");
3524		else
3525			ret = snd_soc_dapm_disable_pin(dapm, "MICBIAS1");
3526		break;
3527	case 2:
3528		micdet = &wm8994->micdet[1];
3529		if (jack)
3530			ret = snd_soc_dapm_force_enable_pin(dapm, "MICBIAS1");
3531		else
3532			ret = snd_soc_dapm_disable_pin(dapm, "MICBIAS1");
3533		break;
3534	default:
3535		dev_warn(component->dev, "Invalid MICBIAS %d\n", micbias);
3536		return -EINVAL;
3537	}
3538
3539	if (ret != 0)
3540		dev_warn(component->dev, "Failed to configure MICBIAS%d: %d\n",
3541			 micbias, ret);
3542
3543	dev_dbg(component->dev, "Configuring microphone detection on %d %p\n",
3544		micbias, jack);
3545
3546	/* Store the configuration */
3547	micdet->jack = jack;
3548	micdet->detecting = true;
3549
3550	/* If either of the jacks is set up then enable detection */
3551	if (wm8994->micdet[0].jack || wm8994->micdet[1].jack)
3552		reg = WM8994_MICD_ENA;
3553	else
3554		reg = 0;
3555
3556	snd_soc_component_update_bits(component, WM8994_MICBIAS, WM8994_MICD_ENA, reg);
3557
3558	/* enable MICDET and MICSHRT deboune */
3559	snd_soc_component_update_bits(component, WM8994_IRQ_DEBOUNCE,
3560			    WM8994_MIC1_DET_DB_MASK | WM8994_MIC1_SHRT_DB_MASK |
3561			    WM8994_MIC2_DET_DB_MASK | WM8994_MIC2_SHRT_DB_MASK,
3562			    WM8994_MIC1_DET_DB | WM8994_MIC1_SHRT_DB);
3563
3564	snd_soc_dapm_sync(dapm);
3565
3566	pm_runtime_put(component->dev);
3567
3568	return 0;
3569}
3570EXPORT_SYMBOL_GPL(wm8994_mic_detect);
3571
3572static void wm8994_mic_work(struct work_struct *work)
3573{
3574	struct wm8994_priv *priv = container_of(work,
3575						struct wm8994_priv,
3576						mic_work.work);
3577	struct regmap *regmap = priv->wm8994->regmap;
3578	struct device *dev = priv->wm8994->dev;
3579	unsigned int reg;
3580	int ret;
3581	int report;
3582
3583	pm_runtime_get_sync(dev);
3584
3585	ret = regmap_read(regmap, WM8994_INTERRUPT_RAW_STATUS_2, &reg);
3586	if (ret < 0) {
3587		dev_err(dev, "Failed to read microphone status: %d\n",
3588			ret);
3589		pm_runtime_put(dev);
3590		return;
3591	}
3592
3593	dev_dbg(dev, "Microphone status: %x\n", reg);
3594
3595	report = 0;
3596	if (reg & WM8994_MIC1_DET_STS) {
3597		if (priv->micdet[0].detecting)
3598			report = SND_JACK_HEADSET;
3599	}
3600	if (reg & WM8994_MIC1_SHRT_STS) {
3601		if (priv->micdet[0].detecting)
3602			report = SND_JACK_HEADPHONE;
3603		else
3604			report |= SND_JACK_BTN_0;
3605	}
3606	if (report)
3607		priv->micdet[0].detecting = false;
3608	else
3609		priv->micdet[0].detecting = true;
3610
3611	snd_soc_jack_report(priv->micdet[0].jack, report,
3612			    SND_JACK_HEADSET | SND_JACK_BTN_0);
3613
3614	report = 0;
3615	if (reg & WM8994_MIC2_DET_STS) {
3616		if (priv->micdet[1].detecting)
3617			report = SND_JACK_HEADSET;
3618	}
3619	if (reg & WM8994_MIC2_SHRT_STS) {
3620		if (priv->micdet[1].detecting)
3621			report = SND_JACK_HEADPHONE;
3622		else
3623			report |= SND_JACK_BTN_0;
3624	}
3625	if (report)
3626		priv->micdet[1].detecting = false;
3627	else
3628		priv->micdet[1].detecting = true;
3629
3630	snd_soc_jack_report(priv->micdet[1].jack, report,
3631			    SND_JACK_HEADSET | SND_JACK_BTN_0);
3632
3633	pm_runtime_put(dev);
3634}
3635
3636static irqreturn_t wm8994_mic_irq(int irq, void *data)
3637{
3638	struct wm8994_priv *priv = data;
3639	struct snd_soc_component *component = priv->hubs.component;
3640
3641#ifndef CONFIG_SND_SOC_WM8994_MODULE
3642	trace_snd_soc_jack_irq(dev_name(component->dev));
3643#endif
3644
3645	pm_wakeup_event(component->dev, 300);
3646
3647	queue_delayed_work(system_power_efficient_wq,
3648			   &priv->mic_work, msecs_to_jiffies(250));
3649
3650	return IRQ_HANDLED;
3651}
3652
3653/* Should be called with accdet_lock held */
3654static void wm1811_micd_stop(struct snd_soc_component *component)
3655{
3656	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3657	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3658
3659	if (!wm8994->jackdet)
3660		return;
3661
3662	snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1, WM8958_MICD_ENA, 0);
3663
3664	wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_JACK);
3665
3666	if (wm8994->wm8994->pdata.jd_ext_cap)
3667		snd_soc_dapm_disable_pin(dapm, "MICBIAS2");
3668}
3669
3670static void wm8958_button_det(struct snd_soc_component *component, u16 status)
3671{
3672	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3673	int report;
3674
3675	report = 0;
3676	if (status & 0x4)
3677		report |= SND_JACK_BTN_0;
3678
3679	if (status & 0x8)
3680		report |= SND_JACK_BTN_1;
3681
3682	if (status & 0x10)
3683		report |= SND_JACK_BTN_2;
3684
3685	if (status & 0x20)
3686		report |= SND_JACK_BTN_3;
3687
3688	if (status & 0x40)
3689		report |= SND_JACK_BTN_4;
3690
3691	if (status & 0x80)
3692		report |= SND_JACK_BTN_5;
3693
3694	snd_soc_jack_report(wm8994->micdet[0].jack, report,
3695			    wm8994->btn_mask);
3696}
3697
3698static void wm8958_open_circuit_work(struct work_struct *work)
3699{
3700	struct wm8994_priv *wm8994 = container_of(work,
3701						  struct wm8994_priv,
3702						  open_circuit_work.work);
3703	struct device *dev = wm8994->wm8994->dev;
3704
3705	mutex_lock(&wm8994->accdet_lock);
3706
3707	wm1811_micd_stop(wm8994->hubs.component);
3708
3709	dev_dbg(dev, "Reporting open circuit\n");
3710
3711	wm8994->jack_mic = false;
3712	wm8994->mic_detecting = true;
3713
3714	wm8958_micd_set_rate(wm8994->hubs.component);
3715
3716	snd_soc_jack_report(wm8994->micdet[0].jack, 0,
3717			    wm8994->btn_mask |
3718			    SND_JACK_HEADSET);
3719
3720	mutex_unlock(&wm8994->accdet_lock);
3721}
3722
3723static void wm8958_mic_id(void *data, u16 status)
3724{
3725	struct snd_soc_component *component = data;
3726	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3727
3728	/* Either nothing present or just starting detection */
3729	if (!(status & WM8958_MICD_STS)) {
3730		/* If nothing present then clear our statuses */
3731		dev_dbg(component->dev, "Detected open circuit\n");
3732
3733		queue_delayed_work(system_power_efficient_wq,
3734				   &wm8994->open_circuit_work,
3735				   msecs_to_jiffies(2500));
3736		return;
3737	}
3738
3739	/* If the measurement is showing a high impedence we've got a
3740	 * microphone.
3741	 */
3742	if (status & 0x600) {
3743		dev_dbg(component->dev, "Detected microphone\n");
3744
3745		wm8994->mic_detecting = false;
3746		wm8994->jack_mic = true;
3747
3748		wm8958_micd_set_rate(component);
3749
3750		snd_soc_jack_report(wm8994->micdet[0].jack, SND_JACK_HEADSET,
3751				    SND_JACK_HEADSET);
3752	}
3753
3754
3755	if (status & 0xfc) {
3756		dev_dbg(component->dev, "Detected headphone\n");
3757		wm8994->mic_detecting = false;
3758
3759		wm8958_micd_set_rate(component);
3760
3761		/* If we have jackdet that will detect removal */
3762		wm1811_micd_stop(component);
3763
3764		snd_soc_jack_report(wm8994->micdet[0].jack, SND_JACK_HEADPHONE,
3765				    SND_JACK_HEADSET);
3766	}
3767}
3768
3769/* Deferred mic detection to allow for extra settling time */
3770static void wm1811_mic_work(struct work_struct *work)
3771{
3772	struct wm8994_priv *wm8994 = container_of(work, struct wm8994_priv,
3773						  mic_work.work);
3774	struct wm8994 *control = wm8994->wm8994;
3775	struct snd_soc_component *component = wm8994->hubs.component;
3776	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3777
3778	pm_runtime_get_sync(component->dev);
3779
3780	/* If required for an external cap force MICBIAS on */
3781	if (control->pdata.jd_ext_cap) {
3782		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS2");
3783		snd_soc_dapm_sync(dapm);
3784	}
3785
3786	mutex_lock(&wm8994->accdet_lock);
3787
3788	dev_dbg(component->dev, "Starting mic detection\n");
3789
3790	/* Use a user-supplied callback if we have one */
3791	if (wm8994->micd_cb) {
3792		wm8994->micd_cb(wm8994->micd_cb_data);
3793	} else {
3794		/*
3795		 * Start off measument of microphone impedence to find out
3796		 * what's actually there.
3797		 */
3798		wm8994->mic_detecting = true;
3799		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_MIC);
3800
3801		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3802				    WM8958_MICD_ENA, WM8958_MICD_ENA);
3803	}
3804
3805	mutex_unlock(&wm8994->accdet_lock);
3806
3807	pm_runtime_put(component->dev);
3808}
3809
3810static irqreturn_t wm1811_jackdet_irq(int irq, void *data)
3811{
3812	struct wm8994_priv *wm8994 = data;
3813	struct wm8994 *control = wm8994->wm8994;
3814	struct snd_soc_component *component = wm8994->hubs.component;
3815	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3816	int reg, delay;
3817	bool present;
3818
3819	pm_runtime_get_sync(component->dev);
3820
3821	cancel_delayed_work_sync(&wm8994->mic_complete_work);
3822
3823	mutex_lock(&wm8994->accdet_lock);
3824
3825	reg = snd_soc_component_read(component, WM1811_JACKDET_CTRL);
3826	if (reg < 0) {
3827		dev_err(component->dev, "Failed to read jack status: %d\n", reg);
3828		mutex_unlock(&wm8994->accdet_lock);
3829		pm_runtime_put(component->dev);
3830		return IRQ_NONE;
3831	}
3832
3833	dev_dbg(component->dev, "JACKDET %x\n", reg);
3834
3835	present = reg & WM1811_JACKDET_LVL;
3836
3837	if (present) {
3838		dev_dbg(component->dev, "Jack detected\n");
3839
3840		wm8958_micd_set_rate(component);
3841
3842		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3843				    WM8958_MICB2_DISCH, 0);
3844
3845		/* Disable debounce while inserted */
3846		snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3847				    WM1811_JACKDET_DB, 0);
3848
3849		delay = control->pdata.micdet_delay;
3850		queue_delayed_work(system_power_efficient_wq,
3851				   &wm8994->mic_work,
3852				   msecs_to_jiffies(delay));
3853	} else {
3854		dev_dbg(component->dev, "Jack not detected\n");
3855
3856		/* Release wm8994->accdet_lock to avoid deadlock:
3857		 * cancel_delayed_work_sync() takes wm8994->mic_work internal
3858		 * lock and wm1811_mic_work takes wm8994->accdet_lock */
3859		mutex_unlock(&wm8994->accdet_lock);
3860		cancel_delayed_work_sync(&wm8994->mic_work);
3861		mutex_lock(&wm8994->accdet_lock);
3862
3863		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3864				    WM8958_MICB2_DISCH, WM8958_MICB2_DISCH);
3865
3866		/* Enable debounce while removed */
3867		snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3868				    WM1811_JACKDET_DB, WM1811_JACKDET_DB);
3869
3870		wm8994->mic_detecting = false;
3871		wm8994->jack_mic = false;
3872		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3873				    WM8958_MICD_ENA, 0);
3874		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_JACK);
3875	}
3876
3877	mutex_unlock(&wm8994->accdet_lock);
3878
3879	/* Turn off MICBIAS if it was on for an external cap */
3880	if (control->pdata.jd_ext_cap && !present)
3881		snd_soc_dapm_disable_pin(dapm, "MICBIAS2");
3882
3883	if (present)
3884		snd_soc_jack_report(wm8994->micdet[0].jack,
3885				    SND_JACK_MECHANICAL, SND_JACK_MECHANICAL);
3886	else
3887		snd_soc_jack_report(wm8994->micdet[0].jack, 0,
3888				    SND_JACK_MECHANICAL | SND_JACK_HEADSET |
3889				    wm8994->btn_mask);
3890
3891	/* Since we only report deltas force an update, ensures we
3892	 * avoid bootstrapping issues with the core. */
3893	snd_soc_jack_report(wm8994->micdet[0].jack, 0, 0);
3894
3895	pm_runtime_put(component->dev);
3896	return IRQ_HANDLED;
3897}
3898
3899static void wm1811_jackdet_bootstrap(struct work_struct *work)
3900{
3901	struct wm8994_priv *wm8994 = container_of(work,
3902						struct wm8994_priv,
3903						jackdet_bootstrap.work);
3904	wm1811_jackdet_irq(0, wm8994);
3905}
3906
3907/**
3908 * wm8958_mic_detect - Enable microphone detection via the WM8958 IRQ
3909 *
3910 * @component:   WM8958 component
3911 * @jack:    jack to report detection events on
3912 * @det_cb: detection callback
3913 * @det_cb_data: data for detection callback
3914 * @id_cb: mic id callback
3915 * @id_cb_data: data for mic id callback
3916 *
3917 * Enable microphone detection functionality for the WM8958.  By
3918 * default simple detection which supports the detection of up to 6
3919 * buttons plus video and microphone functionality is supported.
3920 *
3921 * The WM8958 has an advanced jack detection facility which is able to
3922 * support complex accessory detection, especially when used in
3923 * conjunction with external circuitry.  In order to provide maximum
3924 * flexiblity a callback is provided which allows a completely custom
3925 * detection algorithm.
3926 */
3927int wm8958_mic_detect(struct snd_soc_component *component, struct snd_soc_jack *jack,
3928		      wm1811_micdet_cb det_cb, void *det_cb_data,
3929		      wm1811_mic_id_cb id_cb, void *id_cb_data)
3930{
3931	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3932	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3933	struct wm8994 *control = wm8994->wm8994;
3934	u16 micd_lvl_sel;
3935
3936	switch (control->type) {
3937	case WM1811:
3938	case WM8958:
3939		break;
3940	default:
3941		return -EINVAL;
3942	}
3943
3944	pm_runtime_get_sync(component->dev);
3945
3946	if (jack) {
3947		snd_soc_dapm_force_enable_pin(dapm, "CLK_SYS");
3948		snd_soc_dapm_sync(dapm);
3949
3950		wm8994->micdet[0].jack = jack;
3951
3952		if (det_cb) {
3953			wm8994->micd_cb = det_cb;
3954			wm8994->micd_cb_data = det_cb_data;
3955		} else {
3956			wm8994->mic_detecting = true;
3957			wm8994->jack_mic = false;
3958		}
3959
3960		if (id_cb) {
3961			wm8994->mic_id_cb = id_cb;
3962			wm8994->mic_id_cb_data = id_cb_data;
3963		} else {
3964			wm8994->mic_id_cb = wm8958_mic_id;
3965			wm8994->mic_id_cb_data = component;
3966		}
3967
3968		wm8958_micd_set_rate(component);
3969
3970		/* Detect microphones and short circuits by default */
3971		if (control->pdata.micd_lvl_sel)
3972			micd_lvl_sel = control->pdata.micd_lvl_sel;
3973		else
3974			micd_lvl_sel = 0x41;
3975
3976		wm8994->btn_mask = SND_JACK_BTN_0 | SND_JACK_BTN_1 |
3977			SND_JACK_BTN_2 | SND_JACK_BTN_3 |
3978			SND_JACK_BTN_4 | SND_JACK_BTN_5;
3979
3980		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_2,
3981				    WM8958_MICD_LVL_SEL_MASK, micd_lvl_sel);
3982
3983		WARN_ON(snd_soc_component_get_bias_level(component) > SND_SOC_BIAS_STANDBY);
3984
3985		/*
3986		 * If we can use jack detection start off with that,
3987		 * otherwise jump straight to microphone detection.
3988		 */
3989		if (wm8994->jackdet) {
3990			/* Disable debounce for the initial detect */
3991			snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3992					    WM1811_JACKDET_DB, 0);
3993
3994			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3995					    WM8958_MICB2_DISCH,
3996					    WM8958_MICB2_DISCH);
3997			snd_soc_component_update_bits(component, WM8994_LDO_1,
3998					    WM8994_LDO1_DISCH, 0);
3999			wm1811_jackdet_set_mode(component,
4000						WM1811_JACKDET_MODE_JACK);
4001		} else {
4002			snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
4003					    WM8958_MICD_ENA, WM8958_MICD_ENA);
4004		}
4005
4006	} else {
4007		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
4008				    WM8958_MICD_ENA, 0);
4009		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_NONE);
4010		snd_soc_dapm_disable_pin(dapm, "CLK_SYS");
4011		snd_soc_dapm_sync(dapm);
4012	}
4013
4014	pm_runtime_put(component->dev);
4015
4016	return 0;
4017}
4018EXPORT_SYMBOL_GPL(wm8958_mic_detect);
4019
4020static void wm8958_mic_work(struct work_struct *work)
4021{
4022	struct wm8994_priv *wm8994 = container_of(work,
4023						  struct wm8994_priv,
4024						  mic_complete_work.work);
4025	struct snd_soc_component *component = wm8994->hubs.component;
4026
4027	pm_runtime_get_sync(component->dev);
4028
4029	mutex_lock(&wm8994->accdet_lock);
4030
4031	wm8994->mic_id_cb(wm8994->mic_id_cb_data, wm8994->mic_status);
4032
4033	mutex_unlock(&wm8994->accdet_lock);
4034
4035	pm_runtime_put(component->dev);
4036}
4037
4038static irqreturn_t wm8958_mic_irq(int irq, void *data)
4039{
4040	struct wm8994_priv *wm8994 = data;
4041	struct snd_soc_component *component = wm8994->hubs.component;
4042	int reg, count, ret, id_delay;
4043
4044	/*
4045	 * Jack detection may have detected a removal simulataneously
4046	 * with an update of the MICDET status; if so it will have
4047	 * stopped detection and we can ignore this interrupt.
4048	 */
4049	if (!(snd_soc_component_read(component, WM8958_MIC_DETECT_1) & WM8958_MICD_ENA))
4050		return IRQ_HANDLED;
4051
4052	cancel_delayed_work_sync(&wm8994->mic_complete_work);
4053	cancel_delayed_work_sync(&wm8994->open_circuit_work);
4054
4055	pm_runtime_get_sync(component->dev);
4056
4057	/* We may occasionally read a detection without an impedence
4058	 * range being provided - if that happens loop again.
4059	 */
4060	count = 10;
4061	do {
4062		reg = snd_soc_component_read(component, WM8958_MIC_DETECT_3);
4063		if (reg < 0) {
4064			dev_err(component->dev,
4065				"Failed to read mic detect status: %d\n",
4066				reg);
4067			pm_runtime_put(component->dev);
4068			return IRQ_NONE;
4069		}
4070
4071		if (!(reg & WM8958_MICD_VALID)) {
4072			dev_dbg(component->dev, "Mic detect data not valid\n");
4073			goto out;
4074		}
4075
4076		if (!(reg & WM8958_MICD_STS) || (reg & WM8958_MICD_LVL_MASK))
4077			break;
4078
4079		msleep(1);
4080	} while (count--);
4081
4082	if (count == 0)
4083		dev_warn(component->dev, "No impedance range reported for jack\n");
4084
4085#ifndef CONFIG_SND_SOC_WM8994_MODULE
4086	trace_snd_soc_jack_irq(dev_name(component->dev));
4087#endif
4088
4089	/* Avoid a transient report when the accessory is being removed */
4090	if (wm8994->jackdet) {
4091		ret = snd_soc_component_read(component, WM1811_JACKDET_CTRL);
4092		if (ret < 0) {
4093			dev_err(component->dev, "Failed to read jack status: %d\n",
4094				ret);
4095		} else if (!(ret & WM1811_JACKDET_LVL)) {
4096			dev_dbg(component->dev, "Ignoring removed jack\n");
4097			goto out;
4098		}
4099	} else if (!(reg & WM8958_MICD_STS)) {
4100		snd_soc_jack_report(wm8994->micdet[0].jack, 0,
4101				    SND_JACK_MECHANICAL | SND_JACK_HEADSET |
4102				    wm8994->btn_mask);
4103		wm8994->mic_detecting = true;
4104		goto out;
4105	}
4106
4107	wm8994->mic_status = reg;
4108	id_delay = wm8994->wm8994->pdata.mic_id_delay;
4109
4110	if (wm8994->mic_detecting)
4111		queue_delayed_work(system_power_efficient_wq,
4112				   &wm8994->mic_complete_work,
4113				   msecs_to_jiffies(id_delay));
4114	else
4115		wm8958_button_det(component, reg);
4116
4117out:
4118	pm_runtime_put(component->dev);
4119	return IRQ_HANDLED;
4120}
4121
4122static irqreturn_t wm8994_fifo_error(int irq, void *data)
4123{
4124	struct snd_soc_component *component = data;
4125
4126	dev_err(component->dev, "FIFO error\n");
4127
4128	return IRQ_HANDLED;
4129}
4130
4131static irqreturn_t wm8994_temp_warn(int irq, void *data)
4132{
4133	struct snd_soc_component *component = data;
4134
4135	dev_err(component->dev, "Thermal warning\n");
4136
4137	return IRQ_HANDLED;
4138}
4139
4140static irqreturn_t wm8994_temp_shut(int irq, void *data)
4141{
4142	struct snd_soc_component *component = data;
4143
4144	dev_crit(component->dev, "Thermal shutdown\n");
4145
4146	return IRQ_HANDLED;
4147}
4148
4149static int wm8994_component_probe(struct snd_soc_component *component)
4150{
4151	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
4152	struct wm8994 *control = dev_get_drvdata(component->dev->parent);
4153	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
4154	unsigned int reg;
4155	int ret, i;
4156
4157	snd_soc_component_init_regmap(component, control->regmap);
4158
4159	wm8994->hubs.component = component;
4160
4161	mutex_init(&wm8994->accdet_lock);
4162	INIT_DELAYED_WORK(&wm8994->jackdet_bootstrap,
4163			  wm1811_jackdet_bootstrap);
4164	INIT_DELAYED_WORK(&wm8994->open_circuit_work,
4165			  wm8958_open_circuit_work);
4166
4167	switch (control->type) {
4168	case WM8994:
4169		INIT_DELAYED_WORK(&wm8994->mic_work, wm8994_mic_work);
4170		break;
4171	case WM1811:
4172		INIT_DELAYED_WORK(&wm8994->mic_work, wm1811_mic_work);
4173		break;
4174	default:
4175		break;
4176	}
4177
4178	INIT_DELAYED_WORK(&wm8994->mic_complete_work, wm8958_mic_work);
4179
4180	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4181		init_completion(&wm8994->fll_locked[i]);
4182
4183	wm8994->micdet_irq = control->pdata.micdet_irq;
4184
4185	/* By default use idle_bias_off, will override for WM8994 */
4186	dapm->idle_bias_off = 1;
4187
4188	/* Set revision-specific configuration */
4189	switch (control->type) {
4190	case WM8994:
4191		/* Single ended line outputs should have VMID on. */
4192		if (!control->pdata.lineout1_diff ||
4193		    !control->pdata.lineout2_diff)
4194			dapm->idle_bias_off = 0;
4195
4196		switch (control->revision) {
4197		case 2:
4198		case 3:
4199			wm8994->hubs.dcs_codes_l = -5;
4200			wm8994->hubs.dcs_codes_r = -5;
4201			wm8994->hubs.hp_startup_mode = 1;
4202			wm8994->hubs.dcs_readback_mode = 1;
4203			wm8994->hubs.series_startup = 1;
4204			break;
4205		default:
4206			wm8994->hubs.dcs_readback_mode = 2;
4207			break;
4208		}
4209		wm8994->hubs.micd_scthr = true;
4210		break;
4211
4212	case WM8958:
4213		wm8994->hubs.dcs_readback_mode = 1;
4214		wm8994->hubs.hp_startup_mode = 1;
4215		wm8994->hubs.micd_scthr = true;
4216
4217		switch (control->revision) {
4218		case 0:
4219			break;
4220		default:
4221			wm8994->fll_byp = true;
4222			break;
4223		}
4224		break;
4225
4226	case WM1811:
4227		wm8994->hubs.dcs_readback_mode = 2;
4228		wm8994->hubs.no_series_update = 1;
4229		wm8994->hubs.hp_startup_mode = 1;
4230		wm8994->hubs.no_cache_dac_hp_direct = true;
4231		wm8994->fll_byp = true;
4232
4233		wm8994->hubs.dcs_codes_l = -9;
4234		wm8994->hubs.dcs_codes_r = -7;
4235
4236		snd_soc_component_update_bits(component, WM8994_ANALOGUE_HP_1,
4237				    WM1811_HPOUT1_ATTN, WM1811_HPOUT1_ATTN);
4238		break;
4239
4240	default:
4241		break;
4242	}
4243
4244	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR,
4245			   wm8994_fifo_error, "FIFO error", component);
4246	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN,
4247			   wm8994_temp_warn, "Thermal warning", component);
4248	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT,
4249			   wm8994_temp_shut, "Thermal shutdown", component);
4250
4251	switch (control->type) {
4252	case WM8994:
4253		if (wm8994->micdet_irq)
4254			ret = request_threaded_irq(wm8994->micdet_irq, NULL,
4255						   wm8994_mic_irq,
4256						   IRQF_TRIGGER_RISING |
4257						   IRQF_ONESHOT,
4258						   "Mic1 detect",
4259						   wm8994);
4260		 else
4261			ret = wm8994_request_irq(wm8994->wm8994,
4262					WM8994_IRQ_MIC1_DET,
4263					wm8994_mic_irq, "Mic 1 detect",
4264					wm8994);
4265
4266		if (ret != 0)
4267			dev_warn(component->dev,
4268				 "Failed to request Mic1 detect IRQ: %d\n",
4269				 ret);
4270
4271
4272		ret = wm8994_request_irq(wm8994->wm8994,
4273					 WM8994_IRQ_MIC1_SHRT,
4274					 wm8994_mic_irq, "Mic 1 short",
4275					 wm8994);
4276		if (ret != 0)
4277			dev_warn(component->dev,
4278				 "Failed to request Mic1 short IRQ: %d\n",
4279				 ret);
4280
4281		ret = wm8994_request_irq(wm8994->wm8994,
4282					 WM8994_IRQ_MIC2_DET,
4283					 wm8994_mic_irq, "Mic 2 detect",
4284					 wm8994);
4285		if (ret != 0)
4286			dev_warn(component->dev,
4287				 "Failed to request Mic2 detect IRQ: %d\n",
4288				 ret);
4289
4290		ret = wm8994_request_irq(wm8994->wm8994,
4291					 WM8994_IRQ_MIC2_SHRT,
4292					 wm8994_mic_irq, "Mic 2 short",
4293					 wm8994);
4294		if (ret != 0)
4295			dev_warn(component->dev,
4296				 "Failed to request Mic2 short IRQ: %d\n",
4297				 ret);
4298		break;
4299
4300	case WM8958:
4301	case WM1811:
4302		if (wm8994->micdet_irq) {
4303			ret = request_threaded_irq(wm8994->micdet_irq, NULL,
4304						   wm8958_mic_irq,
4305						   IRQF_TRIGGER_RISING |
4306						   IRQF_ONESHOT,
4307						   "Mic detect",
4308						   wm8994);
4309			if (ret != 0)
4310				dev_warn(component->dev,
4311					 "Failed to request Mic detect IRQ: %d\n",
4312					 ret);
4313		} else {
4314			wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_MIC1_DET,
4315					   wm8958_mic_irq, "Mic detect",
4316					   wm8994);
4317		}
4318	}
4319
4320	switch (control->type) {
4321	case WM1811:
4322		if (control->cust_id > 1 || control->revision > 1) {
4323			ret = wm8994_request_irq(wm8994->wm8994,
4324						 WM8994_IRQ_GPIO(6),
4325						 wm1811_jackdet_irq, "JACKDET",
4326						 wm8994);
4327			if (ret == 0)
4328				wm8994->jackdet = true;
4329		}
4330		break;
4331	default:
4332		break;
4333	}
4334
4335	wm8994->fll_locked_irq = true;
4336	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++) {
4337		ret = wm8994_request_irq(wm8994->wm8994,
4338					 WM8994_IRQ_FLL1_LOCK + i,
4339					 wm8994_fll_locked_irq, "FLL lock",
4340					 &wm8994->fll_locked[i]);
4341		if (ret != 0)
4342			wm8994->fll_locked_irq = false;
4343	}
4344
4345	/* Make sure we can read from the GPIOs if they're inputs */
4346	pm_runtime_get_sync(component->dev);
4347
4348	/* Remember if AIFnLRCLK is configured as a GPIO.  This should be
4349	 * configured on init - if a system wants to do this dynamically
4350	 * at runtime we can deal with that then.
4351	 */
4352	ret = regmap_read(control->regmap, WM8994_GPIO_1, &reg);
4353	if (ret < 0) {
4354		dev_err(component->dev, "Failed to read GPIO1 state: %d\n", ret);
4355		goto err_irq;
4356	}
4357	if ((reg & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
4358		wm8994->lrclk_shared[0] = 1;
4359		wm8994_dai[0].symmetric_rate = 1;
4360	} else {
4361		wm8994->lrclk_shared[0] = 0;
4362	}
4363
4364	ret = regmap_read(control->regmap, WM8994_GPIO_6, &reg);
4365	if (ret < 0) {
4366		dev_err(component->dev, "Failed to read GPIO6 state: %d\n", ret);
4367		goto err_irq;
4368	}
4369	if ((reg & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
4370		wm8994->lrclk_shared[1] = 1;
4371		wm8994_dai[1].symmetric_rate = 1;
4372	} else {
4373		wm8994->lrclk_shared[1] = 0;
4374	}
4375
4376	pm_runtime_put(component->dev);
4377
4378	/* Latch volume update bits */
4379	for (i = 0; i < ARRAY_SIZE(wm8994_vu_bits); i++)
4380		snd_soc_component_update_bits(component, wm8994_vu_bits[i].reg,
4381				    wm8994_vu_bits[i].mask,
4382				    wm8994_vu_bits[i].mask);
4383
4384	if (control->type != WM1811) {
4385		for (i = 0; i < ARRAY_SIZE(wm8994_adc2_dac2_vu_bits); i++)
4386			snd_soc_component_update_bits(component,
4387					wm8994_adc2_dac2_vu_bits[i].reg,
4388					wm8994_adc2_dac2_vu_bits[i].mask,
4389					wm8994_adc2_dac2_vu_bits[i].mask);
4390	}
4391
4392	/* Set the low bit of the 3D stereo depth so TLV matches */
4393	snd_soc_component_update_bits(component, WM8994_AIF1_DAC1_FILTERS_2,
4394			    1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT,
4395			    1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT);
4396	snd_soc_component_update_bits(component, WM8994_AIF1_DAC2_FILTERS_2,
4397			    1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT,
4398			    1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT);
4399	snd_soc_component_update_bits(component, WM8994_AIF2_DAC_FILTERS_2,
4400			    1 << WM8994_AIF2DAC_3D_GAIN_SHIFT,
4401			    1 << WM8994_AIF2DAC_3D_GAIN_SHIFT);
4402
4403	/* Unconditionally enable AIF1 ADC TDM mode on chips which can
4404	 * use this; it only affects behaviour on idle TDM clock
4405	 * cycles. */
4406	switch (control->type) {
4407	case WM8994:
4408	case WM8958:
4409		snd_soc_component_update_bits(component, WM8994_AIF1_CONTROL_1,
4410				    WM8994_AIF1ADC_TDM, WM8994_AIF1ADC_TDM);
4411		break;
4412	default:
4413		break;
4414	}
4415
4416	/* Put MICBIAS into bypass mode by default on newer devices */
4417	switch (control->type) {
4418	case WM8958:
4419	case WM1811:
4420		snd_soc_component_update_bits(component, WM8958_MICBIAS1,
4421				    WM8958_MICB1_MODE, WM8958_MICB1_MODE);
4422		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
4423				    WM8958_MICB2_MODE, WM8958_MICB2_MODE);
4424		break;
4425	default:
4426		break;
4427	}
4428
4429	wm8994->hubs.check_class_w_digital = wm8994_check_class_w_digital;
4430	wm_hubs_update_class_w(component);
4431
4432	wm8994_handle_pdata(wm8994);
4433
4434	wm_hubs_add_analogue_controls(component);
4435	snd_soc_add_component_controls(component, wm8994_common_snd_controls,
4436				       ARRAY_SIZE(wm8994_common_snd_controls));
4437	snd_soc_dapm_new_controls(dapm, wm8994_dapm_widgets,
4438				  ARRAY_SIZE(wm8994_dapm_widgets));
4439
4440	switch (control->type) {
4441	case WM8994:
4442		snd_soc_add_component_controls(component, wm8994_snd_controls,
4443					       ARRAY_SIZE(wm8994_snd_controls));
4444		snd_soc_dapm_new_controls(dapm, wm8994_specific_dapm_widgets,
4445					  ARRAY_SIZE(wm8994_specific_dapm_widgets));
4446		if (control->revision < 4) {
4447			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets,
4448						  ARRAY_SIZE(wm8994_lateclk_revd_widgets));
4449			snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets,
4450						  ARRAY_SIZE(wm8994_adc_revd_widgets));
4451			snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets,
4452						  ARRAY_SIZE(wm8994_dac_revd_widgets));
4453		} else {
4454			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4455						  ARRAY_SIZE(wm8994_lateclk_widgets));
4456			snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4457						  ARRAY_SIZE(wm8994_adc_widgets));
4458			snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4459						  ARRAY_SIZE(wm8994_dac_widgets));
4460		}
4461		break;
4462	case WM8958:
4463		snd_soc_add_component_controls(component, wm8994_snd_controls,
4464					       ARRAY_SIZE(wm8994_snd_controls));
4465		snd_soc_add_component_controls(component, wm8958_snd_controls,
4466					       ARRAY_SIZE(wm8958_snd_controls));
4467		snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets,
4468					  ARRAY_SIZE(wm8958_dapm_widgets));
4469		if (control->revision < 1) {
4470			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets,
4471						  ARRAY_SIZE(wm8994_lateclk_revd_widgets));
4472			snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets,
4473						  ARRAY_SIZE(wm8994_adc_revd_widgets));
4474			snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets,
4475						  ARRAY_SIZE(wm8994_dac_revd_widgets));
4476		} else {
4477			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4478						  ARRAY_SIZE(wm8994_lateclk_widgets));
4479			snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4480						  ARRAY_SIZE(wm8994_adc_widgets));
4481			snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4482						  ARRAY_SIZE(wm8994_dac_widgets));
4483		}
4484		break;
4485
4486	case WM1811:
4487		snd_soc_add_component_controls(component, wm8958_snd_controls,
4488				     ARRAY_SIZE(wm8958_snd_controls));
4489		snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets,
4490					  ARRAY_SIZE(wm8958_dapm_widgets));
4491		snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4492					  ARRAY_SIZE(wm8994_lateclk_widgets));
4493		snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4494					  ARRAY_SIZE(wm8994_adc_widgets));
4495		snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4496					  ARRAY_SIZE(wm8994_dac_widgets));
4497		break;
4498	}
4499
4500	wm_hubs_add_analogue_routes(component, 0, 0);
4501	ret = wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4502				 wm_hubs_dcs_done, "DC servo done",
4503				 &wm8994->hubs);
4504	if (ret == 0)
4505		wm8994->hubs.dcs_done_irq = true;
4506	snd_soc_dapm_add_routes(dapm, intercon, ARRAY_SIZE(intercon));
4507
4508	switch (control->type) {
4509	case WM8994:
4510		snd_soc_dapm_add_routes(dapm, wm8994_intercon,
4511					ARRAY_SIZE(wm8994_intercon));
4512
4513		if (control->revision < 4) {
4514			snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon,
4515						ARRAY_SIZE(wm8994_revd_intercon));
4516			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon,
4517						ARRAY_SIZE(wm8994_lateclk_revd_intercon));
4518		} else {
4519			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4520						ARRAY_SIZE(wm8994_lateclk_intercon));
4521		}
4522		break;
4523	case WM8958:
4524		if (control->revision < 1) {
4525			snd_soc_dapm_add_routes(dapm, wm8994_intercon,
4526						ARRAY_SIZE(wm8994_intercon));
4527			snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon,
4528						ARRAY_SIZE(wm8994_revd_intercon));
4529			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon,
4530						ARRAY_SIZE(wm8994_lateclk_revd_intercon));
4531		} else {
4532			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4533						ARRAY_SIZE(wm8994_lateclk_intercon));
4534			snd_soc_dapm_add_routes(dapm, wm8958_intercon,
4535						ARRAY_SIZE(wm8958_intercon));
4536		}
4537
4538		wm8958_dsp2_init(component);
4539		break;
4540	case WM1811:
4541		snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4542					ARRAY_SIZE(wm8994_lateclk_intercon));
4543		snd_soc_dapm_add_routes(dapm, wm8958_intercon,
4544					ARRAY_SIZE(wm8958_intercon));
4545		break;
4546	}
4547
4548	return 0;
4549
4550err_irq:
4551	if (wm8994->jackdet)
4552		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_GPIO(6), wm8994);
4553	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_SHRT, wm8994);
4554	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_DET, wm8994);
4555	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_SHRT, wm8994);
4556	if (wm8994->micdet_irq)
4557		free_irq(wm8994->micdet_irq, wm8994);
4558	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4559		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FLL1_LOCK + i,
4560				&wm8994->fll_locked[i]);
4561	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4562			&wm8994->hubs);
4563	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR, component);
4564	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT, component);
4565	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN, component);
4566
4567	return ret;
4568}
4569
4570static void wm8994_component_remove(struct snd_soc_component *component)
4571{
4572	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
4573	struct wm8994 *control = wm8994->wm8994;
4574	int i;
4575
4576	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4577		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FLL1_LOCK + i,
4578				&wm8994->fll_locked[i]);
4579
4580	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4581			&wm8994->hubs);
4582	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR, component);
4583	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT, component);
4584	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN, component);
4585
4586	if (wm8994->jackdet)
4587		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_GPIO(6), wm8994);
4588
4589	switch (control->type) {
4590	case WM8994:
4591		if (wm8994->micdet_irq)
4592			free_irq(wm8994->micdet_irq, wm8994);
4593		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_DET,
4594				wm8994);
4595		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_SHRT,
4596				wm8994);
4597		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_DET,
4598				wm8994);
4599		break;
4600
4601	case WM1811:
4602	case WM8958:
4603		if (wm8994->micdet_irq)
4604			free_irq(wm8994->micdet_irq, wm8994);
4605		break;
4606	}
4607	release_firmware(wm8994->mbc);
4608	release_firmware(wm8994->mbc_vss);
4609	release_firmware(wm8994->enh_eq);
4610	kfree(wm8994->retune_mobile_texts);
4611}
4612
4613static const struct snd_soc_component_driver soc_component_dev_wm8994 = {
4614	.probe			= wm8994_component_probe,
4615	.remove			= wm8994_component_remove,
4616	.suspend		= wm8994_component_suspend,
4617	.resume			= wm8994_component_resume,
4618	.set_bias_level		= wm8994_set_bias_level,
4619	.idle_bias_on		= 1,
4620	.use_pmdown_time	= 1,
4621	.endianness		= 1,
 
4622};
4623
4624static int wm8994_probe(struct platform_device *pdev)
4625{
4626	struct wm8994_priv *wm8994;
4627	int ret;
4628
4629	wm8994 = devm_kzalloc(&pdev->dev, sizeof(struct wm8994_priv),
4630			      GFP_KERNEL);
4631	if (wm8994 == NULL)
4632		return -ENOMEM;
4633	platform_set_drvdata(pdev, wm8994);
4634
4635	mutex_init(&wm8994->fw_lock);
4636
4637	wm8994->wm8994 = dev_get_drvdata(pdev->dev.parent);
4638
4639	wm8994->mclk[WM8994_MCLK1].id = "MCLK1";
4640	wm8994->mclk[WM8994_MCLK2].id = "MCLK2";
4641
4642	ret = devm_clk_bulk_get_optional(pdev->dev.parent, ARRAY_SIZE(wm8994->mclk),
4643					 wm8994->mclk);
4644	if (ret < 0) {
4645		dev_err(&pdev->dev, "Failed to get clocks: %d\n", ret);
4646		return ret;
4647	}
4648
4649	pm_runtime_enable(&pdev->dev);
4650	pm_runtime_idle(&pdev->dev);
4651
4652	ret = devm_snd_soc_register_component(&pdev->dev, &soc_component_dev_wm8994,
4653			wm8994_dai, ARRAY_SIZE(wm8994_dai));
4654	if (ret < 0)
4655		pm_runtime_disable(&pdev->dev);
4656
4657	return ret;
4658}
4659
4660static void wm8994_remove(struct platform_device *pdev)
4661{
4662	pm_runtime_disable(&pdev->dev);
 
 
4663}
4664
4665#ifdef CONFIG_PM_SLEEP
4666static int wm8994_suspend(struct device *dev)
4667{
4668	struct wm8994_priv *wm8994 = dev_get_drvdata(dev);
4669
4670	/* Drop down to power saving mode when system is suspended */
4671	if (wm8994->jackdet && !wm8994->active_refcount)
4672		regmap_update_bits(wm8994->wm8994->regmap, WM8994_ANTIPOP_2,
4673				   WM1811_JACKDET_MODE_MASK,
4674				   wm8994->jackdet_mode);
4675
4676	return 0;
4677}
4678
4679static int wm8994_resume(struct device *dev)
4680{
4681	struct wm8994_priv *wm8994 = dev_get_drvdata(dev);
4682
4683	if (wm8994->jackdet && wm8994->jackdet_mode)
4684		regmap_update_bits(wm8994->wm8994->regmap, WM8994_ANTIPOP_2,
4685				   WM1811_JACKDET_MODE_MASK,
4686				   WM1811_JACKDET_MODE_AUDIO);
4687
4688	return 0;
4689}
4690#endif
4691
4692static const struct dev_pm_ops wm8994_pm_ops = {
4693	SET_SYSTEM_SLEEP_PM_OPS(wm8994_suspend, wm8994_resume)
4694};
4695
4696static struct platform_driver wm8994_codec_driver = {
4697	.driver = {
4698		.name = "wm8994-codec",
4699		.pm = &wm8994_pm_ops,
4700	},
4701	.probe = wm8994_probe,
4702	.remove = wm8994_remove,
4703};
4704
4705module_platform_driver(wm8994_codec_driver);
4706
4707MODULE_DESCRIPTION("ASoC WM8994 driver");
4708MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
4709MODULE_LICENSE("GPL");
4710MODULE_ALIAS("platform:wm8994-codec");
v4.17
 
   1/*
   2 * wm8994.c  --  WM8994 ALSA SoC Audio driver
   3 *
   4 * Copyright 2009-12 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/gcd.h>
  20#include <linux/i2c.h>
  21#include <linux/platform_device.h>
  22#include <linux/pm_runtime.h>
  23#include <linux/regulator/consumer.h>
  24#include <linux/slab.h>
  25#include <sound/core.h>
  26#include <sound/jack.h>
  27#include <sound/pcm.h>
  28#include <sound/pcm_params.h>
  29#include <sound/soc.h>
  30#include <sound/initval.h>
  31#include <sound/tlv.h>
  32#include <trace/events/asoc.h>
  33
  34#include <linux/mfd/wm8994/core.h>
  35#include <linux/mfd/wm8994/registers.h>
  36#include <linux/mfd/wm8994/pdata.h>
  37#include <linux/mfd/wm8994/gpio.h>
  38
  39#include "wm8994.h"
  40#include "wm_hubs.h"
  41
  42#define WM1811_JACKDET_MODE_NONE  0x0000
  43#define WM1811_JACKDET_MODE_JACK  0x0100
  44#define WM1811_JACKDET_MODE_MIC   0x0080
  45#define WM1811_JACKDET_MODE_AUDIO 0x0180
  46
  47#define WM8994_NUM_DRC 3
  48#define WM8994_NUM_EQ  3
  49
  50static struct {
  51	unsigned int reg;
  52	unsigned int mask;
  53} wm8994_vu_bits[] = {
 
 
  54	{ WM8994_LEFT_LINE_INPUT_1_2_VOLUME, WM8994_IN1_VU },
  55	{ WM8994_RIGHT_LINE_INPUT_1_2_VOLUME, WM8994_IN1_VU },
  56	{ WM8994_LEFT_LINE_INPUT_3_4_VOLUME, WM8994_IN2_VU },
  57	{ WM8994_RIGHT_LINE_INPUT_3_4_VOLUME, WM8994_IN2_VU },
  58	{ WM8994_SPEAKER_VOLUME_LEFT, WM8994_SPKOUT_VU },
  59	{ WM8994_SPEAKER_VOLUME_RIGHT, WM8994_SPKOUT_VU },
  60	{ WM8994_LEFT_OUTPUT_VOLUME, WM8994_HPOUT1_VU },
  61	{ WM8994_RIGHT_OUTPUT_VOLUME, WM8994_HPOUT1_VU },
  62	{ WM8994_LEFT_OPGA_VOLUME, WM8994_MIXOUT_VU },
  63	{ WM8994_RIGHT_OPGA_VOLUME, WM8994_MIXOUT_VU },
  64
  65	{ WM8994_AIF1_DAC1_LEFT_VOLUME, WM8994_AIF1DAC1_VU },
  66	{ WM8994_AIF1_DAC1_RIGHT_VOLUME, WM8994_AIF1DAC1_VU },
  67	{ WM8994_AIF1_DAC2_LEFT_VOLUME, WM8994_AIF1DAC2_VU },
  68	{ WM8994_AIF1_DAC2_RIGHT_VOLUME, WM8994_AIF1DAC2_VU },
  69	{ WM8994_AIF2_DAC_LEFT_VOLUME, WM8994_AIF2DAC_VU },
  70	{ WM8994_AIF2_DAC_RIGHT_VOLUME, WM8994_AIF2DAC_VU },
  71	{ WM8994_AIF1_ADC1_LEFT_VOLUME, WM8994_AIF1ADC1_VU },
  72	{ WM8994_AIF1_ADC1_RIGHT_VOLUME, WM8994_AIF1ADC1_VU },
  73	{ WM8994_AIF1_ADC2_LEFT_VOLUME, WM8994_AIF1ADC2_VU },
  74	{ WM8994_AIF1_ADC2_RIGHT_VOLUME, WM8994_AIF1ADC2_VU },
  75	{ WM8994_AIF2_ADC_LEFT_VOLUME, WM8994_AIF2ADC_VU },
  76	{ WM8994_AIF2_ADC_RIGHT_VOLUME, WM8994_AIF1ADC2_VU },
  77	{ WM8994_DAC1_LEFT_VOLUME, WM8994_DAC1_VU },
  78	{ WM8994_DAC1_RIGHT_VOLUME, WM8994_DAC1_VU },
  79	{ WM8994_DAC2_LEFT_VOLUME, WM8994_DAC2_VU },
  80	{ WM8994_DAC2_RIGHT_VOLUME, WM8994_DAC2_VU },
  81};
  82
 
 
 
 
 
 
 
 
  83static int wm8994_drc_base[] = {
  84	WM8994_AIF1_DRC1_1,
  85	WM8994_AIF1_DRC2_1,
  86	WM8994_AIF2_DRC_1,
  87};
  88
  89static int wm8994_retune_mobile_base[] = {
  90	WM8994_AIF1_DAC1_EQ_GAINS_1,
  91	WM8994_AIF1_DAC2_EQ_GAINS_1,
  92	WM8994_AIF2_EQ_GAINS_1,
  93};
  94
  95static const struct wm8958_micd_rate micdet_rates[] = {
  96	{ 32768,       true,  1, 4 },
  97	{ 32768,       false, 1, 1 },
  98	{ 44100 * 256, true,  7, 10 },
  99	{ 44100 * 256, false, 7, 10 },
 100};
 101
 102static const struct wm8958_micd_rate jackdet_rates[] = {
 103	{ 32768,       true,  0, 1 },
 104	{ 32768,       false, 0, 1 },
 105	{ 44100 * 256, true,  10, 10 },
 106	{ 44100 * 256, false, 7, 8 },
 107};
 108
 109static void wm8958_micd_set_rate(struct snd_soc_component *component)
 110{
 111	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 112	struct wm8994 *control = wm8994->wm8994;
 113	int best, i, sysclk, val;
 114	bool idle;
 115	const struct wm8958_micd_rate *rates;
 116	int num_rates;
 117
 118	idle = !wm8994->jack_mic;
 119
 120	sysclk = snd_soc_component_read32(component, WM8994_CLOCKING_1);
 121	if (sysclk & WM8994_SYSCLK_SRC)
 122		sysclk = wm8994->aifclk[1];
 123	else
 124		sysclk = wm8994->aifclk[0];
 125
 126	if (control->pdata.micd_rates) {
 127		rates = control->pdata.micd_rates;
 128		num_rates = control->pdata.num_micd_rates;
 129	} else if (wm8994->jackdet) {
 130		rates = jackdet_rates;
 131		num_rates = ARRAY_SIZE(jackdet_rates);
 132	} else {
 133		rates = micdet_rates;
 134		num_rates = ARRAY_SIZE(micdet_rates);
 135	}
 136
 137	best = 0;
 138	for (i = 0; i < num_rates; i++) {
 139		if (rates[i].idle != idle)
 140			continue;
 141		if (abs(rates[i].sysclk - sysclk) <
 142		    abs(rates[best].sysclk - sysclk))
 143			best = i;
 144		else if (rates[best].idle != idle)
 145			best = i;
 146	}
 147
 148	val = rates[best].start << WM8958_MICD_BIAS_STARTTIME_SHIFT
 149		| rates[best].rate << WM8958_MICD_RATE_SHIFT;
 150
 151	dev_dbg(component->dev, "MICD rate %d,%d for %dHz %s\n",
 152		rates[best].start, rates[best].rate, sysclk,
 153		idle ? "idle" : "active");
 154
 155	snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
 156			    WM8958_MICD_BIAS_STARTTIME_MASK |
 157			    WM8958_MICD_RATE_MASK, val);
 158}
 159
 160static int configure_aif_clock(struct snd_soc_component *component, int aif)
 161{
 162	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 163	int rate;
 164	int reg1 = 0;
 165	int offset;
 166
 167	if (aif)
 168		offset = 4;
 169	else
 170		offset = 0;
 171
 172	switch (wm8994->sysclk[aif]) {
 173	case WM8994_SYSCLK_MCLK1:
 174		rate = wm8994->mclk[0];
 175		break;
 176
 177	case WM8994_SYSCLK_MCLK2:
 178		reg1 |= 0x8;
 179		rate = wm8994->mclk[1];
 180		break;
 181
 182	case WM8994_SYSCLK_FLL1:
 183		reg1 |= 0x10;
 184		rate = wm8994->fll[0].out;
 185		break;
 186
 187	case WM8994_SYSCLK_FLL2:
 188		reg1 |= 0x18;
 189		rate = wm8994->fll[1].out;
 190		break;
 191
 192	default:
 193		return -EINVAL;
 194	}
 195
 196	if (rate >= 13500000) {
 197		rate /= 2;
 198		reg1 |= WM8994_AIF1CLK_DIV;
 199
 200		dev_dbg(component->dev, "Dividing AIF%d clock to %dHz\n",
 201			aif + 1, rate);
 202	}
 203
 204	wm8994->aifclk[aif] = rate;
 205
 206	snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1 + offset,
 207			    WM8994_AIF1CLK_SRC_MASK | WM8994_AIF1CLK_DIV,
 208			    reg1);
 209
 210	return 0;
 211}
 212
 213static int configure_clock(struct snd_soc_component *component)
 214{
 215	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
 216	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 217	int change, new;
 218
 219	/* Bring up the AIF clocks first */
 220	configure_aif_clock(component, 0);
 221	configure_aif_clock(component, 1);
 222
 223	/* Then switch CLK_SYS over to the higher of them; a change
 224	 * can only happen as a result of a clocking change which can
 225	 * only be made outside of DAPM so we can safely redo the
 226	 * clocking.
 227	 */
 228
 229	/* If they're equal it doesn't matter which is used */
 230	if (wm8994->aifclk[0] == wm8994->aifclk[1]) {
 231		wm8958_micd_set_rate(component);
 232		return 0;
 233	}
 234
 235	if (wm8994->aifclk[0] < wm8994->aifclk[1])
 236		new = WM8994_SYSCLK_SRC;
 237	else
 238		new = 0;
 239
 240	change = snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
 241				     WM8994_SYSCLK_SRC, new);
 242	if (change)
 243		snd_soc_dapm_sync(dapm);
 244
 245	wm8958_micd_set_rate(component);
 246
 247	return 0;
 248}
 249
 250static int check_clk_sys(struct snd_soc_dapm_widget *source,
 251			 struct snd_soc_dapm_widget *sink)
 252{
 253	struct snd_soc_component *component = snd_soc_dapm_to_component(source->dapm);
 254	int reg = snd_soc_component_read32(component, WM8994_CLOCKING_1);
 255	const char *clk;
 256
 257	/* Check what we're currently using for CLK_SYS */
 258	if (reg & WM8994_SYSCLK_SRC)
 259		clk = "AIF2CLK";
 260	else
 261		clk = "AIF1CLK";
 262
 263	return strcmp(source->name, clk) == 0;
 264}
 265
 266static const char *sidetone_hpf_text[] = {
 267	"2.7kHz", "1.35kHz", "675Hz", "370Hz", "180Hz", "90Hz", "45Hz"
 268};
 269
 270static SOC_ENUM_SINGLE_DECL(sidetone_hpf,
 271			    WM8994_SIDETONE, 7, sidetone_hpf_text);
 272
 273static const char *adc_hpf_text[] = {
 274	"HiFi", "Voice 1", "Voice 2", "Voice 3"
 275};
 276
 277static SOC_ENUM_SINGLE_DECL(aif1adc1_hpf,
 278			    WM8994_AIF1_ADC1_FILTERS, 13, adc_hpf_text);
 279
 280static SOC_ENUM_SINGLE_DECL(aif1adc2_hpf,
 281			    WM8994_AIF1_ADC2_FILTERS, 13, adc_hpf_text);
 282
 283static SOC_ENUM_SINGLE_DECL(aif2adc_hpf,
 284			    WM8994_AIF2_ADC_FILTERS, 13, adc_hpf_text);
 285
 286static const DECLARE_TLV_DB_SCALE(aif_tlv, 0, 600, 0);
 287static const DECLARE_TLV_DB_SCALE(digital_tlv, -7200, 75, 1);
 288static const DECLARE_TLV_DB_SCALE(st_tlv, -3600, 300, 0);
 289static const DECLARE_TLV_DB_SCALE(wm8994_3d_tlv, -1600, 183, 0);
 290static const DECLARE_TLV_DB_SCALE(eq_tlv, -1200, 100, 0);
 291static const DECLARE_TLV_DB_SCALE(ng_tlv, -10200, 600, 0);
 292static const DECLARE_TLV_DB_SCALE(mixin_boost_tlv, 0, 900, 0);
 293
 294#define WM8994_DRC_SWITCH(xname, reg, shift) \
 295	SOC_SINGLE_EXT(xname, reg, shift, 1, 0, \
 296		snd_soc_get_volsw, wm8994_put_drc_sw)
 297
 298static int wm8994_put_drc_sw(struct snd_kcontrol *kcontrol,
 299			     struct snd_ctl_elem_value *ucontrol)
 300{
 301	struct soc_mixer_control *mc =
 302		(struct soc_mixer_control *)kcontrol->private_value;
 303	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 304	int mask, ret;
 305
 306	/* Can't enable both ADC and DAC paths simultaneously */
 307	if (mc->shift == WM8994_AIF1DAC1_DRC_ENA_SHIFT)
 308		mask = WM8994_AIF1ADC1L_DRC_ENA_MASK |
 309			WM8994_AIF1ADC1R_DRC_ENA_MASK;
 310	else
 311		mask = WM8994_AIF1DAC1_DRC_ENA_MASK;
 312
 313	ret = snd_soc_component_read32(component, mc->reg);
 314	if (ret < 0)
 315		return ret;
 316	if (ret & mask)
 317		return -EINVAL;
 318
 319	return snd_soc_put_volsw(kcontrol, ucontrol);
 320}
 321
 322static void wm8994_set_drc(struct snd_soc_component *component, int drc)
 323{
 324	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 325	struct wm8994 *control = wm8994->wm8994;
 326	struct wm8994_pdata *pdata = &control->pdata;
 327	int base = wm8994_drc_base[drc];
 328	int cfg = wm8994->drc_cfg[drc];
 329	int save, i;
 330
 331	/* Save any enables; the configuration should clear them. */
 332	save = snd_soc_component_read32(component, base);
 333	save &= WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA |
 334		WM8994_AIF1ADC1R_DRC_ENA;
 335
 336	for (i = 0; i < WM8994_DRC_REGS; i++)
 337		snd_soc_component_update_bits(component, base + i, 0xffff,
 338				    pdata->drc_cfgs[cfg].regs[i]);
 339
 340	snd_soc_component_update_bits(component, base, WM8994_AIF1DAC1_DRC_ENA |
 341			     WM8994_AIF1ADC1L_DRC_ENA |
 342			     WM8994_AIF1ADC1R_DRC_ENA, save);
 343}
 344
 345/* Icky as hell but saves code duplication */
 346static int wm8994_get_drc(const char *name)
 347{
 348	if (strcmp(name, "AIF1DRC1 Mode") == 0)
 349		return 0;
 350	if (strcmp(name, "AIF1DRC2 Mode") == 0)
 351		return 1;
 352	if (strcmp(name, "AIF2DRC Mode") == 0)
 353		return 2;
 354	return -EINVAL;
 355}
 356
 357static int wm8994_put_drc_enum(struct snd_kcontrol *kcontrol,
 358			       struct snd_ctl_elem_value *ucontrol)
 359{
 360	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 361	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 362	struct wm8994 *control = wm8994->wm8994;
 363	struct wm8994_pdata *pdata = &control->pdata;
 364	int drc = wm8994_get_drc(kcontrol->id.name);
 365	int value = ucontrol->value.enumerated.item[0];
 366
 367	if (drc < 0)
 368		return drc;
 369
 370	if (value >= pdata->num_drc_cfgs)
 371		return -EINVAL;
 372
 373	wm8994->drc_cfg[drc] = value;
 374
 375	wm8994_set_drc(component, drc);
 376
 377	return 0;
 378}
 379
 380static int wm8994_get_drc_enum(struct snd_kcontrol *kcontrol,
 381			       struct snd_ctl_elem_value *ucontrol)
 382{
 383	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 384	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 385	int drc = wm8994_get_drc(kcontrol->id.name);
 386
 387	if (drc < 0)
 388		return drc;
 389	ucontrol->value.enumerated.item[0] = wm8994->drc_cfg[drc];
 390
 391	return 0;
 392}
 393
 394static void wm8994_set_retune_mobile(struct snd_soc_component *component, int block)
 395{
 396	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 397	struct wm8994 *control = wm8994->wm8994;
 398	struct wm8994_pdata *pdata = &control->pdata;
 399	int base = wm8994_retune_mobile_base[block];
 400	int iface, best, best_val, save, i, cfg;
 401
 402	if (!pdata || !wm8994->num_retune_mobile_texts)
 403		return;
 404
 405	switch (block) {
 406	case 0:
 407	case 1:
 408		iface = 0;
 409		break;
 410	case 2:
 411		iface = 1;
 412		break;
 413	default:
 414		return;
 415	}
 416
 417	/* Find the version of the currently selected configuration
 418	 * with the nearest sample rate. */
 419	cfg = wm8994->retune_mobile_cfg[block];
 420	best = 0;
 421	best_val = INT_MAX;
 422	for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
 423		if (strcmp(pdata->retune_mobile_cfgs[i].name,
 424			   wm8994->retune_mobile_texts[cfg]) == 0 &&
 425		    abs(pdata->retune_mobile_cfgs[i].rate
 426			- wm8994->dac_rates[iface]) < best_val) {
 427			best = i;
 428			best_val = abs(pdata->retune_mobile_cfgs[i].rate
 429				       - wm8994->dac_rates[iface]);
 430		}
 431	}
 432
 433	dev_dbg(component->dev, "ReTune Mobile %d %s/%dHz for %dHz sample rate\n",
 434		block,
 435		pdata->retune_mobile_cfgs[best].name,
 436		pdata->retune_mobile_cfgs[best].rate,
 437		wm8994->dac_rates[iface]);
 438
 439	/* The EQ will be disabled while reconfiguring it, remember the
 440	 * current configuration.
 441	 */
 442	save = snd_soc_component_read32(component, base);
 443	save &= WM8994_AIF1DAC1_EQ_ENA;
 444
 445	for (i = 0; i < WM8994_EQ_REGS; i++)
 446		snd_soc_component_update_bits(component, base + i, 0xffff,
 447				pdata->retune_mobile_cfgs[best].regs[i]);
 448
 449	snd_soc_component_update_bits(component, base, WM8994_AIF1DAC1_EQ_ENA, save);
 450}
 451
 452/* Icky as hell but saves code duplication */
 453static int wm8994_get_retune_mobile_block(const char *name)
 454{
 455	if (strcmp(name, "AIF1.1 EQ Mode") == 0)
 456		return 0;
 457	if (strcmp(name, "AIF1.2 EQ Mode") == 0)
 458		return 1;
 459	if (strcmp(name, "AIF2 EQ Mode") == 0)
 460		return 2;
 461	return -EINVAL;
 462}
 463
 464static int wm8994_put_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 465					 struct snd_ctl_elem_value *ucontrol)
 466{
 467	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 468	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 469	struct wm8994 *control = wm8994->wm8994;
 470	struct wm8994_pdata *pdata = &control->pdata;
 471	int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 472	int value = ucontrol->value.enumerated.item[0];
 473
 474	if (block < 0)
 475		return block;
 476
 477	if (value >= pdata->num_retune_mobile_cfgs)
 478		return -EINVAL;
 479
 480	wm8994->retune_mobile_cfg[block] = value;
 481
 482	wm8994_set_retune_mobile(component, block);
 483
 484	return 0;
 485}
 486
 487static int wm8994_get_retune_mobile_enum(struct snd_kcontrol *kcontrol,
 488					 struct snd_ctl_elem_value *ucontrol)
 489{
 490	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 491	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 492	int block = wm8994_get_retune_mobile_block(kcontrol->id.name);
 493
 494	if (block < 0)
 495		return block;
 496
 497	ucontrol->value.enumerated.item[0] = wm8994->retune_mobile_cfg[block];
 498
 499	return 0;
 500}
 501
 502static const char *aif_chan_src_text[] = {
 503	"Left", "Right"
 504};
 505
 506static SOC_ENUM_SINGLE_DECL(aif1adcl_src,
 507			    WM8994_AIF1_CONTROL_1, 15, aif_chan_src_text);
 508
 509static SOC_ENUM_SINGLE_DECL(aif1adcr_src,
 510			    WM8994_AIF1_CONTROL_1, 14, aif_chan_src_text);
 511
 512static SOC_ENUM_SINGLE_DECL(aif2adcl_src,
 513			    WM8994_AIF2_CONTROL_1, 15, aif_chan_src_text);
 514
 515static SOC_ENUM_SINGLE_DECL(aif2adcr_src,
 516			    WM8994_AIF2_CONTROL_1, 14, aif_chan_src_text);
 517
 518static SOC_ENUM_SINGLE_DECL(aif1dacl_src,
 519			    WM8994_AIF1_CONTROL_2, 15, aif_chan_src_text);
 520
 521static SOC_ENUM_SINGLE_DECL(aif1dacr_src,
 522			    WM8994_AIF1_CONTROL_2, 14, aif_chan_src_text);
 523
 524static SOC_ENUM_SINGLE_DECL(aif2dacl_src,
 525			    WM8994_AIF2_CONTROL_2, 15, aif_chan_src_text);
 526
 527static SOC_ENUM_SINGLE_DECL(aif2dacr_src,
 528			    WM8994_AIF2_CONTROL_2, 14, aif_chan_src_text);
 529
 530static const char *osr_text[] = {
 531	"Low Power", "High Performance",
 532};
 533
 534static SOC_ENUM_SINGLE_DECL(dac_osr,
 535			    WM8994_OVERSAMPLING, 0, osr_text);
 536
 537static SOC_ENUM_SINGLE_DECL(adc_osr,
 538			    WM8994_OVERSAMPLING, 1, osr_text);
 539
 540static const struct snd_kcontrol_new wm8994_snd_controls[] = {
 541SOC_DOUBLE_R_TLV("AIF1ADC1 Volume", WM8994_AIF1_ADC1_LEFT_VOLUME,
 542		 WM8994_AIF1_ADC1_RIGHT_VOLUME,
 543		 1, 119, 0, digital_tlv),
 544SOC_DOUBLE_R_TLV("AIF1ADC2 Volume", WM8994_AIF1_ADC2_LEFT_VOLUME,
 545		 WM8994_AIF1_ADC2_RIGHT_VOLUME,
 546		 1, 119, 0, digital_tlv),
 547SOC_DOUBLE_R_TLV("AIF2ADC Volume", WM8994_AIF2_ADC_LEFT_VOLUME,
 548		 WM8994_AIF2_ADC_RIGHT_VOLUME,
 549		 1, 119, 0, digital_tlv),
 550
 551SOC_ENUM("AIF1ADCL Source", aif1adcl_src),
 552SOC_ENUM("AIF1ADCR Source", aif1adcr_src),
 553SOC_ENUM("AIF2ADCL Source", aif2adcl_src),
 554SOC_ENUM("AIF2ADCR Source", aif2adcr_src),
 555
 556SOC_ENUM("AIF1DACL Source", aif1dacl_src),
 557SOC_ENUM("AIF1DACR Source", aif1dacr_src),
 558SOC_ENUM("AIF2DACL Source", aif2dacl_src),
 559SOC_ENUM("AIF2DACR Source", aif2dacr_src),
 560
 561SOC_DOUBLE_R_TLV("AIF1DAC1 Volume", WM8994_AIF1_DAC1_LEFT_VOLUME,
 562		 WM8994_AIF1_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 563SOC_DOUBLE_R_TLV("AIF1DAC2 Volume", WM8994_AIF1_DAC2_LEFT_VOLUME,
 564		 WM8994_AIF1_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 565SOC_DOUBLE_R_TLV("AIF2DAC Volume", WM8994_AIF2_DAC_LEFT_VOLUME,
 566		 WM8994_AIF2_DAC_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 567
 568SOC_SINGLE_TLV("AIF1 Boost Volume", WM8994_AIF1_CONTROL_2, 10, 3, 0, aif_tlv),
 569SOC_SINGLE_TLV("AIF2 Boost Volume", WM8994_AIF2_CONTROL_2, 10, 3, 0, aif_tlv),
 570
 571SOC_SINGLE("AIF1DAC1 EQ Switch", WM8994_AIF1_DAC1_EQ_GAINS_1, 0, 1, 0),
 572SOC_SINGLE("AIF1DAC2 EQ Switch", WM8994_AIF1_DAC2_EQ_GAINS_1, 0, 1, 0),
 573SOC_SINGLE("AIF2 EQ Switch", WM8994_AIF2_EQ_GAINS_1, 0, 1, 0),
 574
 575WM8994_DRC_SWITCH("AIF1DAC1 DRC Switch", WM8994_AIF1_DRC1_1, 2),
 576WM8994_DRC_SWITCH("AIF1ADC1L DRC Switch", WM8994_AIF1_DRC1_1, 1),
 577WM8994_DRC_SWITCH("AIF1ADC1R DRC Switch", WM8994_AIF1_DRC1_1, 0),
 578
 579WM8994_DRC_SWITCH("AIF1DAC2 DRC Switch", WM8994_AIF1_DRC2_1, 2),
 580WM8994_DRC_SWITCH("AIF1ADC2L DRC Switch", WM8994_AIF1_DRC2_1, 1),
 581WM8994_DRC_SWITCH("AIF1ADC2R DRC Switch", WM8994_AIF1_DRC2_1, 0),
 582
 583WM8994_DRC_SWITCH("AIF2DAC DRC Switch", WM8994_AIF2_DRC_1, 2),
 584WM8994_DRC_SWITCH("AIF2ADCL DRC Switch", WM8994_AIF2_DRC_1, 1),
 585WM8994_DRC_SWITCH("AIF2ADCR DRC Switch", WM8994_AIF2_DRC_1, 0),
 586
 587SOC_SINGLE_TLV("DAC1 Right Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 588	       5, 12, 0, st_tlv),
 589SOC_SINGLE_TLV("DAC1 Left Sidetone Volume", WM8994_DAC1_MIXER_VOLUMES,
 590	       0, 12, 0, st_tlv),
 591SOC_SINGLE_TLV("DAC2 Right Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 592	       5, 12, 0, st_tlv),
 593SOC_SINGLE_TLV("DAC2 Left Sidetone Volume", WM8994_DAC2_MIXER_VOLUMES,
 594	       0, 12, 0, st_tlv),
 595SOC_ENUM("Sidetone HPF Mux", sidetone_hpf),
 596SOC_SINGLE("Sidetone HPF Switch", WM8994_SIDETONE, 6, 1, 0),
 597
 598SOC_ENUM("AIF1ADC1 HPF Mode", aif1adc1_hpf),
 599SOC_DOUBLE("AIF1ADC1 HPF Switch", WM8994_AIF1_ADC1_FILTERS, 12, 11, 1, 0),
 600
 601SOC_ENUM("AIF1ADC2 HPF Mode", aif1adc2_hpf),
 602SOC_DOUBLE("AIF1ADC2 HPF Switch", WM8994_AIF1_ADC2_FILTERS, 12, 11, 1, 0),
 603
 604SOC_ENUM("AIF2ADC HPF Mode", aif2adc_hpf),
 605SOC_DOUBLE("AIF2ADC HPF Switch", WM8994_AIF2_ADC_FILTERS, 12, 11, 1, 0),
 606
 607SOC_ENUM("ADC OSR", adc_osr),
 608SOC_ENUM("DAC OSR", dac_osr),
 609
 610SOC_DOUBLE_R_TLV("DAC1 Volume", WM8994_DAC1_LEFT_VOLUME,
 611		 WM8994_DAC1_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 612SOC_DOUBLE_R("DAC1 Switch", WM8994_DAC1_LEFT_VOLUME,
 613	     WM8994_DAC1_RIGHT_VOLUME, 9, 1, 1),
 614
 615SOC_DOUBLE_R_TLV("DAC2 Volume", WM8994_DAC2_LEFT_VOLUME,
 616		 WM8994_DAC2_RIGHT_VOLUME, 1, 96, 0, digital_tlv),
 617SOC_DOUBLE_R("DAC2 Switch", WM8994_DAC2_LEFT_VOLUME,
 618	     WM8994_DAC2_RIGHT_VOLUME, 9, 1, 1),
 619
 620SOC_SINGLE_TLV("SPKL DAC2 Volume", WM8994_SPKMIXL_ATTENUATION,
 621	       6, 1, 1, wm_hubs_spkmix_tlv),
 622SOC_SINGLE_TLV("SPKL DAC1 Volume", WM8994_SPKMIXL_ATTENUATION,
 623	       2, 1, 1, wm_hubs_spkmix_tlv),
 624
 625SOC_SINGLE_TLV("SPKR DAC2 Volume", WM8994_SPKMIXR_ATTENUATION,
 626	       6, 1, 1, wm_hubs_spkmix_tlv),
 627SOC_SINGLE_TLV("SPKR DAC1 Volume", WM8994_SPKMIXR_ATTENUATION,
 628	       2, 1, 1, wm_hubs_spkmix_tlv),
 629
 630SOC_SINGLE_TLV("AIF1DAC1 3D Stereo Volume", WM8994_AIF1_DAC1_FILTERS_2,
 631	       10, 15, 0, wm8994_3d_tlv),
 632SOC_SINGLE("AIF1DAC1 3D Stereo Switch", WM8994_AIF1_DAC1_FILTERS_2,
 633	   8, 1, 0),
 634SOC_SINGLE_TLV("AIF1DAC2 3D Stereo Volume", WM8994_AIF1_DAC2_FILTERS_2,
 635	       10, 15, 0, wm8994_3d_tlv),
 636SOC_SINGLE("AIF1DAC2 3D Stereo Switch", WM8994_AIF1_DAC2_FILTERS_2,
 637	   8, 1, 0),
 638SOC_SINGLE_TLV("AIF2DAC 3D Stereo Volume", WM8994_AIF2_DAC_FILTERS_2,
 639	       10, 15, 0, wm8994_3d_tlv),
 640SOC_SINGLE("AIF2DAC 3D Stereo Switch", WM8994_AIF2_DAC_FILTERS_2,
 641	   8, 1, 0),
 642};
 643
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 644static const struct snd_kcontrol_new wm8994_eq_controls[] = {
 645SOC_SINGLE_TLV("AIF1DAC1 EQ1 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 11, 31, 0,
 646	       eq_tlv),
 647SOC_SINGLE_TLV("AIF1DAC1 EQ2 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 6, 31, 0,
 648	       eq_tlv),
 649SOC_SINGLE_TLV("AIF1DAC1 EQ3 Volume", WM8994_AIF1_DAC1_EQ_GAINS_1, 1, 31, 0,
 650	       eq_tlv),
 651SOC_SINGLE_TLV("AIF1DAC1 EQ4 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 11, 31, 0,
 652	       eq_tlv),
 653SOC_SINGLE_TLV("AIF1DAC1 EQ5 Volume", WM8994_AIF1_DAC1_EQ_GAINS_2, 6, 31, 0,
 654	       eq_tlv),
 655
 656SOC_SINGLE_TLV("AIF1DAC2 EQ1 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 11, 31, 0,
 657	       eq_tlv),
 658SOC_SINGLE_TLV("AIF1DAC2 EQ2 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 6, 31, 0,
 659	       eq_tlv),
 660SOC_SINGLE_TLV("AIF1DAC2 EQ3 Volume", WM8994_AIF1_DAC2_EQ_GAINS_1, 1, 31, 0,
 661	       eq_tlv),
 662SOC_SINGLE_TLV("AIF1DAC2 EQ4 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 11, 31, 0,
 663	       eq_tlv),
 664SOC_SINGLE_TLV("AIF1DAC2 EQ5 Volume", WM8994_AIF1_DAC2_EQ_GAINS_2, 6, 31, 0,
 665	       eq_tlv),
 666
 667SOC_SINGLE_TLV("AIF2 EQ1 Volume", WM8994_AIF2_EQ_GAINS_1, 11, 31, 0,
 668	       eq_tlv),
 669SOC_SINGLE_TLV("AIF2 EQ2 Volume", WM8994_AIF2_EQ_GAINS_1, 6, 31, 0,
 670	       eq_tlv),
 671SOC_SINGLE_TLV("AIF2 EQ3 Volume", WM8994_AIF2_EQ_GAINS_1, 1, 31, 0,
 672	       eq_tlv),
 673SOC_SINGLE_TLV("AIF2 EQ4 Volume", WM8994_AIF2_EQ_GAINS_2, 11, 31, 0,
 674	       eq_tlv),
 675SOC_SINGLE_TLV("AIF2 EQ5 Volume", WM8994_AIF2_EQ_GAINS_2, 6, 31, 0,
 676	       eq_tlv),
 677};
 678
 679static const struct snd_kcontrol_new wm8994_drc_controls[] = {
 680SND_SOC_BYTES_MASK("AIF1.1 DRC", WM8994_AIF1_DRC1_1, 5,
 681		   WM8994_AIF1DAC1_DRC_ENA | WM8994_AIF1ADC1L_DRC_ENA |
 682		   WM8994_AIF1ADC1R_DRC_ENA),
 683SND_SOC_BYTES_MASK("AIF1.2 DRC", WM8994_AIF1_DRC2_1, 5,
 684		   WM8994_AIF1DAC2_DRC_ENA | WM8994_AIF1ADC2L_DRC_ENA |
 685		   WM8994_AIF1ADC2R_DRC_ENA),
 686SND_SOC_BYTES_MASK("AIF2 DRC", WM8994_AIF2_DRC_1, 5,
 687		   WM8994_AIF2DAC_DRC_ENA | WM8994_AIF2ADCL_DRC_ENA |
 688		   WM8994_AIF2ADCR_DRC_ENA),
 689};
 690
 691static const char *wm8958_ng_text[] = {
 692	"30ms", "125ms", "250ms", "500ms",
 693};
 694
 695static SOC_ENUM_SINGLE_DECL(wm8958_aif1dac1_ng_hold,
 696			    WM8958_AIF1_DAC1_NOISE_GATE,
 697			    WM8958_AIF1DAC1_NG_THR_SHIFT,
 698			    wm8958_ng_text);
 699
 700static SOC_ENUM_SINGLE_DECL(wm8958_aif1dac2_ng_hold,
 701			    WM8958_AIF1_DAC2_NOISE_GATE,
 702			    WM8958_AIF1DAC2_NG_THR_SHIFT,
 703			    wm8958_ng_text);
 704
 705static SOC_ENUM_SINGLE_DECL(wm8958_aif2dac_ng_hold,
 706			    WM8958_AIF2_DAC_NOISE_GATE,
 707			    WM8958_AIF2DAC_NG_THR_SHIFT,
 708			    wm8958_ng_text);
 709
 710static const struct snd_kcontrol_new wm8958_snd_controls[] = {
 711SOC_SINGLE_TLV("AIF3 Boost Volume", WM8958_AIF3_CONTROL_2, 10, 3, 0, aif_tlv),
 712
 713SOC_SINGLE("AIF1DAC1 Noise Gate Switch", WM8958_AIF1_DAC1_NOISE_GATE,
 714	   WM8958_AIF1DAC1_NG_ENA_SHIFT, 1, 0),
 715SOC_ENUM("AIF1DAC1 Noise Gate Hold Time", wm8958_aif1dac1_ng_hold),
 716SOC_SINGLE_TLV("AIF1DAC1 Noise Gate Threshold Volume",
 717	       WM8958_AIF1_DAC1_NOISE_GATE, WM8958_AIF1DAC1_NG_THR_SHIFT,
 718	       7, 1, ng_tlv),
 719
 720SOC_SINGLE("AIF1DAC2 Noise Gate Switch", WM8958_AIF1_DAC2_NOISE_GATE,
 721	   WM8958_AIF1DAC2_NG_ENA_SHIFT, 1, 0),
 722SOC_ENUM("AIF1DAC2 Noise Gate Hold Time", wm8958_aif1dac2_ng_hold),
 723SOC_SINGLE_TLV("AIF1DAC2 Noise Gate Threshold Volume",
 724	       WM8958_AIF1_DAC2_NOISE_GATE, WM8958_AIF1DAC2_NG_THR_SHIFT,
 725	       7, 1, ng_tlv),
 726
 727SOC_SINGLE("AIF2DAC Noise Gate Switch", WM8958_AIF2_DAC_NOISE_GATE,
 728	   WM8958_AIF2DAC_NG_ENA_SHIFT, 1, 0),
 729SOC_ENUM("AIF2DAC Noise Gate Hold Time", wm8958_aif2dac_ng_hold),
 730SOC_SINGLE_TLV("AIF2DAC Noise Gate Threshold Volume",
 731	       WM8958_AIF2_DAC_NOISE_GATE, WM8958_AIF2DAC_NG_THR_SHIFT,
 732	       7, 1, ng_tlv),
 733};
 734
 735static const struct snd_kcontrol_new wm1811_snd_controls[] = {
 736SOC_SINGLE_TLV("MIXINL IN1LP Boost Volume", WM8994_INPUT_MIXER_1, 7, 1, 0,
 737	       mixin_boost_tlv),
 738SOC_SINGLE_TLV("MIXINL IN1RP Boost Volume", WM8994_INPUT_MIXER_1, 8, 1, 0,
 739	       mixin_boost_tlv),
 740};
 741
 742/* We run all mode setting through a function to enforce audio mode */
 743static void wm1811_jackdet_set_mode(struct snd_soc_component *component, u16 mode)
 744{
 745	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 746
 747	if (!wm8994->jackdet || !wm8994->micdet[0].jack)
 748		return;
 749
 750	if (wm8994->active_refcount)
 751		mode = WM1811_JACKDET_MODE_AUDIO;
 752
 753	if (mode == wm8994->jackdet_mode)
 754		return;
 755
 756	wm8994->jackdet_mode = mode;
 757
 758	/* Always use audio mode to detect while the system is active */
 759	if (mode != WM1811_JACKDET_MODE_NONE)
 760		mode = WM1811_JACKDET_MODE_AUDIO;
 761
 762	snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 763			    WM1811_JACKDET_MODE_MASK, mode);
 764}
 765
 766static void active_reference(struct snd_soc_component *component)
 767{
 768	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 769
 770	mutex_lock(&wm8994->accdet_lock);
 771
 772	wm8994->active_refcount++;
 773
 774	dev_dbg(component->dev, "Active refcount incremented, now %d\n",
 775		wm8994->active_refcount);
 776
 777	/* If we're using jack detection go into audio mode */
 778	wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_AUDIO);
 779
 780	mutex_unlock(&wm8994->accdet_lock);
 781}
 782
 783static void active_dereference(struct snd_soc_component *component)
 784{
 785	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 786	u16 mode;
 787
 788	mutex_lock(&wm8994->accdet_lock);
 789
 790	wm8994->active_refcount--;
 791
 792	dev_dbg(component->dev, "Active refcount decremented, now %d\n",
 793		wm8994->active_refcount);
 794
 795	if (wm8994->active_refcount == 0) {
 796		/* Go into appropriate detection only mode */
 797		if (wm8994->jack_mic || wm8994->mic_detecting)
 798			mode = WM1811_JACKDET_MODE_MIC;
 799		else
 800			mode = WM1811_JACKDET_MODE_JACK;
 801
 802		wm1811_jackdet_set_mode(component, mode);
 803	}
 804
 805	mutex_unlock(&wm8994->accdet_lock);
 806}
 807
 808static int clk_sys_event(struct snd_soc_dapm_widget *w,
 809			 struct snd_kcontrol *kcontrol, int event)
 810{
 811	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 812	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 813
 814	switch (event) {
 815	case SND_SOC_DAPM_PRE_PMU:
 816		return configure_clock(component);
 817
 818	case SND_SOC_DAPM_POST_PMU:
 819		/*
 820		 * JACKDET won't run until we start the clock and it
 821		 * only reports deltas, make sure we notify the state
 822		 * up the stack on startup.  Use a *very* generous
 823		 * timeout for paranoia, there's no urgency and we
 824		 * don't want false reports.
 825		 */
 826		if (wm8994->jackdet && !wm8994->clk_has_run) {
 827			queue_delayed_work(system_power_efficient_wq,
 828					   &wm8994->jackdet_bootstrap,
 829					   msecs_to_jiffies(1000));
 830			wm8994->clk_has_run = true;
 831		}
 832		break;
 833
 834	case SND_SOC_DAPM_POST_PMD:
 835		configure_clock(component);
 836		break;
 837	}
 838
 839	return 0;
 840}
 841
 842static void vmid_reference(struct snd_soc_component *component)
 843{
 844	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 845
 846	pm_runtime_get_sync(component->dev);
 847
 848	wm8994->vmid_refcount++;
 849
 850	dev_dbg(component->dev, "Referencing VMID, refcount is now %d\n",
 851		wm8994->vmid_refcount);
 852
 853	if (wm8994->vmid_refcount == 1) {
 854		snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
 855				    WM8994_LINEOUT1_DISCH |
 856				    WM8994_LINEOUT2_DISCH, 0);
 857
 858		wm_hubs_vmid_ena(component);
 859
 860		switch (wm8994->vmid_mode) {
 861		default:
 862			WARN_ON(NULL == "Invalid VMID mode");
 863			/* fall through */
 864		case WM8994_VMID_NORMAL:
 865			/* Startup bias, VMID ramp & buffer */
 866			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 867					    WM8994_BIAS_SRC |
 868					    WM8994_VMID_DISCH |
 869					    WM8994_STARTUP_BIAS_ENA |
 870					    WM8994_VMID_BUF_ENA |
 871					    WM8994_VMID_RAMP_MASK,
 872					    WM8994_BIAS_SRC |
 873					    WM8994_STARTUP_BIAS_ENA |
 874					    WM8994_VMID_BUF_ENA |
 875					    (0x2 << WM8994_VMID_RAMP_SHIFT));
 876
 877			/* Main bias enable, VMID=2x40k */
 878			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 879					    WM8994_BIAS_ENA |
 880					    WM8994_VMID_SEL_MASK,
 881					    WM8994_BIAS_ENA | 0x2);
 882
 883			msleep(300);
 884
 885			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 886					    WM8994_VMID_RAMP_MASK |
 887					    WM8994_BIAS_SRC,
 888					    0);
 889			break;
 890
 891		case WM8994_VMID_FORCE:
 892			/* Startup bias, slow VMID ramp & buffer */
 893			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 894					    WM8994_BIAS_SRC |
 895					    WM8994_VMID_DISCH |
 896					    WM8994_STARTUP_BIAS_ENA |
 897					    WM8994_VMID_BUF_ENA |
 898					    WM8994_VMID_RAMP_MASK,
 899					    WM8994_BIAS_SRC |
 900					    WM8994_STARTUP_BIAS_ENA |
 901					    WM8994_VMID_BUF_ENA |
 902					    (0x2 << WM8994_VMID_RAMP_SHIFT));
 903
 904			/* Main bias enable, VMID=2x40k */
 905			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 906					    WM8994_BIAS_ENA |
 907					    WM8994_VMID_SEL_MASK,
 908					    WM8994_BIAS_ENA | 0x2);
 909
 910			msleep(400);
 911
 912			snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 913					    WM8994_VMID_RAMP_MASK |
 914					    WM8994_BIAS_SRC,
 915					    0);
 916			break;
 917		}
 918	}
 919}
 920
 921static void vmid_dereference(struct snd_soc_component *component)
 922{
 923	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
 924
 925	wm8994->vmid_refcount--;
 926
 927	dev_dbg(component->dev, "Dereferencing VMID, refcount is now %d\n",
 928		wm8994->vmid_refcount);
 929
 930	if (wm8994->vmid_refcount == 0) {
 931		if (wm8994->hubs.lineout1_se)
 932			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 933					    WM8994_LINEOUT1N_ENA |
 934					    WM8994_LINEOUT1P_ENA,
 935					    WM8994_LINEOUT1N_ENA |
 936					    WM8994_LINEOUT1P_ENA);
 937
 938		if (wm8994->hubs.lineout2_se)
 939			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 940					    WM8994_LINEOUT2N_ENA |
 941					    WM8994_LINEOUT2P_ENA,
 942					    WM8994_LINEOUT2N_ENA |
 943					    WM8994_LINEOUT2P_ENA);
 944
 945		/* Start discharging VMID */
 946		snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 947				    WM8994_BIAS_SRC |
 948				    WM8994_VMID_DISCH,
 949				    WM8994_BIAS_SRC |
 950				    WM8994_VMID_DISCH);
 951
 952		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 953				    WM8994_VMID_SEL_MASK, 0);
 954
 955		msleep(400);
 956
 957		/* Active discharge */
 958		snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
 959				    WM8994_LINEOUT1_DISCH |
 960				    WM8994_LINEOUT2_DISCH,
 961				    WM8994_LINEOUT1_DISCH |
 962				    WM8994_LINEOUT2_DISCH);
 963
 964		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_3,
 965				    WM8994_LINEOUT1N_ENA |
 966				    WM8994_LINEOUT1P_ENA |
 967				    WM8994_LINEOUT2N_ENA |
 968				    WM8994_LINEOUT2P_ENA, 0);
 969
 970		/* Switch off startup biases */
 971		snd_soc_component_update_bits(component, WM8994_ANTIPOP_2,
 972				    WM8994_BIAS_SRC |
 973				    WM8994_STARTUP_BIAS_ENA |
 974				    WM8994_VMID_BUF_ENA |
 975				    WM8994_VMID_RAMP_MASK, 0);
 976
 977		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_1,
 978				    WM8994_VMID_SEL_MASK, 0);
 979	}
 980
 981	pm_runtime_put(component->dev);
 982}
 983
 984static int vmid_event(struct snd_soc_dapm_widget *w,
 985		      struct snd_kcontrol *kcontrol, int event)
 986{
 987	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 988
 989	switch (event) {
 990	case SND_SOC_DAPM_PRE_PMU:
 991		vmid_reference(component);
 992		break;
 993
 994	case SND_SOC_DAPM_POST_PMD:
 995		vmid_dereference(component);
 996		break;
 997	}
 998
 999	return 0;
1000}
1001
1002static bool wm8994_check_class_w_digital(struct snd_soc_component *component)
1003{
1004	int source = 0;  /* GCC flow analysis can't track enable */
1005	int reg, reg_r;
1006
1007	/* We also need the same AIF source for L/R and only one path */
1008	reg = snd_soc_component_read32(component, WM8994_DAC1_LEFT_MIXER_ROUTING);
1009	switch (reg) {
1010	case WM8994_AIF2DACL_TO_DAC1L:
1011		dev_vdbg(component->dev, "Class W source AIF2DAC\n");
1012		source = 2 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1013		break;
1014	case WM8994_AIF1DAC2L_TO_DAC1L:
1015		dev_vdbg(component->dev, "Class W source AIF1DAC2\n");
1016		source = 1 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1017		break;
1018	case WM8994_AIF1DAC1L_TO_DAC1L:
1019		dev_vdbg(component->dev, "Class W source AIF1DAC1\n");
1020		source = 0 << WM8994_CP_DYN_SRC_SEL_SHIFT;
1021		break;
1022	default:
1023		dev_vdbg(component->dev, "DAC mixer setting: %x\n", reg);
1024		return false;
1025	}
1026
1027	reg_r = snd_soc_component_read32(component, WM8994_DAC1_RIGHT_MIXER_ROUTING);
1028	if (reg_r != reg) {
1029		dev_vdbg(component->dev, "Left and right DAC mixers different\n");
1030		return false;
1031	}
1032
1033	/* Set the source up */
1034	snd_soc_component_update_bits(component, WM8994_CLASS_W_1,
1035			    WM8994_CP_DYN_SRC_SEL_MASK, source);
1036
1037	return true;
1038}
1039
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1040static int aif1clk_ev(struct snd_soc_dapm_widget *w,
1041		      struct snd_kcontrol *kcontrol, int event)
1042{
1043	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1044	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1045	struct wm8994 *control = wm8994->wm8994;
1046	int mask = WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC1R_ENA;
1047	int i;
1048	int dac;
1049	int adc;
1050	int val;
1051
1052	switch (control->type) {
1053	case WM8994:
1054	case WM8958:
1055		mask |= WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA;
1056		break;
1057	default:
1058		break;
1059	}
1060
1061	switch (event) {
1062	case SND_SOC_DAPM_PRE_PMU:
 
 
 
 
1063		/* Don't enable timeslot 2 if not in use */
1064		if (wm8994->channels[0] <= 2)
1065			mask &= ~(WM8994_AIF1DAC2L_ENA | WM8994_AIF1DAC2R_ENA);
1066
1067		val = snd_soc_component_read32(component, WM8994_AIF1_CONTROL_1);
1068		if ((val & WM8994_AIF1ADCL_SRC) &&
1069		    (val & WM8994_AIF1ADCR_SRC))
1070			adc = WM8994_AIF1ADC1R_ENA | WM8994_AIF1ADC2R_ENA;
1071		else if (!(val & WM8994_AIF1ADCL_SRC) &&
1072			 !(val & WM8994_AIF1ADCR_SRC))
1073			adc = WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC2L_ENA;
1074		else
1075			adc = WM8994_AIF1ADC1R_ENA | WM8994_AIF1ADC2R_ENA |
1076				WM8994_AIF1ADC1L_ENA | WM8994_AIF1ADC2L_ENA;
1077
1078		val = snd_soc_component_read32(component, WM8994_AIF1_CONTROL_2);
1079		if ((val & WM8994_AIF1DACL_SRC) &&
1080		    (val & WM8994_AIF1DACR_SRC))
1081			dac = WM8994_AIF1DAC1R_ENA | WM8994_AIF1DAC2R_ENA;
1082		else if (!(val & WM8994_AIF1DACL_SRC) &&
1083			 !(val & WM8994_AIF1DACR_SRC))
1084			dac = WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC2L_ENA;
1085		else
1086			dac = WM8994_AIF1DAC1R_ENA | WM8994_AIF1DAC2R_ENA |
1087				WM8994_AIF1DAC1L_ENA | WM8994_AIF1DAC2L_ENA;
1088
1089		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1090				    mask, adc);
1091		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1092				    mask, dac);
1093		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1094				    WM8994_AIF1DSPCLK_ENA |
1095				    WM8994_SYSDSPCLK_ENA,
1096				    WM8994_AIF1DSPCLK_ENA |
1097				    WM8994_SYSDSPCLK_ENA);
1098		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4, mask,
1099				    WM8994_AIF1ADC1R_ENA |
1100				    WM8994_AIF1ADC1L_ENA |
1101				    WM8994_AIF1ADC2R_ENA |
1102				    WM8994_AIF1ADC2L_ENA);
1103		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5, mask,
1104				    WM8994_AIF1DAC1R_ENA |
1105				    WM8994_AIF1DAC1L_ENA |
1106				    WM8994_AIF1DAC2R_ENA |
1107				    WM8994_AIF1DAC2L_ENA);
1108		break;
1109
1110	case SND_SOC_DAPM_POST_PMU:
1111		for (i = 0; i < ARRAY_SIZE(wm8994_vu_bits); i++)
1112			snd_soc_component_write(component, wm8994_vu_bits[i].reg,
1113				      snd_soc_component_read32(component,
1114						   wm8994_vu_bits[i].reg));
1115		break;
1116
1117	case SND_SOC_DAPM_PRE_PMD:
1118	case SND_SOC_DAPM_POST_PMD:
1119		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1120				    mask, 0);
1121		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1122				    mask, 0);
1123
1124		val = snd_soc_component_read32(component, WM8994_CLOCKING_1);
1125		if (val & WM8994_AIF2DSPCLK_ENA)
1126			val = WM8994_SYSDSPCLK_ENA;
1127		else
1128			val = 0;
1129		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1130				    WM8994_SYSDSPCLK_ENA |
1131				    WM8994_AIF1DSPCLK_ENA, val);
1132		break;
1133	}
1134
 
 
 
 
 
 
1135	return 0;
1136}
1137
1138static int aif2clk_ev(struct snd_soc_dapm_widget *w,
1139		      struct snd_kcontrol *kcontrol, int event)
1140{
1141	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1142	int i;
1143	int dac;
1144	int adc;
1145	int val;
1146
1147	switch (event) {
1148	case SND_SOC_DAPM_PRE_PMU:
1149		val = snd_soc_component_read32(component, WM8994_AIF2_CONTROL_1);
 
 
 
 
1150		if ((val & WM8994_AIF2ADCL_SRC) &&
1151		    (val & WM8994_AIF2ADCR_SRC))
1152			adc = WM8994_AIF2ADCR_ENA;
1153		else if (!(val & WM8994_AIF2ADCL_SRC) &&
1154			 !(val & WM8994_AIF2ADCR_SRC))
1155			adc = WM8994_AIF2ADCL_ENA;
1156		else
1157			adc = WM8994_AIF2ADCL_ENA | WM8994_AIF2ADCR_ENA;
1158
1159
1160		val = snd_soc_component_read32(component, WM8994_AIF2_CONTROL_2);
1161		if ((val & WM8994_AIF2DACL_SRC) &&
1162		    (val & WM8994_AIF2DACR_SRC))
1163			dac = WM8994_AIF2DACR_ENA;
1164		else if (!(val & WM8994_AIF2DACL_SRC) &&
1165			 !(val & WM8994_AIF2DACR_SRC))
1166			dac = WM8994_AIF2DACL_ENA;
1167		else
1168			dac = WM8994_AIF2DACL_ENA | WM8994_AIF2DACR_ENA;
1169
1170		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1171				    WM8994_AIF2ADCL_ENA |
1172				    WM8994_AIF2ADCR_ENA, adc);
1173		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1174				    WM8994_AIF2DACL_ENA |
1175				    WM8994_AIF2DACR_ENA, dac);
1176		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1177				    WM8994_AIF2DSPCLK_ENA |
1178				    WM8994_SYSDSPCLK_ENA,
1179				    WM8994_AIF2DSPCLK_ENA |
1180				    WM8994_SYSDSPCLK_ENA);
1181		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1182				    WM8994_AIF2ADCL_ENA |
1183				    WM8994_AIF2ADCR_ENA,
1184				    WM8994_AIF2ADCL_ENA |
1185				    WM8994_AIF2ADCR_ENA);
1186		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1187				    WM8994_AIF2DACL_ENA |
1188				    WM8994_AIF2DACR_ENA,
1189				    WM8994_AIF2DACL_ENA |
1190				    WM8994_AIF2DACR_ENA);
1191		break;
1192
1193	case SND_SOC_DAPM_POST_PMU:
1194		for (i = 0; i < ARRAY_SIZE(wm8994_vu_bits); i++)
1195			snd_soc_component_write(component, wm8994_vu_bits[i].reg,
1196				      snd_soc_component_read32(component,
1197						   wm8994_vu_bits[i].reg));
1198		break;
1199
1200	case SND_SOC_DAPM_PRE_PMD:
1201	case SND_SOC_DAPM_POST_PMD:
1202		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1203				    WM8994_AIF2DACL_ENA |
1204				    WM8994_AIF2DACR_ENA, 0);
1205		snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_4,
1206				    WM8994_AIF2ADCL_ENA |
1207				    WM8994_AIF2ADCR_ENA, 0);
1208
1209		val = snd_soc_component_read32(component, WM8994_CLOCKING_1);
1210		if (val & WM8994_AIF1DSPCLK_ENA)
1211			val = WM8994_SYSDSPCLK_ENA;
1212		else
1213			val = 0;
1214		snd_soc_component_update_bits(component, WM8994_CLOCKING_1,
1215				    WM8994_SYSDSPCLK_ENA |
1216				    WM8994_AIF2DSPCLK_ENA, val);
1217		break;
1218	}
1219
 
 
 
 
 
 
1220	return 0;
1221}
1222
1223static int aif1clk_late_ev(struct snd_soc_dapm_widget *w,
1224			   struct snd_kcontrol *kcontrol, int event)
1225{
1226	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1227	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1228
1229	switch (event) {
1230	case SND_SOC_DAPM_PRE_PMU:
1231		wm8994->aif1clk_enable = 1;
1232		break;
1233	case SND_SOC_DAPM_POST_PMD:
1234		wm8994->aif1clk_disable = 1;
1235		break;
1236	}
1237
1238	return 0;
1239}
1240
1241static int aif2clk_late_ev(struct snd_soc_dapm_widget *w,
1242			   struct snd_kcontrol *kcontrol, int event)
1243{
1244	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1245	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1246
1247	switch (event) {
1248	case SND_SOC_DAPM_PRE_PMU:
1249		wm8994->aif2clk_enable = 1;
1250		break;
1251	case SND_SOC_DAPM_POST_PMD:
1252		wm8994->aif2clk_disable = 1;
1253		break;
1254	}
1255
1256	return 0;
1257}
1258
1259static int late_enable_ev(struct snd_soc_dapm_widget *w,
1260			  struct snd_kcontrol *kcontrol, int event)
1261{
1262	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1263	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1264
1265	switch (event) {
1266	case SND_SOC_DAPM_PRE_PMU:
1267		if (wm8994->aif1clk_enable) {
1268			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMU);
1269			snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1,
1270					    WM8994_AIF1CLK_ENA_MASK,
1271					    WM8994_AIF1CLK_ENA);
1272			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMU);
1273			wm8994->aif1clk_enable = 0;
1274		}
1275		if (wm8994->aif2clk_enable) {
1276			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMU);
1277			snd_soc_component_update_bits(component, WM8994_AIF2_CLOCKING_1,
1278					    WM8994_AIF2CLK_ENA_MASK,
1279					    WM8994_AIF2CLK_ENA);
1280			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMU);
1281			wm8994->aif2clk_enable = 0;
1282		}
1283		break;
1284	}
1285
1286	/* We may also have postponed startup of DSP, handle that. */
1287	wm8958_aif_ev(w, kcontrol, event);
1288
1289	return 0;
1290}
1291
1292static int late_disable_ev(struct snd_soc_dapm_widget *w,
1293			   struct snd_kcontrol *kcontrol, int event)
1294{
1295	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1296	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
1297
1298	switch (event) {
1299	case SND_SOC_DAPM_POST_PMD:
1300		if (wm8994->aif1clk_disable) {
1301			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMD);
1302			snd_soc_component_update_bits(component, WM8994_AIF1_CLOCKING_1,
1303					    WM8994_AIF1CLK_ENA_MASK, 0);
1304			aif1clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMD);
1305			wm8994->aif1clk_disable = 0;
1306		}
1307		if (wm8994->aif2clk_disable) {
1308			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_PRE_PMD);
1309			snd_soc_component_update_bits(component, WM8994_AIF2_CLOCKING_1,
1310					    WM8994_AIF2CLK_ENA_MASK, 0);
1311			aif2clk_ev(w, kcontrol, SND_SOC_DAPM_POST_PMD);
1312			wm8994->aif2clk_disable = 0;
1313		}
1314		break;
1315	}
1316
1317	return 0;
1318}
1319
1320static int adc_mux_ev(struct snd_soc_dapm_widget *w,
1321		      struct snd_kcontrol *kcontrol, int event)
1322{
1323	late_enable_ev(w, kcontrol, event);
1324	return 0;
1325}
1326
1327static int micbias_ev(struct snd_soc_dapm_widget *w,
1328		      struct snd_kcontrol *kcontrol, int event)
1329{
1330	late_enable_ev(w, kcontrol, event);
1331	return 0;
1332}
1333
1334static int dac_ev(struct snd_soc_dapm_widget *w,
1335		  struct snd_kcontrol *kcontrol, int event)
1336{
1337	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1338	unsigned int mask = 1 << w->shift;
1339
1340	snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_5,
1341			    mask, mask);
1342	return 0;
1343}
1344
1345static const char *adc_mux_text[] = {
1346	"ADC",
1347	"DMIC",
1348};
1349
1350static SOC_ENUM_SINGLE_VIRT_DECL(adc_enum, adc_mux_text);
1351
1352static const struct snd_kcontrol_new adcl_mux =
1353	SOC_DAPM_ENUM("ADCL Mux", adc_enum);
1354
1355static const struct snd_kcontrol_new adcr_mux =
1356	SOC_DAPM_ENUM("ADCR Mux", adc_enum);
1357
1358static const struct snd_kcontrol_new left_speaker_mixer[] = {
1359SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 9, 1, 0),
1360SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 7, 1, 0),
1361SOC_DAPM_SINGLE("IN1LP Switch", WM8994_SPEAKER_MIXER, 5, 1, 0),
1362SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 3, 1, 0),
1363SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 1, 1, 0),
1364};
1365
1366static const struct snd_kcontrol_new right_speaker_mixer[] = {
1367SOC_DAPM_SINGLE("DAC2 Switch", WM8994_SPEAKER_MIXER, 8, 1, 0),
1368SOC_DAPM_SINGLE("Input Switch", WM8994_SPEAKER_MIXER, 6, 1, 0),
1369SOC_DAPM_SINGLE("IN1RP Switch", WM8994_SPEAKER_MIXER, 4, 1, 0),
1370SOC_DAPM_SINGLE("Output Switch", WM8994_SPEAKER_MIXER, 2, 1, 0),
1371SOC_DAPM_SINGLE("DAC1 Switch", WM8994_SPEAKER_MIXER, 0, 1, 0),
1372};
1373
1374/* Debugging; dump chip status after DAPM transitions */
1375static int post_ev(struct snd_soc_dapm_widget *w,
1376	    struct snd_kcontrol *kcontrol, int event)
1377{
1378	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
1379	dev_dbg(component->dev, "SRC status: %x\n",
1380		snd_soc_component_read32(component,
1381			     WM8994_RATE_STATUS));
1382	return 0;
1383}
1384
1385static const struct snd_kcontrol_new aif1adc1l_mix[] = {
1386SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1387		1, 1, 0),
1388SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_LEFT_MIXER_ROUTING,
1389		0, 1, 0),
1390};
1391
1392static const struct snd_kcontrol_new aif1adc1r_mix[] = {
1393SOC_DAPM_SINGLE("ADC/DMIC Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1394		1, 1, 0),
1395SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC1_RIGHT_MIXER_ROUTING,
1396		0, 1, 0),
1397};
1398
1399static const struct snd_kcontrol_new aif1adc2l_mix[] = {
1400SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1401		1, 1, 0),
1402SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_LEFT_MIXER_ROUTING,
1403		0, 1, 0),
1404};
1405
1406static const struct snd_kcontrol_new aif1adc2r_mix[] = {
1407SOC_DAPM_SINGLE("DMIC Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1408		1, 1, 0),
1409SOC_DAPM_SINGLE("AIF2 Switch", WM8994_AIF1_ADC2_RIGHT_MIXER_ROUTING,
1410		0, 1, 0),
1411};
1412
1413static const struct snd_kcontrol_new aif2dac2l_mix[] = {
1414SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1415		5, 1, 0),
1416SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1417		4, 1, 0),
1418SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1419		2, 1, 0),
1420SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1421		1, 1, 0),
1422SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_LEFT_MIXER_ROUTING,
1423		0, 1, 0),
1424};
1425
1426static const struct snd_kcontrol_new aif2dac2r_mix[] = {
1427SOC_DAPM_SINGLE("Right Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1428		5, 1, 0),
1429SOC_DAPM_SINGLE("Left Sidetone Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1430		4, 1, 0),
1431SOC_DAPM_SINGLE("AIF2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1432		2, 1, 0),
1433SOC_DAPM_SINGLE("AIF1.2 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1434		1, 1, 0),
1435SOC_DAPM_SINGLE("AIF1.1 Switch", WM8994_DAC2_RIGHT_MIXER_ROUTING,
1436		0, 1, 0),
1437};
1438
1439#define WM8994_CLASS_W_SWITCH(xname, reg, shift, max, invert) \
1440	SOC_SINGLE_EXT(xname, reg, shift, max, invert, \
1441		snd_soc_dapm_get_volsw, wm8994_put_class_w)
1442
1443static int wm8994_put_class_w(struct snd_kcontrol *kcontrol,
1444			      struct snd_ctl_elem_value *ucontrol)
1445{
1446	struct snd_soc_component *component = snd_soc_dapm_kcontrol_component(kcontrol);
1447	int ret;
1448
1449	ret = snd_soc_dapm_put_volsw(kcontrol, ucontrol);
1450
1451	wm_hubs_update_class_w(component);
1452
1453	return ret;
1454}
1455
1456static const struct snd_kcontrol_new dac1l_mix[] = {
1457WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1458		      5, 1, 0),
1459WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1460		      4, 1, 0),
1461WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1462		      2, 1, 0),
1463WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1464		      1, 1, 0),
1465WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_LEFT_MIXER_ROUTING,
1466		      0, 1, 0),
1467};
1468
1469static const struct snd_kcontrol_new dac1r_mix[] = {
1470WM8994_CLASS_W_SWITCH("Right Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1471		      5, 1, 0),
1472WM8994_CLASS_W_SWITCH("Left Sidetone Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1473		      4, 1, 0),
1474WM8994_CLASS_W_SWITCH("AIF2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1475		      2, 1, 0),
1476WM8994_CLASS_W_SWITCH("AIF1.2 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1477		      1, 1, 0),
1478WM8994_CLASS_W_SWITCH("AIF1.1 Switch", WM8994_DAC1_RIGHT_MIXER_ROUTING,
1479		      0, 1, 0),
1480};
1481
1482static const char *sidetone_text[] = {
1483	"ADC/DMIC1", "DMIC2",
1484};
1485
1486static SOC_ENUM_SINGLE_DECL(sidetone1_enum,
1487			    WM8994_SIDETONE, 0, sidetone_text);
1488
1489static const struct snd_kcontrol_new sidetone1_mux =
1490	SOC_DAPM_ENUM("Left Sidetone Mux", sidetone1_enum);
1491
1492static SOC_ENUM_SINGLE_DECL(sidetone2_enum,
1493			    WM8994_SIDETONE, 1, sidetone_text);
1494
1495static const struct snd_kcontrol_new sidetone2_mux =
1496	SOC_DAPM_ENUM("Right Sidetone Mux", sidetone2_enum);
1497
1498static const char *aif1dac_text[] = {
1499	"AIF1DACDAT", "AIF3DACDAT",
1500};
1501
1502static const char *loopback_text[] = {
1503	"None", "ADCDAT",
1504};
1505
1506static SOC_ENUM_SINGLE_DECL(aif1_loopback_enum,
1507			    WM8994_AIF1_CONTROL_2,
1508			    WM8994_AIF1_LOOPBACK_SHIFT,
1509			    loopback_text);
1510
1511static const struct snd_kcontrol_new aif1_loopback =
1512	SOC_DAPM_ENUM("AIF1 Loopback", aif1_loopback_enum);
1513
1514static SOC_ENUM_SINGLE_DECL(aif2_loopback_enum,
1515			    WM8994_AIF2_CONTROL_2,
1516			    WM8994_AIF2_LOOPBACK_SHIFT,
1517			    loopback_text);
1518
1519static const struct snd_kcontrol_new aif2_loopback =
1520	SOC_DAPM_ENUM("AIF2 Loopback", aif2_loopback_enum);
1521
1522static SOC_ENUM_SINGLE_DECL(aif1dac_enum,
1523			    WM8994_POWER_MANAGEMENT_6, 0, aif1dac_text);
1524
1525static const struct snd_kcontrol_new aif1dac_mux =
1526	SOC_DAPM_ENUM("AIF1DAC Mux", aif1dac_enum);
1527
1528static const char *aif2dac_text[] = {
1529	"AIF2DACDAT", "AIF3DACDAT",
1530};
1531
1532static SOC_ENUM_SINGLE_DECL(aif2dac_enum,
1533			    WM8994_POWER_MANAGEMENT_6, 1, aif2dac_text);
1534
1535static const struct snd_kcontrol_new aif2dac_mux =
1536	SOC_DAPM_ENUM("AIF2DAC Mux", aif2dac_enum);
1537
1538static const char *aif2adc_text[] = {
1539	"AIF2ADCDAT", "AIF3DACDAT",
1540};
1541
1542static SOC_ENUM_SINGLE_DECL(aif2adc_enum,
1543			    WM8994_POWER_MANAGEMENT_6, 2, aif2adc_text);
1544
1545static const struct snd_kcontrol_new aif2adc_mux =
1546	SOC_DAPM_ENUM("AIF2ADC Mux", aif2adc_enum);
1547
1548static const char *aif3adc_text[] = {
1549	"AIF1ADCDAT", "AIF2ADCDAT", "AIF2DACDAT", "Mono PCM",
1550};
1551
1552static SOC_ENUM_SINGLE_DECL(wm8994_aif3adc_enum,
1553			    WM8994_POWER_MANAGEMENT_6, 3, aif3adc_text);
1554
1555static const struct snd_kcontrol_new wm8994_aif3adc_mux =
1556	SOC_DAPM_ENUM("AIF3ADC Mux", wm8994_aif3adc_enum);
1557
1558static SOC_ENUM_SINGLE_DECL(wm8958_aif3adc_enum,
1559			    WM8994_POWER_MANAGEMENT_6, 3, aif3adc_text);
1560
1561static const struct snd_kcontrol_new wm8958_aif3adc_mux =
1562	SOC_DAPM_ENUM("AIF3ADC Mux", wm8958_aif3adc_enum);
1563
1564static const char *mono_pcm_out_text[] = {
1565	"None", "AIF2ADCL", "AIF2ADCR",
1566};
1567
1568static SOC_ENUM_SINGLE_DECL(mono_pcm_out_enum,
1569			    WM8994_POWER_MANAGEMENT_6, 9, mono_pcm_out_text);
1570
1571static const struct snd_kcontrol_new mono_pcm_out_mux =
1572	SOC_DAPM_ENUM("Mono PCM Out Mux", mono_pcm_out_enum);
1573
1574static const char *aif2dac_src_text[] = {
1575	"AIF2", "AIF3",
1576};
1577
1578/* Note that these two control shouldn't be simultaneously switched to AIF3 */
1579static SOC_ENUM_SINGLE_DECL(aif2dacl_src_enum,
1580			    WM8994_POWER_MANAGEMENT_6, 7, aif2dac_src_text);
1581
1582static const struct snd_kcontrol_new aif2dacl_src_mux =
1583	SOC_DAPM_ENUM("AIF2DACL Mux", aif2dacl_src_enum);
1584
1585static SOC_ENUM_SINGLE_DECL(aif2dacr_src_enum,
1586			    WM8994_POWER_MANAGEMENT_6, 8, aif2dac_src_text);
1587
1588static const struct snd_kcontrol_new aif2dacr_src_mux =
1589	SOC_DAPM_ENUM("AIF2DACR Mux", aif2dacr_src_enum);
1590
1591static const struct snd_soc_dapm_widget wm8994_lateclk_revd_widgets[] = {
1592SND_SOC_DAPM_SUPPLY("AIF1CLK", SND_SOC_NOPM, 0, 0, aif1clk_late_ev,
1593	SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1594SND_SOC_DAPM_SUPPLY("AIF2CLK", SND_SOC_NOPM, 0, 0, aif2clk_late_ev,
1595	SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1596
1597SND_SOC_DAPM_PGA_E("Late DAC1L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1598	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1599SND_SOC_DAPM_PGA_E("Late DAC1R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1600	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1601SND_SOC_DAPM_PGA_E("Late DAC2L Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1602	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1603SND_SOC_DAPM_PGA_E("Late DAC2R Enable PGA", SND_SOC_NOPM, 0, 0, NULL, 0,
1604	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1605SND_SOC_DAPM_PGA_E("Direct Voice", SND_SOC_NOPM, 0, 0, NULL, 0,
1606	late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1607
1608SND_SOC_DAPM_MIXER_E("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0,
1609		     left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer),
1610		     late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1611SND_SOC_DAPM_MIXER_E("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0,
1612		     right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer),
1613		     late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1614SND_SOC_DAPM_MUX_E("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpl_mux,
1615		   late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1616SND_SOC_DAPM_MUX_E("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpr_mux,
1617		   late_enable_ev, SND_SOC_DAPM_PRE_PMU),
1618
1619SND_SOC_DAPM_POST("Late Disable PGA", late_disable_ev)
1620};
1621
1622static const struct snd_soc_dapm_widget wm8994_lateclk_widgets[] = {
1623SND_SOC_DAPM_SUPPLY("AIF1CLK", WM8994_AIF1_CLOCKING_1, 0, 0, aif1clk_ev,
1624		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1625		    SND_SOC_DAPM_PRE_PMD),
1626SND_SOC_DAPM_SUPPLY("AIF2CLK", WM8994_AIF2_CLOCKING_1, 0, 0, aif2clk_ev,
1627		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1628		    SND_SOC_DAPM_PRE_PMD),
1629SND_SOC_DAPM_PGA("Direct Voice", SND_SOC_NOPM, 0, 0, NULL, 0),
1630SND_SOC_DAPM_MIXER("SPKL", WM8994_POWER_MANAGEMENT_3, 8, 0,
1631		   left_speaker_mixer, ARRAY_SIZE(left_speaker_mixer)),
1632SND_SOC_DAPM_MIXER("SPKR", WM8994_POWER_MANAGEMENT_3, 9, 0,
1633		   right_speaker_mixer, ARRAY_SIZE(right_speaker_mixer)),
1634SND_SOC_DAPM_MUX("Left Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpl_mux),
1635SND_SOC_DAPM_MUX("Right Headphone Mux", SND_SOC_NOPM, 0, 0, &wm_hubs_hpr_mux),
1636};
1637
1638static const struct snd_soc_dapm_widget wm8994_dac_revd_widgets[] = {
1639SND_SOC_DAPM_DAC_E("DAC2L", NULL, SND_SOC_NOPM, 3, 0,
1640	dac_ev, SND_SOC_DAPM_PRE_PMU),
1641SND_SOC_DAPM_DAC_E("DAC2R", NULL, SND_SOC_NOPM, 2, 0,
1642	dac_ev, SND_SOC_DAPM_PRE_PMU),
1643SND_SOC_DAPM_DAC_E("DAC1L", NULL, SND_SOC_NOPM, 1, 0,
1644	dac_ev, SND_SOC_DAPM_PRE_PMU),
1645SND_SOC_DAPM_DAC_E("DAC1R", NULL, SND_SOC_NOPM, 0, 0,
1646	dac_ev, SND_SOC_DAPM_PRE_PMU),
1647};
1648
1649static const struct snd_soc_dapm_widget wm8994_dac_widgets[] = {
1650SND_SOC_DAPM_DAC("DAC2L", NULL, WM8994_POWER_MANAGEMENT_5, 3, 0),
1651SND_SOC_DAPM_DAC("DAC2R", NULL, WM8994_POWER_MANAGEMENT_5, 2, 0),
1652SND_SOC_DAPM_DAC("DAC1L", NULL, WM8994_POWER_MANAGEMENT_5, 1, 0),
1653SND_SOC_DAPM_DAC("DAC1R", NULL, WM8994_POWER_MANAGEMENT_5, 0, 0),
1654};
1655
1656static const struct snd_soc_dapm_widget wm8994_adc_revd_widgets[] = {
1657SND_SOC_DAPM_MUX_E("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux,
1658			adc_mux_ev, SND_SOC_DAPM_PRE_PMU),
1659SND_SOC_DAPM_MUX_E("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux,
1660			adc_mux_ev, SND_SOC_DAPM_PRE_PMU),
1661};
1662
1663static const struct snd_soc_dapm_widget wm8994_adc_widgets[] = {
1664SND_SOC_DAPM_MUX("ADCL Mux", WM8994_POWER_MANAGEMENT_4, 1, 0, &adcl_mux),
1665SND_SOC_DAPM_MUX("ADCR Mux", WM8994_POWER_MANAGEMENT_4, 0, 0, &adcr_mux),
1666};
1667
1668static const struct snd_soc_dapm_widget wm8994_dapm_widgets[] = {
1669SND_SOC_DAPM_INPUT("DMIC1DAT"),
1670SND_SOC_DAPM_INPUT("DMIC2DAT"),
1671SND_SOC_DAPM_INPUT("Clock"),
1672
1673SND_SOC_DAPM_SUPPLY_S("MICBIAS Supply", 1, SND_SOC_NOPM, 0, 0, micbias_ev,
1674		      SND_SOC_DAPM_PRE_PMU),
1675SND_SOC_DAPM_SUPPLY("VMID", SND_SOC_NOPM, 0, 0, vmid_event,
1676		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
1677
1678SND_SOC_DAPM_SUPPLY("CLK_SYS", SND_SOC_NOPM, 0, 0, clk_sys_event,
1679		    SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMU |
1680		    SND_SOC_DAPM_PRE_PMD),
1681
1682SND_SOC_DAPM_SUPPLY("DSP1CLK", SND_SOC_NOPM, 3, 0, NULL, 0),
1683SND_SOC_DAPM_SUPPLY("DSP2CLK", SND_SOC_NOPM, 2, 0, NULL, 0),
1684SND_SOC_DAPM_SUPPLY("DSPINTCLK", SND_SOC_NOPM, 1, 0, NULL, 0),
1685
1686SND_SOC_DAPM_AIF_OUT("AIF1ADC1L", NULL,
1687		     0, SND_SOC_NOPM, 9, 0),
1688SND_SOC_DAPM_AIF_OUT("AIF1ADC1R", NULL,
1689		     0, SND_SOC_NOPM, 8, 0),
1690SND_SOC_DAPM_AIF_IN_E("AIF1DAC1L", NULL, 0,
1691		      SND_SOC_NOPM, 9, 0, wm8958_aif_ev,
1692		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1693SND_SOC_DAPM_AIF_IN_E("AIF1DAC1R", NULL, 0,
1694		      SND_SOC_NOPM, 8, 0, wm8958_aif_ev,
1695		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1696
1697SND_SOC_DAPM_AIF_OUT("AIF1ADC2L", NULL,
1698		     0, SND_SOC_NOPM, 11, 0),
1699SND_SOC_DAPM_AIF_OUT("AIF1ADC2R", NULL,
1700		     0, SND_SOC_NOPM, 10, 0),
1701SND_SOC_DAPM_AIF_IN_E("AIF1DAC2L", NULL, 0,
1702		      SND_SOC_NOPM, 11, 0, wm8958_aif_ev,
1703		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1704SND_SOC_DAPM_AIF_IN_E("AIF1DAC2R", NULL, 0,
1705		      SND_SOC_NOPM, 10, 0, wm8958_aif_ev,
1706		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_POST_PMD),
1707
1708SND_SOC_DAPM_MIXER("AIF1ADC1L Mixer", SND_SOC_NOPM, 0, 0,
1709		   aif1adc1l_mix, ARRAY_SIZE(aif1adc1l_mix)),
1710SND_SOC_DAPM_MIXER("AIF1ADC1R Mixer", SND_SOC_NOPM, 0, 0,
1711		   aif1adc1r_mix, ARRAY_SIZE(aif1adc1r_mix)),
1712
1713SND_SOC_DAPM_MIXER("AIF1ADC2L Mixer", SND_SOC_NOPM, 0, 0,
1714		   aif1adc2l_mix, ARRAY_SIZE(aif1adc2l_mix)),
1715SND_SOC_DAPM_MIXER("AIF1ADC2R Mixer", SND_SOC_NOPM, 0, 0,
1716		   aif1adc2r_mix, ARRAY_SIZE(aif1adc2r_mix)),
1717
1718SND_SOC_DAPM_MIXER("AIF2DAC2L Mixer", SND_SOC_NOPM, 0, 0,
1719		   aif2dac2l_mix, ARRAY_SIZE(aif2dac2l_mix)),
1720SND_SOC_DAPM_MIXER("AIF2DAC2R Mixer", SND_SOC_NOPM, 0, 0,
1721		   aif2dac2r_mix, ARRAY_SIZE(aif2dac2r_mix)),
1722
1723SND_SOC_DAPM_MUX("Left Sidetone", SND_SOC_NOPM, 0, 0, &sidetone1_mux),
1724SND_SOC_DAPM_MUX("Right Sidetone", SND_SOC_NOPM, 0, 0, &sidetone2_mux),
1725
1726SND_SOC_DAPM_MIXER("DAC1L Mixer", SND_SOC_NOPM, 0, 0,
1727		   dac1l_mix, ARRAY_SIZE(dac1l_mix)),
1728SND_SOC_DAPM_MIXER("DAC1R Mixer", SND_SOC_NOPM, 0, 0,
1729		   dac1r_mix, ARRAY_SIZE(dac1r_mix)),
1730
1731SND_SOC_DAPM_AIF_OUT("AIF2ADCL", NULL, 0,
1732		     SND_SOC_NOPM, 13, 0),
1733SND_SOC_DAPM_AIF_OUT("AIF2ADCR", NULL, 0,
1734		     SND_SOC_NOPM, 12, 0),
1735SND_SOC_DAPM_AIF_IN_E("AIF2DACL", NULL, 0,
1736		      SND_SOC_NOPM, 13, 0, wm8958_aif_ev,
1737		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1738SND_SOC_DAPM_AIF_IN_E("AIF2DACR", NULL, 0,
1739		      SND_SOC_NOPM, 12, 0, wm8958_aif_ev,
1740		      SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
1741
1742SND_SOC_DAPM_AIF_IN("AIF1DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1743SND_SOC_DAPM_AIF_IN("AIF2DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1744SND_SOC_DAPM_AIF_OUT("AIF1ADCDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1745SND_SOC_DAPM_AIF_OUT("AIF2ADCDAT",  NULL, 0, SND_SOC_NOPM, 0, 0),
1746
1747SND_SOC_DAPM_MUX("AIF1DAC Mux", SND_SOC_NOPM, 0, 0, &aif1dac_mux),
1748SND_SOC_DAPM_MUX("AIF2DAC Mux", SND_SOC_NOPM, 0, 0, &aif2dac_mux),
1749SND_SOC_DAPM_MUX("AIF2ADC Mux", SND_SOC_NOPM, 0, 0, &aif2adc_mux),
1750
1751SND_SOC_DAPM_AIF_IN("AIF3DACDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1752SND_SOC_DAPM_AIF_OUT("AIF3ADCDAT", NULL, 0, SND_SOC_NOPM, 0, 0),
1753
1754SND_SOC_DAPM_SUPPLY("TOCLK", WM8994_CLOCKING_1, 4, 0, NULL, 0),
1755
1756SND_SOC_DAPM_ADC("DMIC2L", NULL, WM8994_POWER_MANAGEMENT_4, 5, 0),
1757SND_SOC_DAPM_ADC("DMIC2R", NULL, WM8994_POWER_MANAGEMENT_4, 4, 0),
1758SND_SOC_DAPM_ADC("DMIC1L", NULL, WM8994_POWER_MANAGEMENT_4, 3, 0),
1759SND_SOC_DAPM_ADC("DMIC1R", NULL, WM8994_POWER_MANAGEMENT_4, 2, 0),
1760
1761/* Power is done with the muxes since the ADC power also controls the
1762 * downsampling chain, the chip will automatically manage the analogue
1763 * specific portions.
1764 */
1765SND_SOC_DAPM_ADC("ADCL", NULL, SND_SOC_NOPM, 1, 0),
1766SND_SOC_DAPM_ADC("ADCR", NULL, SND_SOC_NOPM, 0, 0),
1767
1768SND_SOC_DAPM_MUX("AIF1 Loopback", SND_SOC_NOPM, 0, 0, &aif1_loopback),
1769SND_SOC_DAPM_MUX("AIF2 Loopback", SND_SOC_NOPM, 0, 0, &aif2_loopback),
1770
1771SND_SOC_DAPM_POST("Debug log", post_ev),
1772};
1773
1774static const struct snd_soc_dapm_widget wm8994_specific_dapm_widgets[] = {
1775SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8994_aif3adc_mux),
1776};
1777
1778static const struct snd_soc_dapm_widget wm8958_dapm_widgets[] = {
1779SND_SOC_DAPM_SUPPLY("AIF3", WM8994_POWER_MANAGEMENT_6, 5, 1, NULL, 0),
1780SND_SOC_DAPM_MUX("Mono PCM Out Mux", SND_SOC_NOPM, 0, 0, &mono_pcm_out_mux),
1781SND_SOC_DAPM_MUX("AIF2DACL Mux", SND_SOC_NOPM, 0, 0, &aif2dacl_src_mux),
1782SND_SOC_DAPM_MUX("AIF2DACR Mux", SND_SOC_NOPM, 0, 0, &aif2dacr_src_mux),
1783SND_SOC_DAPM_MUX("AIF3ADC Mux", SND_SOC_NOPM, 0, 0, &wm8958_aif3adc_mux),
1784};
1785
1786static const struct snd_soc_dapm_route intercon[] = {
1787	{ "CLK_SYS", NULL, "AIF1CLK", check_clk_sys },
1788	{ "CLK_SYS", NULL, "AIF2CLK", check_clk_sys },
1789
1790	{ "DSP1CLK", NULL, "CLK_SYS" },
1791	{ "DSP2CLK", NULL, "CLK_SYS" },
1792	{ "DSPINTCLK", NULL, "CLK_SYS" },
1793
1794	{ "AIF1ADC1L", NULL, "AIF1CLK" },
1795	{ "AIF1ADC1L", NULL, "DSP1CLK" },
1796	{ "AIF1ADC1R", NULL, "AIF1CLK" },
1797	{ "AIF1ADC1R", NULL, "DSP1CLK" },
1798	{ "AIF1ADC1R", NULL, "DSPINTCLK" },
1799
1800	{ "AIF1DAC1L", NULL, "AIF1CLK" },
1801	{ "AIF1DAC1L", NULL, "DSP1CLK" },
1802	{ "AIF1DAC1R", NULL, "AIF1CLK" },
1803	{ "AIF1DAC1R", NULL, "DSP1CLK" },
1804	{ "AIF1DAC1R", NULL, "DSPINTCLK" },
1805
1806	{ "AIF1ADC2L", NULL, "AIF1CLK" },
1807	{ "AIF1ADC2L", NULL, "DSP1CLK" },
1808	{ "AIF1ADC2R", NULL, "AIF1CLK" },
1809	{ "AIF1ADC2R", NULL, "DSP1CLK" },
1810	{ "AIF1ADC2R", NULL, "DSPINTCLK" },
1811
1812	{ "AIF1DAC2L", NULL, "AIF1CLK" },
1813	{ "AIF1DAC2L", NULL, "DSP1CLK" },
1814	{ "AIF1DAC2R", NULL, "AIF1CLK" },
1815	{ "AIF1DAC2R", NULL, "DSP1CLK" },
1816	{ "AIF1DAC2R", NULL, "DSPINTCLK" },
1817
1818	{ "AIF2ADCL", NULL, "AIF2CLK" },
1819	{ "AIF2ADCL", NULL, "DSP2CLK" },
1820	{ "AIF2ADCR", NULL, "AIF2CLK" },
1821	{ "AIF2ADCR", NULL, "DSP2CLK" },
1822	{ "AIF2ADCR", NULL, "DSPINTCLK" },
1823
1824	{ "AIF2DACL", NULL, "AIF2CLK" },
1825	{ "AIF2DACL", NULL, "DSP2CLK" },
1826	{ "AIF2DACR", NULL, "AIF2CLK" },
1827	{ "AIF2DACR", NULL, "DSP2CLK" },
1828	{ "AIF2DACR", NULL, "DSPINTCLK" },
1829
1830	{ "DMIC1L", NULL, "DMIC1DAT" },
1831	{ "DMIC1L", NULL, "CLK_SYS" },
1832	{ "DMIC1R", NULL, "DMIC1DAT" },
1833	{ "DMIC1R", NULL, "CLK_SYS" },
1834	{ "DMIC2L", NULL, "DMIC2DAT" },
1835	{ "DMIC2L", NULL, "CLK_SYS" },
1836	{ "DMIC2R", NULL, "DMIC2DAT" },
1837	{ "DMIC2R", NULL, "CLK_SYS" },
1838
1839	{ "ADCL", NULL, "AIF1CLK" },
1840	{ "ADCL", NULL, "DSP1CLK" },
1841	{ "ADCL", NULL, "DSPINTCLK" },
1842
1843	{ "ADCR", NULL, "AIF1CLK" },
1844	{ "ADCR", NULL, "DSP1CLK" },
1845	{ "ADCR", NULL, "DSPINTCLK" },
1846
1847	{ "ADCL Mux", "ADC", "ADCL" },
1848	{ "ADCL Mux", "DMIC", "DMIC1L" },
1849	{ "ADCR Mux", "ADC", "ADCR" },
1850	{ "ADCR Mux", "DMIC", "DMIC1R" },
1851
1852	{ "DAC1L", NULL, "AIF1CLK" },
1853	{ "DAC1L", NULL, "DSP1CLK" },
1854	{ "DAC1L", NULL, "DSPINTCLK" },
1855
1856	{ "DAC1R", NULL, "AIF1CLK" },
1857	{ "DAC1R", NULL, "DSP1CLK" },
1858	{ "DAC1R", NULL, "DSPINTCLK" },
1859
1860	{ "DAC2L", NULL, "AIF2CLK" },
1861	{ "DAC2L", NULL, "DSP2CLK" },
1862	{ "DAC2L", NULL, "DSPINTCLK" },
1863
1864	{ "DAC2R", NULL, "AIF2DACR" },
1865	{ "DAC2R", NULL, "AIF2CLK" },
1866	{ "DAC2R", NULL, "DSP2CLK" },
1867	{ "DAC2R", NULL, "DSPINTCLK" },
1868
1869	{ "TOCLK", NULL, "CLK_SYS" },
1870
1871	{ "AIF1DACDAT", NULL, "AIF1 Playback" },
1872	{ "AIF2DACDAT", NULL, "AIF2 Playback" },
1873	{ "AIF3DACDAT", NULL, "AIF3 Playback" },
1874
1875	{ "AIF1 Capture", NULL, "AIF1ADCDAT" },
1876	{ "AIF2 Capture", NULL, "AIF2ADCDAT" },
1877	{ "AIF3 Capture", NULL, "AIF3ADCDAT" },
1878
1879	/* AIF1 outputs */
1880	{ "AIF1ADC1L", NULL, "AIF1ADC1L Mixer" },
1881	{ "AIF1ADC1L Mixer", "ADC/DMIC Switch", "ADCL Mux" },
1882	{ "AIF1ADC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1883
1884	{ "AIF1ADC1R", NULL, "AIF1ADC1R Mixer" },
1885	{ "AIF1ADC1R Mixer", "ADC/DMIC Switch", "ADCR Mux" },
1886	{ "AIF1ADC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1887
1888	{ "AIF1ADC2L", NULL, "AIF1ADC2L Mixer" },
1889	{ "AIF1ADC2L Mixer", "DMIC Switch", "DMIC2L" },
1890	{ "AIF1ADC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1891
1892	{ "AIF1ADC2R", NULL, "AIF1ADC2R Mixer" },
1893	{ "AIF1ADC2R Mixer", "DMIC Switch", "DMIC2R" },
1894	{ "AIF1ADC2R Mixer", "AIF2 Switch", "AIF2DACR" },
1895
1896	/* Pin level routing for AIF3 */
1897	{ "AIF1DAC1L", NULL, "AIF1DAC Mux" },
1898	{ "AIF1DAC1R", NULL, "AIF1DAC Mux" },
1899	{ "AIF1DAC2L", NULL, "AIF1DAC Mux" },
1900	{ "AIF1DAC2R", NULL, "AIF1DAC Mux" },
1901
1902	{ "AIF1DAC Mux", "AIF1DACDAT", "AIF1 Loopback" },
1903	{ "AIF1DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1904	{ "AIF2DAC Mux", "AIF2DACDAT", "AIF2 Loopback" },
1905	{ "AIF2DAC Mux", "AIF3DACDAT", "AIF3DACDAT" },
1906	{ "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCL" },
1907	{ "AIF2ADC Mux", "AIF2ADCDAT", "AIF2ADCR" },
1908	{ "AIF2ADC Mux", "AIF3DACDAT", "AIF3ADCDAT" },
1909
1910	/* DAC1 inputs */
1911	{ "DAC1L Mixer", "AIF2 Switch", "AIF2DACL" },
1912	{ "DAC1L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1913	{ "DAC1L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
1914	{ "DAC1L Mixer", "Left Sidetone Switch", "Left Sidetone" },
1915	{ "DAC1L Mixer", "Right Sidetone Switch", "Right Sidetone" },
1916
1917	{ "DAC1R Mixer", "AIF2 Switch", "AIF2DACR" },
1918	{ "DAC1R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
1919	{ "DAC1R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
1920	{ "DAC1R Mixer", "Left Sidetone Switch", "Left Sidetone" },
1921	{ "DAC1R Mixer", "Right Sidetone Switch", "Right Sidetone" },
1922
1923	/* DAC2/AIF2 outputs  */
1924	{ "AIF2ADCL", NULL, "AIF2DAC2L Mixer" },
1925	{ "AIF2DAC2L Mixer", "AIF2 Switch", "AIF2DACL" },
1926	{ "AIF2DAC2L Mixer", "AIF1.2 Switch", "AIF1DAC2L" },
1927	{ "AIF2DAC2L Mixer", "AIF1.1 Switch", "AIF1DAC1L" },
1928	{ "AIF2DAC2L Mixer", "Left Sidetone Switch", "Left Sidetone" },
1929	{ "AIF2DAC2L Mixer", "Right Sidetone Switch", "Right Sidetone" },
1930
1931	{ "AIF2ADCR", NULL, "AIF2DAC2R Mixer" },
1932	{ "AIF2DAC2R Mixer", "AIF2 Switch", "AIF2DACR" },
1933	{ "AIF2DAC2R Mixer", "AIF1.2 Switch", "AIF1DAC2R" },
1934	{ "AIF2DAC2R Mixer", "AIF1.1 Switch", "AIF1DAC1R" },
1935	{ "AIF2DAC2R Mixer", "Left Sidetone Switch", "Left Sidetone" },
1936	{ "AIF2DAC2R Mixer", "Right Sidetone Switch", "Right Sidetone" },
1937
1938	{ "AIF1ADCDAT", NULL, "AIF1ADC1L" },
1939	{ "AIF1ADCDAT", NULL, "AIF1ADC1R" },
1940	{ "AIF1ADCDAT", NULL, "AIF1ADC2L" },
1941	{ "AIF1ADCDAT", NULL, "AIF1ADC2R" },
1942
1943	{ "AIF2ADCDAT", NULL, "AIF2ADC Mux" },
1944
1945	/* AIF3 output */
1946	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC1L" },
1947	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC1R" },
1948	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC2L" },
1949	{ "AIF3ADC Mux", "AIF1ADCDAT", "AIF1ADC2R" },
1950	{ "AIF3ADC Mux", "AIF2ADCDAT", "AIF2ADCL" },
1951	{ "AIF3ADC Mux", "AIF2ADCDAT", "AIF2ADCR" },
1952	{ "AIF3ADC Mux", "AIF2DACDAT", "AIF2DACL" },
1953	{ "AIF3ADC Mux", "AIF2DACDAT", "AIF2DACR" },
1954
1955	{ "AIF3ADCDAT", NULL, "AIF3ADC Mux" },
1956
1957	/* Loopback */
1958	{ "AIF1 Loopback", "ADCDAT", "AIF1ADCDAT" },
1959	{ "AIF1 Loopback", "None", "AIF1DACDAT" },
1960	{ "AIF2 Loopback", "ADCDAT", "AIF2ADCDAT" },
1961	{ "AIF2 Loopback", "None", "AIF2DACDAT" },
1962
1963	/* Sidetone */
1964	{ "Left Sidetone", "ADC/DMIC1", "ADCL Mux" },
1965	{ "Left Sidetone", "DMIC2", "DMIC2L" },
1966	{ "Right Sidetone", "ADC/DMIC1", "ADCR Mux" },
1967	{ "Right Sidetone", "DMIC2", "DMIC2R" },
1968
1969	/* Output stages */
1970	{ "Left Output Mixer", "DAC Switch", "DAC1L" },
1971	{ "Right Output Mixer", "DAC Switch", "DAC1R" },
1972
1973	{ "SPKL", "DAC1 Switch", "DAC1L" },
1974	{ "SPKL", "DAC2 Switch", "DAC2L" },
1975
1976	{ "SPKR", "DAC1 Switch", "DAC1R" },
1977	{ "SPKR", "DAC2 Switch", "DAC2R" },
1978
1979	{ "Left Headphone Mux", "DAC", "DAC1L" },
1980	{ "Right Headphone Mux", "DAC", "DAC1R" },
1981};
1982
1983static const struct snd_soc_dapm_route wm8994_lateclk_revd_intercon[] = {
1984	{ "DAC1L", NULL, "Late DAC1L Enable PGA" },
1985	{ "Late DAC1L Enable PGA", NULL, "DAC1L Mixer" },
1986	{ "DAC1R", NULL, "Late DAC1R Enable PGA" },
1987	{ "Late DAC1R Enable PGA", NULL, "DAC1R Mixer" },
1988	{ "DAC2L", NULL, "Late DAC2L Enable PGA" },
1989	{ "Late DAC2L Enable PGA", NULL, "AIF2DAC2L Mixer" },
1990	{ "DAC2R", NULL, "Late DAC2R Enable PGA" },
1991	{ "Late DAC2R Enable PGA", NULL, "AIF2DAC2R Mixer" }
1992};
1993
1994static const struct snd_soc_dapm_route wm8994_lateclk_intercon[] = {
1995	{ "DAC1L", NULL, "DAC1L Mixer" },
1996	{ "DAC1R", NULL, "DAC1R Mixer" },
1997	{ "DAC2L", NULL, "AIF2DAC2L Mixer" },
1998	{ "DAC2R", NULL, "AIF2DAC2R Mixer" },
1999};
2000
2001static const struct snd_soc_dapm_route wm8994_revd_intercon[] = {
2002	{ "AIF1DACDAT", NULL, "AIF2DACDAT" },
2003	{ "AIF2DACDAT", NULL, "AIF1DACDAT" },
2004	{ "AIF1ADCDAT", NULL, "AIF2ADCDAT" },
2005	{ "AIF2ADCDAT", NULL, "AIF1ADCDAT" },
2006	{ "MICBIAS1", NULL, "CLK_SYS" },
2007	{ "MICBIAS1", NULL, "MICBIAS Supply" },
2008	{ "MICBIAS2", NULL, "CLK_SYS" },
2009	{ "MICBIAS2", NULL, "MICBIAS Supply" },
2010};
2011
2012static const struct snd_soc_dapm_route wm8994_intercon[] = {
2013	{ "AIF2DACL", NULL, "AIF2DAC Mux" },
2014	{ "AIF2DACR", NULL, "AIF2DAC Mux" },
2015	{ "MICBIAS1", NULL, "VMID" },
2016	{ "MICBIAS2", NULL, "VMID" },
2017};
2018
2019static const struct snd_soc_dapm_route wm8958_intercon[] = {
2020	{ "AIF2DACL", NULL, "AIF2DACL Mux" },
2021	{ "AIF2DACR", NULL, "AIF2DACR Mux" },
2022
2023	{ "AIF2DACL Mux", "AIF2", "AIF2DAC Mux" },
2024	{ "AIF2DACL Mux", "AIF3", "AIF3DACDAT" },
2025	{ "AIF2DACR Mux", "AIF2", "AIF2DAC Mux" },
2026	{ "AIF2DACR Mux", "AIF3", "AIF3DACDAT" },
2027
2028	{ "AIF3DACDAT", NULL, "AIF3" },
2029	{ "AIF3ADCDAT", NULL, "AIF3" },
2030
2031	{ "Mono PCM Out Mux", "AIF2ADCL", "AIF2ADCL" },
2032	{ "Mono PCM Out Mux", "AIF2ADCR", "AIF2ADCR" },
2033
2034	{ "AIF3ADC Mux", "Mono PCM", "Mono PCM Out Mux" },
2035};
2036
2037/* The size in bits of the FLL divide multiplied by 10
2038 * to allow rounding later */
2039#define FIXED_FLL_SIZE ((1 << 16) * 10)
2040
2041struct fll_div {
2042	u16 outdiv;
2043	u16 n;
2044	u16 k;
2045	u16 lambda;
2046	u16 clk_ref_div;
2047	u16 fll_fratio;
2048};
2049
2050static int wm8994_get_fll_config(struct wm8994 *control, struct fll_div *fll,
2051				 int freq_in, int freq_out)
2052{
2053	u64 Kpart;
2054	unsigned int K, Ndiv, Nmod, gcd_fll;
2055
2056	pr_debug("FLL input=%dHz, output=%dHz\n", freq_in, freq_out);
2057
2058	/* Scale the input frequency down to <= 13.5MHz */
2059	fll->clk_ref_div = 0;
2060	while (freq_in > 13500000) {
2061		fll->clk_ref_div++;
2062		freq_in /= 2;
2063
2064		if (fll->clk_ref_div > 3)
2065			return -EINVAL;
2066	}
2067	pr_debug("CLK_REF_DIV=%d, Fref=%dHz\n", fll->clk_ref_div, freq_in);
2068
2069	/* Scale the output to give 90MHz<=Fvco<=100MHz */
2070	fll->outdiv = 3;
2071	while (freq_out * (fll->outdiv + 1) < 90000000) {
2072		fll->outdiv++;
2073		if (fll->outdiv > 63)
2074			return -EINVAL;
2075	}
2076	freq_out *= fll->outdiv + 1;
2077	pr_debug("OUTDIV=%d, Fvco=%dHz\n", fll->outdiv, freq_out);
2078
2079	if (freq_in > 1000000) {
2080		fll->fll_fratio = 0;
2081	} else if (freq_in > 256000) {
2082		fll->fll_fratio = 1;
2083		freq_in *= 2;
2084	} else if (freq_in > 128000) {
2085		fll->fll_fratio = 2;
2086		freq_in *= 4;
2087	} else if (freq_in > 64000) {
2088		fll->fll_fratio = 3;
2089		freq_in *= 8;
2090	} else {
2091		fll->fll_fratio = 4;
2092		freq_in *= 16;
2093	}
2094	pr_debug("FLL_FRATIO=%d, Fref=%dHz\n", fll->fll_fratio, freq_in);
2095
2096	/* Now, calculate N.K */
2097	Ndiv = freq_out / freq_in;
2098
2099	fll->n = Ndiv;
2100	Nmod = freq_out % freq_in;
2101	pr_debug("Nmod=%d\n", Nmod);
2102
2103	switch (control->type) {
2104	case WM8994:
2105		/* Calculate fractional part - scale up so we can round. */
2106		Kpart = FIXED_FLL_SIZE * (long long)Nmod;
2107
2108		do_div(Kpart, freq_in);
2109
2110		K = Kpart & 0xFFFFFFFF;
2111
2112		if ((K % 10) >= 5)
2113			K += 5;
2114
2115		/* Move down to proper range now rounding is done */
2116		fll->k = K / 10;
2117		fll->lambda = 0;
2118
2119		pr_debug("N=%x K=%x\n", fll->n, fll->k);
2120		break;
2121
2122	default:
2123		gcd_fll = gcd(freq_out, freq_in);
2124
2125		fll->k = (freq_out - (freq_in * fll->n)) / gcd_fll;
2126		fll->lambda = freq_in / gcd_fll;
2127		
2128	}
2129
2130	return 0;
2131}
2132
2133static int _wm8994_set_fll(struct snd_soc_component *component, int id, int src,
2134			  unsigned int freq_in, unsigned int freq_out)
2135{
2136	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2137	struct wm8994 *control = wm8994->wm8994;
2138	int reg_offset, ret;
2139	struct fll_div fll;
2140	u16 reg, clk1, aif_reg, aif_src;
2141	unsigned long timeout;
2142	bool was_enabled;
 
2143
2144	switch (id) {
2145	case WM8994_FLL1:
2146		reg_offset = 0;
2147		id = 0;
2148		aif_src = 0x10;
2149		break;
2150	case WM8994_FLL2:
2151		reg_offset = 0x20;
2152		id = 1;
2153		aif_src = 0x18;
2154		break;
2155	default:
2156		return -EINVAL;
2157	}
2158
2159	reg = snd_soc_component_read32(component, WM8994_FLL1_CONTROL_1 + reg_offset);
2160	was_enabled = reg & WM8994_FLL1_ENA;
2161
2162	switch (src) {
2163	case 0:
2164		/* Allow no source specification when stopping */
2165		if (freq_out)
2166			return -EINVAL;
2167		src = wm8994->fll[id].src;
2168		break;
2169	case WM8994_FLL_SRC_MCLK1:
2170	case WM8994_FLL_SRC_MCLK2:
2171	case WM8994_FLL_SRC_LRCLK:
2172	case WM8994_FLL_SRC_BCLK:
2173		break;
2174	case WM8994_FLL_SRC_INTERNAL:
2175		freq_in = 12000000;
2176		freq_out = 12000000;
2177		break;
2178	default:
2179		return -EINVAL;
2180	}
2181
2182	/* Are we changing anything? */
2183	if (wm8994->fll[id].src == src &&
2184	    wm8994->fll[id].in == freq_in && wm8994->fll[id].out == freq_out)
2185		return 0;
2186
2187	/* If we're stopping the FLL redo the old config - no
2188	 * registers will actually be written but we avoid GCC flow
2189	 * analysis bugs spewing warnings.
2190	 */
2191	if (freq_out)
2192		ret = wm8994_get_fll_config(control, &fll, freq_in, freq_out);
2193	else
2194		ret = wm8994_get_fll_config(control, &fll, wm8994->fll[id].in,
2195					    wm8994->fll[id].out);
2196	if (ret < 0)
2197		return ret;
2198
2199	/* Make sure that we're not providing SYSCLK right now */
2200	clk1 = snd_soc_component_read32(component, WM8994_CLOCKING_1);
2201	if (clk1 & WM8994_SYSCLK_SRC)
2202		aif_reg = WM8994_AIF2_CLOCKING_1;
2203	else
2204		aif_reg = WM8994_AIF1_CLOCKING_1;
2205	reg = snd_soc_component_read32(component, aif_reg);
2206
2207	if ((reg & WM8994_AIF1CLK_ENA) &&
2208	    (reg & WM8994_AIF1CLK_SRC_MASK) == aif_src) {
2209		dev_err(component->dev, "FLL%d is currently providing SYSCLK\n",
2210			id + 1);
2211		return -EBUSY;
2212	}
2213
2214	/* We always need to disable the FLL while reconfiguring */
2215	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_1 + reg_offset,
2216			    WM8994_FLL1_ENA, 0);
2217
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2218	if (wm8994->fll_byp && src == WM8994_FLL_SRC_BCLK &&
2219	    freq_in == freq_out && freq_out) {
2220		dev_dbg(component->dev, "Bypassing FLL%d\n", id + 1);
2221		snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_5 + reg_offset,
2222				    WM8958_FLL1_BYP, WM8958_FLL1_BYP);
2223		goto out;
2224	}
2225
2226	reg = (fll.outdiv << WM8994_FLL1_OUTDIV_SHIFT) |
2227		(fll.fll_fratio << WM8994_FLL1_FRATIO_SHIFT);
2228	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_2 + reg_offset,
2229			    WM8994_FLL1_OUTDIV_MASK |
2230			    WM8994_FLL1_FRATIO_MASK, reg);
2231
2232	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_3 + reg_offset,
2233			    WM8994_FLL1_K_MASK, fll.k);
2234
2235	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_4 + reg_offset,
2236			    WM8994_FLL1_N_MASK,
2237			    fll.n << WM8994_FLL1_N_SHIFT);
2238
2239	if (fll.lambda) {
2240		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_1 + reg_offset,
2241				    WM8958_FLL1_LAMBDA_MASK,
2242				    fll.lambda);
2243		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_2 + reg_offset,
2244				    WM8958_FLL1_EFS_ENA, WM8958_FLL1_EFS_ENA);
2245	} else {
2246		snd_soc_component_update_bits(component, WM8958_FLL1_EFS_2 + reg_offset,
2247				    WM8958_FLL1_EFS_ENA, 0);
2248	}
2249
2250	snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_5 + reg_offset,
2251			    WM8994_FLL1_FRC_NCO | WM8958_FLL1_BYP |
2252			    WM8994_FLL1_REFCLK_DIV_MASK |
2253			    WM8994_FLL1_REFCLK_SRC_MASK,
2254			    ((src == WM8994_FLL_SRC_INTERNAL)
2255			     << WM8994_FLL1_FRC_NCO_SHIFT) |
2256			    (fll.clk_ref_div << WM8994_FLL1_REFCLK_DIV_SHIFT) |
2257			    (src - 1));
2258
2259	/* Clear any pending completion from a previous failure */
2260	try_wait_for_completion(&wm8994->fll_locked[id]);
2261
 
 
 
 
 
 
 
 
 
 
 
2262	/* Enable (with fractional mode if required) */
2263	if (freq_out) {
 
 
 
 
 
 
 
2264		/* Enable VMID if we need it */
2265		if (!was_enabled) {
 
2266			active_reference(component);
2267
2268			switch (control->type) {
2269			case WM8994:
2270				vmid_reference(component);
2271				break;
2272			case WM8958:
2273				if (control->revision < 1)
2274					vmid_reference(component);
2275				break;
2276			default:
2277				break;
2278			}
2279		}
2280
2281		reg = WM8994_FLL1_ENA;
2282
2283		if (fll.k)
2284			reg |= WM8994_FLL1_FRAC;
2285		if (src == WM8994_FLL_SRC_INTERNAL)
2286			reg |= WM8994_FLL1_OSC_ENA;
2287
2288		snd_soc_component_update_bits(component, WM8994_FLL1_CONTROL_1 + reg_offset,
2289				    WM8994_FLL1_ENA | WM8994_FLL1_OSC_ENA |
2290				    WM8994_FLL1_FRAC, reg);
2291
2292		if (wm8994->fll_locked_irq) {
2293			timeout = wait_for_completion_timeout(&wm8994->fll_locked[id],
2294							      msecs_to_jiffies(10));
2295			if (timeout == 0)
2296				dev_warn(component->dev,
2297					 "Timed out waiting for FLL lock\n");
2298		} else {
2299			msleep(5);
2300		}
2301	} else {
2302		if (was_enabled) {
2303			switch (control->type) {
2304			case WM8994:
2305				vmid_dereference(component);
2306				break;
2307			case WM8958:
2308				if (control->revision < 1)
2309					vmid_dereference(component);
2310				break;
2311			default:
2312				break;
2313			}
2314
2315			active_dereference(component);
2316		}
2317	}
2318
2319out:
2320	wm8994->fll[id].in = freq_in;
2321	wm8994->fll[id].out = freq_out;
2322	wm8994->fll[id].src = src;
2323
2324	configure_clock(component);
2325
2326	/*
2327	 * If SYSCLK will be less than 50kHz adjust AIFnCLK dividers
2328	 * for detection.
2329	 */
2330	if (max(wm8994->aifclk[0], wm8994->aifclk[1]) < 50000) {
2331		dev_dbg(component->dev, "Configuring AIFs for 128fs\n");
2332
2333		wm8994->aifdiv[0] = snd_soc_component_read32(component, WM8994_AIF1_RATE)
2334			& WM8994_AIF1CLK_RATE_MASK;
2335		wm8994->aifdiv[1] = snd_soc_component_read32(component, WM8994_AIF2_RATE)
2336			& WM8994_AIF1CLK_RATE_MASK;
2337
2338		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2339				    WM8994_AIF1CLK_RATE_MASK, 0x1);
2340		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2341				    WM8994_AIF2CLK_RATE_MASK, 0x1);
2342	} else if (wm8994->aifdiv[0]) {
2343		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2344				    WM8994_AIF1CLK_RATE_MASK,
2345				    wm8994->aifdiv[0]);
2346		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2347				    WM8994_AIF2CLK_RATE_MASK,
2348				    wm8994->aifdiv[1]);
2349
2350		wm8994->aifdiv[0] = 0;
2351		wm8994->aifdiv[1] = 0;
2352	}
2353
2354	return 0;
2355}
2356
2357static irqreturn_t wm8994_fll_locked_irq(int irq, void *data)
2358{
2359	struct completion *completion = data;
2360
2361	complete(completion);
2362
2363	return IRQ_HANDLED;
2364}
2365
2366static int opclk_divs[] = { 10, 20, 30, 40, 55, 60, 80, 120, 160 };
2367
2368static int wm8994_set_fll(struct snd_soc_dai *dai, int id, int src,
2369			  unsigned int freq_in, unsigned int freq_out)
2370{
2371	return _wm8994_set_fll(dai->component, id, src, freq_in, freq_out);
2372}
2373
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2374static int wm8994_set_dai_sysclk(struct snd_soc_dai *dai,
2375		int clk_id, unsigned int freq, int dir)
2376{
2377	struct snd_soc_component *component = dai->component;
2378	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2379	int i;
2380
2381	switch (dai->id) {
2382	case 1:
2383	case 2:
2384		break;
2385
2386	default:
2387		/* AIF3 shares clocking with AIF1/2 */
2388		return -EINVAL;
2389	}
2390
2391	switch (clk_id) {
2392	case WM8994_SYSCLK_MCLK1:
2393		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK1;
2394		wm8994->mclk[0] = freq;
 
 
 
 
 
2395		dev_dbg(dai->dev, "AIF%d using MCLK1 at %uHz\n",
2396			dai->id, freq);
2397		break;
2398
2399	case WM8994_SYSCLK_MCLK2:
2400		/* TODO: Set GPIO AF */
2401		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_MCLK2;
2402		wm8994->mclk[1] = freq;
 
 
 
 
 
2403		dev_dbg(dai->dev, "AIF%d using MCLK2 at %uHz\n",
2404			dai->id, freq);
2405		break;
2406
2407	case WM8994_SYSCLK_FLL1:
2408		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL1;
2409		dev_dbg(dai->dev, "AIF%d using FLL1\n", dai->id);
2410		break;
2411
2412	case WM8994_SYSCLK_FLL2:
2413		wm8994->sysclk[dai->id - 1] = WM8994_SYSCLK_FLL2;
2414		dev_dbg(dai->dev, "AIF%d using FLL2\n", dai->id);
2415		break;
2416
2417	case WM8994_SYSCLK_OPCLK:
2418		/* Special case - a division (times 10) is given and
2419		 * no effect on main clocking.
2420		 */
2421		if (freq) {
2422			for (i = 0; i < ARRAY_SIZE(opclk_divs); i++)
2423				if (opclk_divs[i] == freq)
2424					break;
2425			if (i == ARRAY_SIZE(opclk_divs))
2426				return -EINVAL;
2427			snd_soc_component_update_bits(component, WM8994_CLOCKING_2,
2428					    WM8994_OPCLK_DIV_MASK, i);
2429			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_2,
2430					    WM8994_OPCLK_ENA, WM8994_OPCLK_ENA);
2431		} else {
2432			snd_soc_component_update_bits(component, WM8994_POWER_MANAGEMENT_2,
2433					    WM8994_OPCLK_ENA, 0);
2434		}
 
2435
2436	default:
2437		return -EINVAL;
2438	}
2439
2440	configure_clock(component);
2441
2442	/*
2443	 * If SYSCLK will be less than 50kHz adjust AIFnCLK dividers
2444	 * for detection.
2445	 */
2446	if (max(wm8994->aifclk[0], wm8994->aifclk[1]) < 50000) {
2447		dev_dbg(component->dev, "Configuring AIFs for 128fs\n");
2448
2449		wm8994->aifdiv[0] = snd_soc_component_read32(component, WM8994_AIF1_RATE)
2450			& WM8994_AIF1CLK_RATE_MASK;
2451		wm8994->aifdiv[1] = snd_soc_component_read32(component, WM8994_AIF2_RATE)
2452			& WM8994_AIF1CLK_RATE_MASK;
2453
2454		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2455				    WM8994_AIF1CLK_RATE_MASK, 0x1);
2456		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2457				    WM8994_AIF2CLK_RATE_MASK, 0x1);
2458	} else if (wm8994->aifdiv[0]) {
2459		snd_soc_component_update_bits(component, WM8994_AIF1_RATE,
2460				    WM8994_AIF1CLK_RATE_MASK,
2461				    wm8994->aifdiv[0]);
2462		snd_soc_component_update_bits(component, WM8994_AIF2_RATE,
2463				    WM8994_AIF2CLK_RATE_MASK,
2464				    wm8994->aifdiv[1]);
2465
2466		wm8994->aifdiv[0] = 0;
2467		wm8994->aifdiv[1] = 0;
2468	}
2469
2470	return 0;
2471}
2472
2473static int wm8994_set_bias_level(struct snd_soc_component *component,
2474				 enum snd_soc_bias_level level)
2475{
2476	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2477	struct wm8994 *control = wm8994->wm8994;
2478
2479	wm_hubs_set_bias_level(component, level);
2480
2481	switch (level) {
2482	case SND_SOC_BIAS_ON:
2483		break;
2484
2485	case SND_SOC_BIAS_PREPARE:
2486		/* MICBIAS into regulating mode */
2487		switch (control->type) {
2488		case WM8958:
2489		case WM1811:
2490			snd_soc_component_update_bits(component, WM8958_MICBIAS1,
2491					    WM8958_MICB1_MODE, 0);
2492			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
2493					    WM8958_MICB2_MODE, 0);
2494			break;
2495		default:
2496			break;
2497		}
2498
2499		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_STANDBY)
2500			active_reference(component);
2501		break;
2502
2503	case SND_SOC_BIAS_STANDBY:
2504		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF) {
2505			switch (control->type) {
2506			case WM8958:
2507				if (control->revision == 0) {
2508					/* Optimise performance for rev A */
2509					snd_soc_component_update_bits(component,
2510							    WM8958_CHARGE_PUMP_2,
2511							    WM8958_CP_DISCH,
2512							    WM8958_CP_DISCH);
2513				}
2514				break;
2515
2516			default:
2517				break;
2518			}
2519
2520			/* Discharge LINEOUT1 & 2 */
2521			snd_soc_component_update_bits(component, WM8994_ANTIPOP_1,
2522					    WM8994_LINEOUT1_DISCH |
2523					    WM8994_LINEOUT2_DISCH,
2524					    WM8994_LINEOUT1_DISCH |
2525					    WM8994_LINEOUT2_DISCH);
2526		}
2527
2528		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_PREPARE)
2529			active_dereference(component);
2530
2531		/* MICBIAS into bypass mode on newer devices */
2532		switch (control->type) {
2533		case WM8958:
2534		case WM1811:
2535			snd_soc_component_update_bits(component, WM8958_MICBIAS1,
2536					    WM8958_MICB1_MODE,
2537					    WM8958_MICB1_MODE);
2538			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
2539					    WM8958_MICB2_MODE,
2540					    WM8958_MICB2_MODE);
2541			break;
2542		default:
2543			break;
2544		}
2545		break;
2546
2547	case SND_SOC_BIAS_OFF:
2548		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_STANDBY)
2549			wm8994->cur_fw = NULL;
2550		break;
2551	}
2552
2553	return 0;
2554}
2555
2556int wm8994_vmid_mode(struct snd_soc_component *component, enum wm8994_vmid_mode mode)
2557{
2558	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2559	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
2560
2561	switch (mode) {
2562	case WM8994_VMID_NORMAL:
2563		snd_soc_dapm_mutex_lock(dapm);
2564
2565		if (wm8994->hubs.lineout1_se) {
2566			snd_soc_dapm_disable_pin_unlocked(dapm,
2567							  "LINEOUT1N Driver");
2568			snd_soc_dapm_disable_pin_unlocked(dapm,
2569							  "LINEOUT1P Driver");
2570		}
2571		if (wm8994->hubs.lineout2_se) {
2572			snd_soc_dapm_disable_pin_unlocked(dapm,
2573							  "LINEOUT2N Driver");
2574			snd_soc_dapm_disable_pin_unlocked(dapm,
2575							  "LINEOUT2P Driver");
2576		}
2577
2578		/* Do the sync with the old mode to allow it to clean up */
2579		snd_soc_dapm_sync_unlocked(dapm);
2580		wm8994->vmid_mode = mode;
2581
2582		snd_soc_dapm_mutex_unlock(dapm);
2583		break;
2584
2585	case WM8994_VMID_FORCE:
2586		snd_soc_dapm_mutex_lock(dapm);
2587
2588		if (wm8994->hubs.lineout1_se) {
2589			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2590							       "LINEOUT1N Driver");
2591			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2592							       "LINEOUT1P Driver");
2593		}
2594		if (wm8994->hubs.lineout2_se) {
2595			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2596							       "LINEOUT2N Driver");
2597			snd_soc_dapm_force_enable_pin_unlocked(dapm,
2598							       "LINEOUT2P Driver");
2599		}
2600
2601		wm8994->vmid_mode = mode;
2602		snd_soc_dapm_sync_unlocked(dapm);
2603
2604		snd_soc_dapm_mutex_unlock(dapm);
2605		break;
2606
2607	default:
2608		return -EINVAL;
2609	}
2610
2611	return 0;
2612}
2613
2614static int wm8994_set_dai_fmt(struct snd_soc_dai *dai, unsigned int fmt)
2615{
2616	struct snd_soc_component *component = dai->component;
2617	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2618	struct wm8994 *control = wm8994->wm8994;
2619	int ms_reg;
2620	int aif1_reg;
2621	int dac_reg;
2622	int adc_reg;
2623	int ms = 0;
2624	int aif1 = 0;
2625	int lrclk = 0;
2626
2627	switch (dai->id) {
2628	case 1:
2629		ms_reg = WM8994_AIF1_MASTER_SLAVE;
2630		aif1_reg = WM8994_AIF1_CONTROL_1;
2631		dac_reg = WM8994_AIF1DAC_LRCLK;
2632		adc_reg = WM8994_AIF1ADC_LRCLK;
2633		break;
2634	case 2:
2635		ms_reg = WM8994_AIF2_MASTER_SLAVE;
2636		aif1_reg = WM8994_AIF2_CONTROL_1;
2637		dac_reg = WM8994_AIF1DAC_LRCLK;
2638		adc_reg = WM8994_AIF1ADC_LRCLK;
2639		break;
2640	default:
2641		return -EINVAL;
2642	}
2643
2644	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2645	case SND_SOC_DAIFMT_CBS_CFS:
2646		break;
2647	case SND_SOC_DAIFMT_CBM_CFM:
2648		ms = WM8994_AIF1_MSTR;
2649		break;
2650	default:
2651		return -EINVAL;
2652	}
2653
2654	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2655	case SND_SOC_DAIFMT_DSP_B:
2656		aif1 |= WM8994_AIF1_LRCLK_INV;
2657		lrclk |= WM8958_AIF1_LRCLK_INV;
2658		/* fall through */
2659	case SND_SOC_DAIFMT_DSP_A:
2660		aif1 |= 0x18;
2661		break;
2662	case SND_SOC_DAIFMT_I2S:
2663		aif1 |= 0x10;
2664		break;
2665	case SND_SOC_DAIFMT_RIGHT_J:
2666		break;
2667	case SND_SOC_DAIFMT_LEFT_J:
2668		aif1 |= 0x8;
2669		break;
2670	default:
2671		return -EINVAL;
2672	}
2673
2674	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
2675	case SND_SOC_DAIFMT_DSP_A:
2676	case SND_SOC_DAIFMT_DSP_B:
2677		/* frame inversion not valid for DSP modes */
2678		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2679		case SND_SOC_DAIFMT_NB_NF:
2680			break;
2681		case SND_SOC_DAIFMT_IB_NF:
2682			aif1 |= WM8994_AIF1_BCLK_INV;
2683			break;
2684		default:
2685			return -EINVAL;
2686		}
2687		break;
2688
2689	case SND_SOC_DAIFMT_I2S:
2690	case SND_SOC_DAIFMT_RIGHT_J:
2691	case SND_SOC_DAIFMT_LEFT_J:
2692		switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2693		case SND_SOC_DAIFMT_NB_NF:
2694			break;
2695		case SND_SOC_DAIFMT_IB_IF:
2696			aif1 |= WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV;
2697			lrclk |= WM8958_AIF1_LRCLK_INV;
2698			break;
2699		case SND_SOC_DAIFMT_IB_NF:
2700			aif1 |= WM8994_AIF1_BCLK_INV;
2701			break;
2702		case SND_SOC_DAIFMT_NB_IF:
2703			aif1 |= WM8994_AIF1_LRCLK_INV;
2704			lrclk |= WM8958_AIF1_LRCLK_INV;
2705			break;
2706		default:
2707			return -EINVAL;
2708		}
2709		break;
2710	default:
2711		return -EINVAL;
2712	}
2713
2714	/* The AIF2 format configuration needs to be mirrored to AIF3
2715	 * on WM8958 if it's in use so just do it all the time. */
2716	switch (control->type) {
2717	case WM1811:
2718	case WM8958:
2719		if (dai->id == 2)
2720			snd_soc_component_update_bits(component, WM8958_AIF3_CONTROL_1,
2721					    WM8994_AIF1_LRCLK_INV |
2722					    WM8958_AIF3_FMT_MASK, aif1);
2723		break;
2724
2725	default:
2726		break;
2727	}
2728
2729	snd_soc_component_update_bits(component, aif1_reg,
2730			    WM8994_AIF1_BCLK_INV | WM8994_AIF1_LRCLK_INV |
2731			    WM8994_AIF1_FMT_MASK,
2732			    aif1);
2733	snd_soc_component_update_bits(component, ms_reg, WM8994_AIF1_MSTR,
2734			    ms);
2735	snd_soc_component_update_bits(component, dac_reg,
2736			    WM8958_AIF1_LRCLK_INV, lrclk);
2737	snd_soc_component_update_bits(component, adc_reg,
2738			    WM8958_AIF1_LRCLK_INV, lrclk);
2739
2740	return 0;
2741}
2742
2743static struct {
2744	int val, rate;
2745} srs[] = {
2746	{ 0,   8000 },
2747	{ 1,  11025 },
2748	{ 2,  12000 },
2749	{ 3,  16000 },
2750	{ 4,  22050 },
2751	{ 5,  24000 },
2752	{ 6,  32000 },
2753	{ 7,  44100 },
2754	{ 8,  48000 },
2755	{ 9,  88200 },
2756	{ 10, 96000 },
2757};
2758
2759static int fs_ratios[] = {
2760	64, 128, 192, 256, 384, 512, 768, 1024, 1408, 1536
2761};
2762
2763static int bclk_divs[] = {
2764	10, 15, 20, 30, 40, 50, 60, 80, 110, 120, 160, 220, 240, 320, 440, 480,
2765	640, 880, 960, 1280, 1760, 1920
2766};
2767
2768static int wm8994_hw_params(struct snd_pcm_substream *substream,
2769			    struct snd_pcm_hw_params *params,
2770			    struct snd_soc_dai *dai)
2771{
2772	struct snd_soc_component *component = dai->component;
2773	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2774	struct wm8994 *control = wm8994->wm8994;
2775	struct wm8994_pdata *pdata = &control->pdata;
2776	int aif1_reg;
2777	int aif2_reg;
2778	int bclk_reg;
2779	int lrclk_reg;
2780	int rate_reg;
2781	int aif1 = 0;
2782	int aif2 = 0;
2783	int bclk = 0;
2784	int lrclk = 0;
2785	int rate_val = 0;
2786	int id = dai->id - 1;
2787
2788	int i, cur_val, best_val, bclk_rate, best;
2789
2790	switch (dai->id) {
2791	case 1:
2792		aif1_reg = WM8994_AIF1_CONTROL_1;
2793		aif2_reg = WM8994_AIF1_CONTROL_2;
2794		bclk_reg = WM8994_AIF1_BCLK;
2795		rate_reg = WM8994_AIF1_RATE;
2796		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2797		    wm8994->lrclk_shared[0]) {
2798			lrclk_reg = WM8994_AIF1DAC_LRCLK;
2799		} else {
2800			lrclk_reg = WM8994_AIF1ADC_LRCLK;
2801			dev_dbg(component->dev, "AIF1 using split LRCLK\n");
2802		}
2803		break;
2804	case 2:
2805		aif1_reg = WM8994_AIF2_CONTROL_1;
2806		aif2_reg = WM8994_AIF2_CONTROL_2;
2807		bclk_reg = WM8994_AIF2_BCLK;
2808		rate_reg = WM8994_AIF2_RATE;
2809		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
2810		    wm8994->lrclk_shared[1]) {
2811			lrclk_reg = WM8994_AIF2DAC_LRCLK;
2812		} else {
2813			lrclk_reg = WM8994_AIF2ADC_LRCLK;
2814			dev_dbg(component->dev, "AIF2 using split LRCLK\n");
2815		}
2816		break;
2817	default:
2818		return -EINVAL;
2819	}
2820
2821	bclk_rate = params_rate(params);
2822	switch (params_width(params)) {
2823	case 16:
2824		bclk_rate *= 16;
2825		break;
2826	case 20:
2827		bclk_rate *= 20;
2828		aif1 |= 0x20;
2829		break;
2830	case 24:
2831		bclk_rate *= 24;
2832		aif1 |= 0x40;
2833		break;
2834	case 32:
2835		bclk_rate *= 32;
2836		aif1 |= 0x60;
2837		break;
2838	default:
2839		return -EINVAL;
2840	}
2841
2842	wm8994->channels[id] = params_channels(params);
2843	if (pdata->max_channels_clocked[id] &&
2844	    wm8994->channels[id] > pdata->max_channels_clocked[id]) {
2845		dev_dbg(dai->dev, "Constraining channels to %d from %d\n",
2846			pdata->max_channels_clocked[id], wm8994->channels[id]);
2847		wm8994->channels[id] = pdata->max_channels_clocked[id];
2848	}
2849
2850	switch (wm8994->channels[id]) {
2851	case 1:
2852	case 2:
2853		bclk_rate *= 2;
2854		break;
2855	default:
2856		bclk_rate *= 4;
2857		break;
2858	}
2859
2860	/* Try to find an appropriate sample rate; look for an exact match. */
2861	for (i = 0; i < ARRAY_SIZE(srs); i++)
2862		if (srs[i].rate == params_rate(params))
2863			break;
2864	if (i == ARRAY_SIZE(srs))
2865		return -EINVAL;
2866	rate_val |= srs[i].val << WM8994_AIF1_SR_SHIFT;
2867
2868	dev_dbg(dai->dev, "Sample rate is %dHz\n", srs[i].rate);
2869	dev_dbg(dai->dev, "AIF%dCLK is %dHz, target BCLK %dHz\n",
2870		dai->id, wm8994->aifclk[id], bclk_rate);
2871
2872	if (wm8994->channels[id] == 1 &&
2873	    (snd_soc_component_read32(component, aif1_reg) & 0x18) == 0x18)
2874		aif2 |= WM8994_AIF1_MONO;
2875
2876	if (wm8994->aifclk[id] == 0) {
2877		dev_err(dai->dev, "AIF%dCLK not configured\n", dai->id);
2878		return -EINVAL;
2879	}
2880
2881	/* AIFCLK/fs ratio; look for a close match in either direction */
2882	best = 0;
2883	best_val = abs((fs_ratios[0] * params_rate(params))
2884		       - wm8994->aifclk[id]);
2885	for (i = 1; i < ARRAY_SIZE(fs_ratios); i++) {
2886		cur_val = abs((fs_ratios[i] * params_rate(params))
2887			      - wm8994->aifclk[id]);
2888		if (cur_val >= best_val)
2889			continue;
2890		best = i;
2891		best_val = cur_val;
2892	}
2893	dev_dbg(dai->dev, "Selected AIF%dCLK/fs = %d\n",
2894		dai->id, fs_ratios[best]);
2895	rate_val |= best;
2896
2897	/* We may not get quite the right frequency if using
2898	 * approximate clocks so look for the closest match that is
2899	 * higher than the target (we need to ensure that there enough
2900	 * BCLKs to clock out the samples).
2901	 */
2902	best = 0;
2903	for (i = 0; i < ARRAY_SIZE(bclk_divs); i++) {
2904		cur_val = (wm8994->aifclk[id] * 10 / bclk_divs[i]) - bclk_rate;
2905		if (cur_val < 0) /* BCLK table is sorted */
2906			break;
2907		best = i;
2908	}
2909	bclk_rate = wm8994->aifclk[id] * 10 / bclk_divs[best];
2910	dev_dbg(dai->dev, "Using BCLK_DIV %d for actual BCLK %dHz\n",
2911		bclk_divs[best], bclk_rate);
2912	bclk |= best << WM8994_AIF1_BCLK_DIV_SHIFT;
2913
2914	lrclk = bclk_rate / params_rate(params);
2915	if (!lrclk) {
2916		dev_err(dai->dev, "Unable to generate LRCLK from %dHz BCLK\n",
2917			bclk_rate);
2918		return -EINVAL;
2919	}
2920	dev_dbg(dai->dev, "Using LRCLK rate %d for actual LRCLK %dHz\n",
2921		lrclk, bclk_rate / lrclk);
2922
2923	snd_soc_component_update_bits(component, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
2924	snd_soc_component_update_bits(component, aif2_reg, WM8994_AIF1_MONO, aif2);
2925	snd_soc_component_update_bits(component, bclk_reg, WM8994_AIF1_BCLK_DIV_MASK, bclk);
2926	snd_soc_component_update_bits(component, lrclk_reg, WM8994_AIF1DAC_RATE_MASK,
2927			    lrclk);
2928	snd_soc_component_update_bits(component, rate_reg, WM8994_AIF1_SR_MASK |
2929			    WM8994_AIF1CLK_RATE_MASK, rate_val);
2930
2931	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
2932		switch (dai->id) {
2933		case 1:
2934			wm8994->dac_rates[0] = params_rate(params);
2935			wm8994_set_retune_mobile(component, 0);
2936			wm8994_set_retune_mobile(component, 1);
2937			break;
2938		case 2:
2939			wm8994->dac_rates[1] = params_rate(params);
2940			wm8994_set_retune_mobile(component, 2);
2941			break;
2942		}
2943	}
2944
2945	return 0;
2946}
2947
2948static int wm8994_aif3_hw_params(struct snd_pcm_substream *substream,
2949				 struct snd_pcm_hw_params *params,
2950				 struct snd_soc_dai *dai)
2951{
2952	struct snd_soc_component *component = dai->component;
2953	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
2954	struct wm8994 *control = wm8994->wm8994;
2955	int aif1_reg;
2956	int aif1 = 0;
2957
2958	switch (dai->id) {
2959	case 3:
2960		switch (control->type) {
2961		case WM1811:
2962		case WM8958:
2963			aif1_reg = WM8958_AIF3_CONTROL_1;
2964			break;
2965		default:
2966			return 0;
2967		}
2968		break;
2969	default:
2970		return 0;
2971	}
2972
2973	switch (params_width(params)) {
2974	case 16:
2975		break;
2976	case 20:
2977		aif1 |= 0x20;
2978		break;
2979	case 24:
2980		aif1 |= 0x40;
2981		break;
2982	case 32:
2983		aif1 |= 0x60;
2984		break;
2985	default:
2986		return -EINVAL;
2987	}
2988
2989	return snd_soc_component_update_bits(component, aif1_reg, WM8994_AIF1_WL_MASK, aif1);
2990}
2991
2992static int wm8994_aif_mute(struct snd_soc_dai *codec_dai, int mute)
 
2993{
2994	struct snd_soc_component *component = codec_dai->component;
2995	int mute_reg;
2996	int reg;
2997
2998	switch (codec_dai->id) {
2999	case 1:
3000		mute_reg = WM8994_AIF1_DAC1_FILTERS_1;
3001		break;
3002	case 2:
3003		mute_reg = WM8994_AIF2_DAC_FILTERS_1;
3004		break;
3005	default:
3006		return -EINVAL;
3007	}
3008
3009	if (mute)
3010		reg = WM8994_AIF1DAC1_MUTE;
3011	else
3012		reg = 0;
3013
3014	snd_soc_component_update_bits(component, mute_reg, WM8994_AIF1DAC1_MUTE, reg);
3015
3016	return 0;
3017}
3018
3019static int wm8994_set_tristate(struct snd_soc_dai *codec_dai, int tristate)
3020{
3021	struct snd_soc_component *component = codec_dai->component;
3022	int reg, val, mask;
3023
3024	switch (codec_dai->id) {
3025	case 1:
3026		reg = WM8994_AIF1_MASTER_SLAVE;
3027		mask = WM8994_AIF1_TRI;
3028		break;
3029	case 2:
3030		reg = WM8994_AIF2_MASTER_SLAVE;
3031		mask = WM8994_AIF2_TRI;
3032		break;
3033	default:
3034		return -EINVAL;
3035	}
3036
3037	if (tristate)
3038		val = mask;
3039	else
3040		val = 0;
3041
3042	return snd_soc_component_update_bits(component, reg, mask, val);
3043}
3044
3045static int wm8994_aif2_probe(struct snd_soc_dai *dai)
3046{
3047	struct snd_soc_component *component = dai->component;
3048
3049	/* Disable the pulls on the AIF if we're using it to save power. */
3050	snd_soc_component_update_bits(component, WM8994_GPIO_3,
3051			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3052	snd_soc_component_update_bits(component, WM8994_GPIO_4,
3053			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3054	snd_soc_component_update_bits(component, WM8994_GPIO_5,
3055			    WM8994_GPN_PU | WM8994_GPN_PD, 0);
3056
3057	return 0;
3058}
3059
3060#define WM8994_RATES SNDRV_PCM_RATE_8000_96000
3061
3062#define WM8994_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
3063			SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
3064
3065static const struct snd_soc_dai_ops wm8994_aif1_dai_ops = {
3066	.set_sysclk	= wm8994_set_dai_sysclk,
3067	.set_fmt	= wm8994_set_dai_fmt,
3068	.hw_params	= wm8994_hw_params,
3069	.digital_mute	= wm8994_aif_mute,
3070	.set_pll	= wm8994_set_fll,
3071	.set_tristate	= wm8994_set_tristate,
 
3072};
3073
3074static const struct snd_soc_dai_ops wm8994_aif2_dai_ops = {
 
3075	.set_sysclk	= wm8994_set_dai_sysclk,
3076	.set_fmt	= wm8994_set_dai_fmt,
3077	.hw_params	= wm8994_hw_params,
3078	.digital_mute   = wm8994_aif_mute,
3079	.set_pll	= wm8994_set_fll,
3080	.set_tristate	= wm8994_set_tristate,
 
3081};
3082
3083static const struct snd_soc_dai_ops wm8994_aif3_dai_ops = {
3084	.hw_params	= wm8994_aif3_hw_params,
3085};
3086
3087static struct snd_soc_dai_driver wm8994_dai[] = {
3088	{
3089		.name = "wm8994-aif1",
3090		.id = 1,
3091		.playback = {
3092			.stream_name = "AIF1 Playback",
3093			.channels_min = 1,
3094			.channels_max = 2,
3095			.rates = WM8994_RATES,
3096			.formats = WM8994_FORMATS,
3097			.sig_bits = 24,
3098		},
3099		.capture = {
3100			.stream_name = "AIF1 Capture",
3101			.channels_min = 1,
3102			.channels_max = 2,
3103			.rates = WM8994_RATES,
3104			.formats = WM8994_FORMATS,
3105			.sig_bits = 24,
3106		 },
3107		.ops = &wm8994_aif1_dai_ops,
3108	},
3109	{
3110		.name = "wm8994-aif2",
3111		.id = 2,
3112		.playback = {
3113			.stream_name = "AIF2 Playback",
3114			.channels_min = 1,
3115			.channels_max = 2,
3116			.rates = WM8994_RATES,
3117			.formats = WM8994_FORMATS,
3118			.sig_bits = 24,
3119		},
3120		.capture = {
3121			.stream_name = "AIF2 Capture",
3122			.channels_min = 1,
3123			.channels_max = 2,
3124			.rates = WM8994_RATES,
3125			.formats = WM8994_FORMATS,
3126			.sig_bits = 24,
3127		},
3128		.probe = wm8994_aif2_probe,
3129		.ops = &wm8994_aif2_dai_ops,
3130	},
3131	{
3132		.name = "wm8994-aif3",
3133		.id = 3,
3134		.playback = {
3135			.stream_name = "AIF3 Playback",
3136			.channels_min = 1,
3137			.channels_max = 2,
3138			.rates = WM8994_RATES,
3139			.formats = WM8994_FORMATS,
3140			.sig_bits = 24,
3141		},
3142		.capture = {
3143			.stream_name = "AIF3 Capture",
3144			.channels_min = 1,
3145			.channels_max = 2,
3146			.rates = WM8994_RATES,
3147			.formats = WM8994_FORMATS,
3148			.sig_bits = 24,
3149		 },
3150		.ops = &wm8994_aif3_dai_ops,
3151	}
3152};
3153
3154#ifdef CONFIG_PM
3155static int wm8994_component_suspend(struct snd_soc_component *component)
3156{
3157	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3158	int i, ret;
3159
3160	for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
3161		memcpy(&wm8994->fll_suspend[i], &wm8994->fll[i],
3162		       sizeof(struct wm8994_fll_config));
3163		ret = _wm8994_set_fll(component, i + 1, 0, 0, 0);
3164		if (ret < 0)
3165			dev_warn(component->dev, "Failed to stop FLL%d: %d\n",
3166				 i + 1, ret);
3167	}
3168
3169	snd_soc_component_force_bias_level(component, SND_SOC_BIAS_OFF);
3170
3171	return 0;
3172}
3173
3174static int wm8994_component_resume(struct snd_soc_component *component)
3175{
3176	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3177	int i, ret;
3178
3179	for (i = 0; i < ARRAY_SIZE(wm8994->fll); i++) {
3180		if (!wm8994->fll_suspend[i].out)
3181			continue;
3182
3183		ret = _wm8994_set_fll(component, i + 1,
3184				     wm8994->fll_suspend[i].src,
3185				     wm8994->fll_suspend[i].in,
3186				     wm8994->fll_suspend[i].out);
3187		if (ret < 0)
3188			dev_warn(component->dev, "Failed to restore FLL%d: %d\n",
3189				 i + 1, ret);
3190	}
3191
3192	return 0;
3193}
3194#else
3195#define wm8994_component_suspend NULL
3196#define wm8994_component_resume NULL
3197#endif
3198
3199static void wm8994_handle_retune_mobile_pdata(struct wm8994_priv *wm8994)
3200{
3201	struct snd_soc_component *component = wm8994->hubs.component;
3202	struct wm8994 *control = wm8994->wm8994;
3203	struct wm8994_pdata *pdata = &control->pdata;
3204	struct snd_kcontrol_new controls[] = {
3205		SOC_ENUM_EXT("AIF1.1 EQ Mode",
3206			     wm8994->retune_mobile_enum,
3207			     wm8994_get_retune_mobile_enum,
3208			     wm8994_put_retune_mobile_enum),
3209		SOC_ENUM_EXT("AIF1.2 EQ Mode",
3210			     wm8994->retune_mobile_enum,
3211			     wm8994_get_retune_mobile_enum,
3212			     wm8994_put_retune_mobile_enum),
3213		SOC_ENUM_EXT("AIF2 EQ Mode",
3214			     wm8994->retune_mobile_enum,
3215			     wm8994_get_retune_mobile_enum,
3216			     wm8994_put_retune_mobile_enum),
3217	};
3218	int ret, i, j;
3219	const char **t;
3220
3221	/* We need an array of texts for the enum API but the number
3222	 * of texts is likely to be less than the number of
3223	 * configurations due to the sample rate dependency of the
3224	 * configurations. */
3225	wm8994->num_retune_mobile_texts = 0;
3226	wm8994->retune_mobile_texts = NULL;
3227	for (i = 0; i < pdata->num_retune_mobile_cfgs; i++) {
3228		for (j = 0; j < wm8994->num_retune_mobile_texts; j++) {
3229			if (strcmp(pdata->retune_mobile_cfgs[i].name,
3230				   wm8994->retune_mobile_texts[j]) == 0)
3231				break;
3232		}
3233
3234		if (j != wm8994->num_retune_mobile_texts)
3235			continue;
3236
3237		/* Expand the array... */
3238		t = krealloc(wm8994->retune_mobile_texts,
3239			     sizeof(char *) *
3240			     (wm8994->num_retune_mobile_texts + 1),
3241			     GFP_KERNEL);
3242		if (t == NULL)
3243			continue;
3244
3245		/* ...store the new entry... */
3246		t[wm8994->num_retune_mobile_texts] =
3247			pdata->retune_mobile_cfgs[i].name;
3248
3249		/* ...and remember the new version. */
3250		wm8994->num_retune_mobile_texts++;
3251		wm8994->retune_mobile_texts = t;
3252	}
3253
3254	dev_dbg(component->dev, "Allocated %d unique ReTune Mobile names\n",
3255		wm8994->num_retune_mobile_texts);
3256
3257	wm8994->retune_mobile_enum.items = wm8994->num_retune_mobile_texts;
3258	wm8994->retune_mobile_enum.texts = wm8994->retune_mobile_texts;
3259
3260	ret = snd_soc_add_component_controls(wm8994->hubs.component, controls,
3261				   ARRAY_SIZE(controls));
3262	if (ret != 0)
3263		dev_err(wm8994->hubs.component->dev,
3264			"Failed to add ReTune Mobile controls: %d\n", ret);
3265}
3266
3267static void wm8994_handle_pdata(struct wm8994_priv *wm8994)
3268{
3269	struct snd_soc_component *component = wm8994->hubs.component;
3270	struct wm8994 *control = wm8994->wm8994;
3271	struct wm8994_pdata *pdata = &control->pdata;
3272	int ret, i;
3273
3274	if (!pdata)
3275		return;
3276
3277	wm_hubs_handle_analogue_pdata(component, pdata->lineout1_diff,
3278				      pdata->lineout2_diff,
3279				      pdata->lineout1fb,
3280				      pdata->lineout2fb,
3281				      pdata->jd_scthr,
3282				      pdata->jd_thr,
3283				      pdata->micb1_delay,
3284				      pdata->micb2_delay,
3285				      pdata->micbias1_lvl,
3286				      pdata->micbias2_lvl);
3287
3288	dev_dbg(component->dev, "%d DRC configurations\n", pdata->num_drc_cfgs);
3289
3290	if (pdata->num_drc_cfgs) {
3291		struct snd_kcontrol_new controls[] = {
3292			SOC_ENUM_EXT("AIF1DRC1 Mode", wm8994->drc_enum,
3293				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3294			SOC_ENUM_EXT("AIF1DRC2 Mode", wm8994->drc_enum,
3295				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3296			SOC_ENUM_EXT("AIF2DRC Mode", wm8994->drc_enum,
3297				     wm8994_get_drc_enum, wm8994_put_drc_enum),
3298		};
3299
3300		/* We need an array of texts for the enum API */
3301		wm8994->drc_texts = devm_kzalloc(wm8994->hubs.component->dev,
3302			    sizeof(char *) * pdata->num_drc_cfgs, GFP_KERNEL);
3303		if (!wm8994->drc_texts)
3304			return;
3305
3306		for (i = 0; i < pdata->num_drc_cfgs; i++)
3307			wm8994->drc_texts[i] = pdata->drc_cfgs[i].name;
3308
3309		wm8994->drc_enum.items = pdata->num_drc_cfgs;
3310		wm8994->drc_enum.texts = wm8994->drc_texts;
3311
3312		ret = snd_soc_add_component_controls(wm8994->hubs.component, controls,
3313					   ARRAY_SIZE(controls));
3314		for (i = 0; i < WM8994_NUM_DRC; i++)
3315			wm8994_set_drc(component, i);
3316	} else {
3317		ret = snd_soc_add_component_controls(wm8994->hubs.component,
3318						 wm8994_drc_controls,
3319						 ARRAY_SIZE(wm8994_drc_controls));
3320	}
3321
3322	if (ret != 0)
3323		dev_err(wm8994->hubs.component->dev,
3324			"Failed to add DRC mode controls: %d\n", ret);
3325
3326
3327	dev_dbg(component->dev, "%d ReTune Mobile configurations\n",
3328		pdata->num_retune_mobile_cfgs);
3329
3330	if (pdata->num_retune_mobile_cfgs)
3331		wm8994_handle_retune_mobile_pdata(wm8994);
3332	else
3333		snd_soc_add_component_controls(wm8994->hubs.component, wm8994_eq_controls,
3334				     ARRAY_SIZE(wm8994_eq_controls));
3335
3336	for (i = 0; i < ARRAY_SIZE(pdata->micbias); i++) {
3337		if (pdata->micbias[i]) {
3338			snd_soc_component_write(component, WM8958_MICBIAS1 + i,
3339				pdata->micbias[i] & 0xffff);
3340		}
3341	}
3342}
3343
3344/**
3345 * wm8994_mic_detect - Enable microphone detection via the WM8994 IRQ
3346 *
3347 * @component:   WM8994 component
3348 * @jack:    jack to report detection events on
3349 * @micbias: microphone bias to detect on
3350 *
3351 * Enable microphone detection via IRQ on the WM8994.  If GPIOs are
3352 * being used to bring out signals to the processor then only platform
3353 * data configuration is needed for WM8994 and processor GPIOs should
3354 * be configured using snd_soc_jack_add_gpios() instead.
3355 *
3356 * Configuration of detection levels is available via the micbias1_lvl
3357 * and micbias2_lvl platform data members.
3358 */
3359int wm8994_mic_detect(struct snd_soc_component *component, struct snd_soc_jack *jack,
3360		      int micbias)
3361{
3362	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3363	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3364	struct wm8994_micdet *micdet;
3365	struct wm8994 *control = wm8994->wm8994;
3366	int reg, ret;
3367
3368	if (control->type != WM8994) {
3369		dev_warn(component->dev, "Not a WM8994\n");
3370		return -EINVAL;
3371	}
3372
 
 
3373	switch (micbias) {
3374	case 1:
3375		micdet = &wm8994->micdet[0];
3376		if (jack)
3377			ret = snd_soc_dapm_force_enable_pin(dapm, "MICBIAS1");
3378		else
3379			ret = snd_soc_dapm_disable_pin(dapm, "MICBIAS1");
3380		break;
3381	case 2:
3382		micdet = &wm8994->micdet[1];
3383		if (jack)
3384			ret = snd_soc_dapm_force_enable_pin(dapm, "MICBIAS1");
3385		else
3386			ret = snd_soc_dapm_disable_pin(dapm, "MICBIAS1");
3387		break;
3388	default:
3389		dev_warn(component->dev, "Invalid MICBIAS %d\n", micbias);
3390		return -EINVAL;
3391	}
3392
3393	if (ret != 0)
3394		dev_warn(component->dev, "Failed to configure MICBIAS%d: %d\n",
3395			 micbias, ret);
3396
3397	dev_dbg(component->dev, "Configuring microphone detection on %d %p\n",
3398		micbias, jack);
3399
3400	/* Store the configuration */
3401	micdet->jack = jack;
3402	micdet->detecting = true;
3403
3404	/* If either of the jacks is set up then enable detection */
3405	if (wm8994->micdet[0].jack || wm8994->micdet[1].jack)
3406		reg = WM8994_MICD_ENA;
3407	else
3408		reg = 0;
3409
3410	snd_soc_component_update_bits(component, WM8994_MICBIAS, WM8994_MICD_ENA, reg);
3411
3412	/* enable MICDET and MICSHRT deboune */
3413	snd_soc_component_update_bits(component, WM8994_IRQ_DEBOUNCE,
3414			    WM8994_MIC1_DET_DB_MASK | WM8994_MIC1_SHRT_DB_MASK |
3415			    WM8994_MIC2_DET_DB_MASK | WM8994_MIC2_SHRT_DB_MASK,
3416			    WM8994_MIC1_DET_DB | WM8994_MIC1_SHRT_DB);
3417
3418	snd_soc_dapm_sync(dapm);
3419
 
 
3420	return 0;
3421}
3422EXPORT_SYMBOL_GPL(wm8994_mic_detect);
3423
3424static void wm8994_mic_work(struct work_struct *work)
3425{
3426	struct wm8994_priv *priv = container_of(work,
3427						struct wm8994_priv,
3428						mic_work.work);
3429	struct regmap *regmap = priv->wm8994->regmap;
3430	struct device *dev = priv->wm8994->dev;
3431	unsigned int reg;
3432	int ret;
3433	int report;
3434
3435	pm_runtime_get_sync(dev);
3436
3437	ret = regmap_read(regmap, WM8994_INTERRUPT_RAW_STATUS_2, &reg);
3438	if (ret < 0) {
3439		dev_err(dev, "Failed to read microphone status: %d\n",
3440			ret);
3441		pm_runtime_put(dev);
3442		return;
3443	}
3444
3445	dev_dbg(dev, "Microphone status: %x\n", reg);
3446
3447	report = 0;
3448	if (reg & WM8994_MIC1_DET_STS) {
3449		if (priv->micdet[0].detecting)
3450			report = SND_JACK_HEADSET;
3451	}
3452	if (reg & WM8994_MIC1_SHRT_STS) {
3453		if (priv->micdet[0].detecting)
3454			report = SND_JACK_HEADPHONE;
3455		else
3456			report |= SND_JACK_BTN_0;
3457	}
3458	if (report)
3459		priv->micdet[0].detecting = false;
3460	else
3461		priv->micdet[0].detecting = true;
3462
3463	snd_soc_jack_report(priv->micdet[0].jack, report,
3464			    SND_JACK_HEADSET | SND_JACK_BTN_0);
3465
3466	report = 0;
3467	if (reg & WM8994_MIC2_DET_STS) {
3468		if (priv->micdet[1].detecting)
3469			report = SND_JACK_HEADSET;
3470	}
3471	if (reg & WM8994_MIC2_SHRT_STS) {
3472		if (priv->micdet[1].detecting)
3473			report = SND_JACK_HEADPHONE;
3474		else
3475			report |= SND_JACK_BTN_0;
3476	}
3477	if (report)
3478		priv->micdet[1].detecting = false;
3479	else
3480		priv->micdet[1].detecting = true;
3481
3482	snd_soc_jack_report(priv->micdet[1].jack, report,
3483			    SND_JACK_HEADSET | SND_JACK_BTN_0);
3484
3485	pm_runtime_put(dev);
3486}
3487
3488static irqreturn_t wm8994_mic_irq(int irq, void *data)
3489{
3490	struct wm8994_priv *priv = data;
3491	struct snd_soc_component *component = priv->hubs.component;
3492
3493#ifndef CONFIG_SND_SOC_WM8994_MODULE
3494	trace_snd_soc_jack_irq(dev_name(component->dev));
3495#endif
3496
3497	pm_wakeup_event(component->dev, 300);
3498
3499	queue_delayed_work(system_power_efficient_wq,
3500			   &priv->mic_work, msecs_to_jiffies(250));
3501
3502	return IRQ_HANDLED;
3503}
3504
3505/* Should be called with accdet_lock held */
3506static void wm1811_micd_stop(struct snd_soc_component *component)
3507{
3508	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3509	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3510
3511	if (!wm8994->jackdet)
3512		return;
3513
3514	snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1, WM8958_MICD_ENA, 0);
3515
3516	wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_JACK);
3517
3518	if (wm8994->wm8994->pdata.jd_ext_cap)
3519		snd_soc_dapm_disable_pin(dapm, "MICBIAS2");
3520}
3521
3522static void wm8958_button_det(struct snd_soc_component *component, u16 status)
3523{
3524	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3525	int report;
3526
3527	report = 0;
3528	if (status & 0x4)
3529		report |= SND_JACK_BTN_0;
3530
3531	if (status & 0x8)
3532		report |= SND_JACK_BTN_1;
3533
3534	if (status & 0x10)
3535		report |= SND_JACK_BTN_2;
3536
3537	if (status & 0x20)
3538		report |= SND_JACK_BTN_3;
3539
3540	if (status & 0x40)
3541		report |= SND_JACK_BTN_4;
3542
3543	if (status & 0x80)
3544		report |= SND_JACK_BTN_5;
3545
3546	snd_soc_jack_report(wm8994->micdet[0].jack, report,
3547			    wm8994->btn_mask);
3548}
3549
3550static void wm8958_open_circuit_work(struct work_struct *work)
3551{
3552	struct wm8994_priv *wm8994 = container_of(work,
3553						  struct wm8994_priv,
3554						  open_circuit_work.work);
3555	struct device *dev = wm8994->wm8994->dev;
3556
3557	mutex_lock(&wm8994->accdet_lock);
3558
3559	wm1811_micd_stop(wm8994->hubs.component);
3560
3561	dev_dbg(dev, "Reporting open circuit\n");
3562
3563	wm8994->jack_mic = false;
3564	wm8994->mic_detecting = true;
3565
3566	wm8958_micd_set_rate(wm8994->hubs.component);
3567
3568	snd_soc_jack_report(wm8994->micdet[0].jack, 0,
3569			    wm8994->btn_mask |
3570			    SND_JACK_HEADSET);
3571
3572	mutex_unlock(&wm8994->accdet_lock);
3573}
3574
3575static void wm8958_mic_id(void *data, u16 status)
3576{
3577	struct snd_soc_component *component = data;
3578	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3579
3580	/* Either nothing present or just starting detection */
3581	if (!(status & WM8958_MICD_STS)) {
3582		/* If nothing present then clear our statuses */
3583		dev_dbg(component->dev, "Detected open circuit\n");
3584
3585		queue_delayed_work(system_power_efficient_wq,
3586				   &wm8994->open_circuit_work,
3587				   msecs_to_jiffies(2500));
3588		return;
3589	}
3590
3591	/* If the measurement is showing a high impedence we've got a
3592	 * microphone.
3593	 */
3594	if (status & 0x600) {
3595		dev_dbg(component->dev, "Detected microphone\n");
3596
3597		wm8994->mic_detecting = false;
3598		wm8994->jack_mic = true;
3599
3600		wm8958_micd_set_rate(component);
3601
3602		snd_soc_jack_report(wm8994->micdet[0].jack, SND_JACK_HEADSET,
3603				    SND_JACK_HEADSET);
3604	}
3605
3606
3607	if (status & 0xfc) {
3608		dev_dbg(component->dev, "Detected headphone\n");
3609		wm8994->mic_detecting = false;
3610
3611		wm8958_micd_set_rate(component);
3612
3613		/* If we have jackdet that will detect removal */
3614		wm1811_micd_stop(component);
3615
3616		snd_soc_jack_report(wm8994->micdet[0].jack, SND_JACK_HEADPHONE,
3617				    SND_JACK_HEADSET);
3618	}
3619}
3620
3621/* Deferred mic detection to allow for extra settling time */
3622static void wm1811_mic_work(struct work_struct *work)
3623{
3624	struct wm8994_priv *wm8994 = container_of(work, struct wm8994_priv,
3625						  mic_work.work);
3626	struct wm8994 *control = wm8994->wm8994;
3627	struct snd_soc_component *component = wm8994->hubs.component;
3628	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3629
3630	pm_runtime_get_sync(component->dev);
3631
3632	/* If required for an external cap force MICBIAS on */
3633	if (control->pdata.jd_ext_cap) {
3634		snd_soc_dapm_force_enable_pin(dapm, "MICBIAS2");
3635		snd_soc_dapm_sync(dapm);
3636	}
3637
3638	mutex_lock(&wm8994->accdet_lock);
3639
3640	dev_dbg(component->dev, "Starting mic detection\n");
3641
3642	/* Use a user-supplied callback if we have one */
3643	if (wm8994->micd_cb) {
3644		wm8994->micd_cb(wm8994->micd_cb_data);
3645	} else {
3646		/*
3647		 * Start off measument of microphone impedence to find out
3648		 * what's actually there.
3649		 */
3650		wm8994->mic_detecting = true;
3651		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_MIC);
3652
3653		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3654				    WM8958_MICD_ENA, WM8958_MICD_ENA);
3655	}
3656
3657	mutex_unlock(&wm8994->accdet_lock);
3658
3659	pm_runtime_put(component->dev);
3660}
3661
3662static irqreturn_t wm1811_jackdet_irq(int irq, void *data)
3663{
3664	struct wm8994_priv *wm8994 = data;
3665	struct wm8994 *control = wm8994->wm8994;
3666	struct snd_soc_component *component = wm8994->hubs.component;
3667	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3668	int reg, delay;
3669	bool present;
3670
3671	pm_runtime_get_sync(component->dev);
3672
3673	cancel_delayed_work_sync(&wm8994->mic_complete_work);
3674
3675	mutex_lock(&wm8994->accdet_lock);
3676
3677	reg = snd_soc_component_read32(component, WM1811_JACKDET_CTRL);
3678	if (reg < 0) {
3679		dev_err(component->dev, "Failed to read jack status: %d\n", reg);
3680		mutex_unlock(&wm8994->accdet_lock);
3681		pm_runtime_put(component->dev);
3682		return IRQ_NONE;
3683	}
3684
3685	dev_dbg(component->dev, "JACKDET %x\n", reg);
3686
3687	present = reg & WM1811_JACKDET_LVL;
3688
3689	if (present) {
3690		dev_dbg(component->dev, "Jack detected\n");
3691
3692		wm8958_micd_set_rate(component);
3693
3694		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3695				    WM8958_MICB2_DISCH, 0);
3696
3697		/* Disable debounce while inserted */
3698		snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3699				    WM1811_JACKDET_DB, 0);
3700
3701		delay = control->pdata.micdet_delay;
3702		queue_delayed_work(system_power_efficient_wq,
3703				   &wm8994->mic_work,
3704				   msecs_to_jiffies(delay));
3705	} else {
3706		dev_dbg(component->dev, "Jack not detected\n");
3707
 
 
 
 
3708		cancel_delayed_work_sync(&wm8994->mic_work);
 
3709
3710		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3711				    WM8958_MICB2_DISCH, WM8958_MICB2_DISCH);
3712
3713		/* Enable debounce while removed */
3714		snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3715				    WM1811_JACKDET_DB, WM1811_JACKDET_DB);
3716
3717		wm8994->mic_detecting = false;
3718		wm8994->jack_mic = false;
3719		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3720				    WM8958_MICD_ENA, 0);
3721		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_JACK);
3722	}
3723
3724	mutex_unlock(&wm8994->accdet_lock);
3725
3726	/* Turn off MICBIAS if it was on for an external cap */
3727	if (control->pdata.jd_ext_cap && !present)
3728		snd_soc_dapm_disable_pin(dapm, "MICBIAS2");
3729
3730	if (present)
3731		snd_soc_jack_report(wm8994->micdet[0].jack,
3732				    SND_JACK_MECHANICAL, SND_JACK_MECHANICAL);
3733	else
3734		snd_soc_jack_report(wm8994->micdet[0].jack, 0,
3735				    SND_JACK_MECHANICAL | SND_JACK_HEADSET |
3736				    wm8994->btn_mask);
3737
3738	/* Since we only report deltas force an update, ensures we
3739	 * avoid bootstrapping issues with the core. */
3740	snd_soc_jack_report(wm8994->micdet[0].jack, 0, 0);
3741
3742	pm_runtime_put(component->dev);
3743	return IRQ_HANDLED;
3744}
3745
3746static void wm1811_jackdet_bootstrap(struct work_struct *work)
3747{
3748	struct wm8994_priv *wm8994 = container_of(work,
3749						struct wm8994_priv,
3750						jackdet_bootstrap.work);
3751	wm1811_jackdet_irq(0, wm8994);
3752}
3753
3754/**
3755 * wm8958_mic_detect - Enable microphone detection via the WM8958 IRQ
3756 *
3757 * @component:   WM8958 component
3758 * @jack:    jack to report detection events on
 
 
 
 
3759 *
3760 * Enable microphone detection functionality for the WM8958.  By
3761 * default simple detection which supports the detection of up to 6
3762 * buttons plus video and microphone functionality is supported.
3763 *
3764 * The WM8958 has an advanced jack detection facility which is able to
3765 * support complex accessory detection, especially when used in
3766 * conjunction with external circuitry.  In order to provide maximum
3767 * flexiblity a callback is provided which allows a completely custom
3768 * detection algorithm.
3769 */
3770int wm8958_mic_detect(struct snd_soc_component *component, struct snd_soc_jack *jack,
3771		      wm1811_micdet_cb det_cb, void *det_cb_data,
3772		      wm1811_mic_id_cb id_cb, void *id_cb_data)
3773{
3774	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3775	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3776	struct wm8994 *control = wm8994->wm8994;
3777	u16 micd_lvl_sel;
3778
3779	switch (control->type) {
3780	case WM1811:
3781	case WM8958:
3782		break;
3783	default:
3784		return -EINVAL;
3785	}
3786
 
 
3787	if (jack) {
3788		snd_soc_dapm_force_enable_pin(dapm, "CLK_SYS");
3789		snd_soc_dapm_sync(dapm);
3790
3791		wm8994->micdet[0].jack = jack;
3792
3793		if (det_cb) {
3794			wm8994->micd_cb = det_cb;
3795			wm8994->micd_cb_data = det_cb_data;
3796		} else {
3797			wm8994->mic_detecting = true;
3798			wm8994->jack_mic = false;
3799		}
3800
3801		if (id_cb) {
3802			wm8994->mic_id_cb = id_cb;
3803			wm8994->mic_id_cb_data = id_cb_data;
3804		} else {
3805			wm8994->mic_id_cb = wm8958_mic_id;
3806			wm8994->mic_id_cb_data = component;
3807		}
3808
3809		wm8958_micd_set_rate(component);
3810
3811		/* Detect microphones and short circuits by default */
3812		if (control->pdata.micd_lvl_sel)
3813			micd_lvl_sel = control->pdata.micd_lvl_sel;
3814		else
3815			micd_lvl_sel = 0x41;
3816
3817		wm8994->btn_mask = SND_JACK_BTN_0 | SND_JACK_BTN_1 |
3818			SND_JACK_BTN_2 | SND_JACK_BTN_3 |
3819			SND_JACK_BTN_4 | SND_JACK_BTN_5;
3820
3821		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_2,
3822				    WM8958_MICD_LVL_SEL_MASK, micd_lvl_sel);
3823
3824		WARN_ON(snd_soc_component_get_bias_level(component) > SND_SOC_BIAS_STANDBY);
3825
3826		/*
3827		 * If we can use jack detection start off with that,
3828		 * otherwise jump straight to microphone detection.
3829		 */
3830		if (wm8994->jackdet) {
3831			/* Disable debounce for the initial detect */
3832			snd_soc_component_update_bits(component, WM1811_JACKDET_CTRL,
3833					    WM1811_JACKDET_DB, 0);
3834
3835			snd_soc_component_update_bits(component, WM8958_MICBIAS2,
3836					    WM8958_MICB2_DISCH,
3837					    WM8958_MICB2_DISCH);
3838			snd_soc_component_update_bits(component, WM8994_LDO_1,
3839					    WM8994_LDO1_DISCH, 0);
3840			wm1811_jackdet_set_mode(component,
3841						WM1811_JACKDET_MODE_JACK);
3842		} else {
3843			snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3844					    WM8958_MICD_ENA, WM8958_MICD_ENA);
3845		}
3846
3847	} else {
3848		snd_soc_component_update_bits(component, WM8958_MIC_DETECT_1,
3849				    WM8958_MICD_ENA, 0);
3850		wm1811_jackdet_set_mode(component, WM1811_JACKDET_MODE_NONE);
3851		snd_soc_dapm_disable_pin(dapm, "CLK_SYS");
3852		snd_soc_dapm_sync(dapm);
3853	}
3854
 
 
3855	return 0;
3856}
3857EXPORT_SYMBOL_GPL(wm8958_mic_detect);
3858
3859static void wm8958_mic_work(struct work_struct *work)
3860{
3861	struct wm8994_priv *wm8994 = container_of(work,
3862						  struct wm8994_priv,
3863						  mic_complete_work.work);
3864	struct snd_soc_component *component = wm8994->hubs.component;
3865
3866	pm_runtime_get_sync(component->dev);
3867
3868	mutex_lock(&wm8994->accdet_lock);
3869
3870	wm8994->mic_id_cb(wm8994->mic_id_cb_data, wm8994->mic_status);
3871
3872	mutex_unlock(&wm8994->accdet_lock);
3873
3874	pm_runtime_put(component->dev);
3875}
3876
3877static irqreturn_t wm8958_mic_irq(int irq, void *data)
3878{
3879	struct wm8994_priv *wm8994 = data;
3880	struct snd_soc_component *component = wm8994->hubs.component;
3881	int reg, count, ret, id_delay;
3882
3883	/*
3884	 * Jack detection may have detected a removal simulataneously
3885	 * with an update of the MICDET status; if so it will have
3886	 * stopped detection and we can ignore this interrupt.
3887	 */
3888	if (!(snd_soc_component_read32(component, WM8958_MIC_DETECT_1) & WM8958_MICD_ENA))
3889		return IRQ_HANDLED;
3890
3891	cancel_delayed_work_sync(&wm8994->mic_complete_work);
3892	cancel_delayed_work_sync(&wm8994->open_circuit_work);
3893
3894	pm_runtime_get_sync(component->dev);
3895
3896	/* We may occasionally read a detection without an impedence
3897	 * range being provided - if that happens loop again.
3898	 */
3899	count = 10;
3900	do {
3901		reg = snd_soc_component_read32(component, WM8958_MIC_DETECT_3);
3902		if (reg < 0) {
3903			dev_err(component->dev,
3904				"Failed to read mic detect status: %d\n",
3905				reg);
3906			pm_runtime_put(component->dev);
3907			return IRQ_NONE;
3908		}
3909
3910		if (!(reg & WM8958_MICD_VALID)) {
3911			dev_dbg(component->dev, "Mic detect data not valid\n");
3912			goto out;
3913		}
3914
3915		if (!(reg & WM8958_MICD_STS) || (reg & WM8958_MICD_LVL_MASK))
3916			break;
3917
3918		msleep(1);
3919	} while (count--);
3920
3921	if (count == 0)
3922		dev_warn(component->dev, "No impedance range reported for jack\n");
3923
3924#ifndef CONFIG_SND_SOC_WM8994_MODULE
3925	trace_snd_soc_jack_irq(dev_name(component->dev));
3926#endif
3927
3928	/* Avoid a transient report when the accessory is being removed */
3929	if (wm8994->jackdet) {
3930		ret = snd_soc_component_read32(component, WM1811_JACKDET_CTRL);
3931		if (ret < 0) {
3932			dev_err(component->dev, "Failed to read jack status: %d\n",
3933				ret);
3934		} else if (!(ret & WM1811_JACKDET_LVL)) {
3935			dev_dbg(component->dev, "Ignoring removed jack\n");
3936			goto out;
3937		}
3938	} else if (!(reg & WM8958_MICD_STS)) {
3939		snd_soc_jack_report(wm8994->micdet[0].jack, 0,
3940				    SND_JACK_MECHANICAL | SND_JACK_HEADSET |
3941				    wm8994->btn_mask);
3942		wm8994->mic_detecting = true;
3943		goto out;
3944	}
3945
3946	wm8994->mic_status = reg;
3947	id_delay = wm8994->wm8994->pdata.mic_id_delay;
3948
3949	if (wm8994->mic_detecting)
3950		queue_delayed_work(system_power_efficient_wq,
3951				   &wm8994->mic_complete_work,
3952				   msecs_to_jiffies(id_delay));
3953	else
3954		wm8958_button_det(component, reg);
3955
3956out:
3957	pm_runtime_put(component->dev);
3958	return IRQ_HANDLED;
3959}
3960
3961static irqreturn_t wm8994_fifo_error(int irq, void *data)
3962{
3963	struct snd_soc_component *component = data;
3964
3965	dev_err(component->dev, "FIFO error\n");
3966
3967	return IRQ_HANDLED;
3968}
3969
3970static irqreturn_t wm8994_temp_warn(int irq, void *data)
3971{
3972	struct snd_soc_component *component = data;
3973
3974	dev_err(component->dev, "Thermal warning\n");
3975
3976	return IRQ_HANDLED;
3977}
3978
3979static irqreturn_t wm8994_temp_shut(int irq, void *data)
3980{
3981	struct snd_soc_component *component = data;
3982
3983	dev_crit(component->dev, "Thermal shutdown\n");
3984
3985	return IRQ_HANDLED;
3986}
3987
3988static int wm8994_component_probe(struct snd_soc_component *component)
3989{
3990	struct snd_soc_dapm_context *dapm = snd_soc_component_get_dapm(component);
3991	struct wm8994 *control = dev_get_drvdata(component->dev->parent);
3992	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
3993	unsigned int reg;
3994	int ret, i;
3995
3996	snd_soc_component_init_regmap(component, control->regmap);
3997
3998	wm8994->hubs.component = component;
3999
4000	mutex_init(&wm8994->accdet_lock);
4001	INIT_DELAYED_WORK(&wm8994->jackdet_bootstrap,
4002			  wm1811_jackdet_bootstrap);
4003	INIT_DELAYED_WORK(&wm8994->open_circuit_work,
4004			  wm8958_open_circuit_work);
4005
4006	switch (control->type) {
4007	case WM8994:
4008		INIT_DELAYED_WORK(&wm8994->mic_work, wm8994_mic_work);
4009		break;
4010	case WM1811:
4011		INIT_DELAYED_WORK(&wm8994->mic_work, wm1811_mic_work);
4012		break;
4013	default:
4014		break;
4015	}
4016
4017	INIT_DELAYED_WORK(&wm8994->mic_complete_work, wm8958_mic_work);
4018
4019	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4020		init_completion(&wm8994->fll_locked[i]);
4021
4022	wm8994->micdet_irq = control->pdata.micdet_irq;
4023
4024	/* By default use idle_bias_off, will override for WM8994 */
4025	dapm->idle_bias_off = 1;
4026
4027	/* Set revision-specific configuration */
4028	switch (control->type) {
4029	case WM8994:
4030		/* Single ended line outputs should have VMID on. */
4031		if (!control->pdata.lineout1_diff ||
4032		    !control->pdata.lineout2_diff)
4033			dapm->idle_bias_off = 0;
4034
4035		switch (control->revision) {
4036		case 2:
4037		case 3:
4038			wm8994->hubs.dcs_codes_l = -5;
4039			wm8994->hubs.dcs_codes_r = -5;
4040			wm8994->hubs.hp_startup_mode = 1;
4041			wm8994->hubs.dcs_readback_mode = 1;
4042			wm8994->hubs.series_startup = 1;
4043			break;
4044		default:
4045			wm8994->hubs.dcs_readback_mode = 2;
4046			break;
4047		}
 
4048		break;
4049
4050	case WM8958:
4051		wm8994->hubs.dcs_readback_mode = 1;
4052		wm8994->hubs.hp_startup_mode = 1;
 
4053
4054		switch (control->revision) {
4055		case 0:
4056			break;
4057		default:
4058			wm8994->fll_byp = true;
4059			break;
4060		}
4061		break;
4062
4063	case WM1811:
4064		wm8994->hubs.dcs_readback_mode = 2;
4065		wm8994->hubs.no_series_update = 1;
4066		wm8994->hubs.hp_startup_mode = 1;
4067		wm8994->hubs.no_cache_dac_hp_direct = true;
4068		wm8994->fll_byp = true;
4069
4070		wm8994->hubs.dcs_codes_l = -9;
4071		wm8994->hubs.dcs_codes_r = -7;
4072
4073		snd_soc_component_update_bits(component, WM8994_ANALOGUE_HP_1,
4074				    WM1811_HPOUT1_ATTN, WM1811_HPOUT1_ATTN);
4075		break;
4076
4077	default:
4078		break;
4079	}
4080
4081	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR,
4082			   wm8994_fifo_error, "FIFO error", component);
4083	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN,
4084			   wm8994_temp_warn, "Thermal warning", component);
4085	wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT,
4086			   wm8994_temp_shut, "Thermal shutdown", component);
4087
4088	switch (control->type) {
4089	case WM8994:
4090		if (wm8994->micdet_irq)
4091			ret = request_threaded_irq(wm8994->micdet_irq, NULL,
4092						   wm8994_mic_irq,
4093						   IRQF_TRIGGER_RISING |
4094						   IRQF_ONESHOT,
4095						   "Mic1 detect",
4096						   wm8994);
4097		 else
4098			ret = wm8994_request_irq(wm8994->wm8994,
4099					WM8994_IRQ_MIC1_DET,
4100					wm8994_mic_irq, "Mic 1 detect",
4101					wm8994);
4102
4103		if (ret != 0)
4104			dev_warn(component->dev,
4105				 "Failed to request Mic1 detect IRQ: %d\n",
4106				 ret);
4107
4108
4109		ret = wm8994_request_irq(wm8994->wm8994,
4110					 WM8994_IRQ_MIC1_SHRT,
4111					 wm8994_mic_irq, "Mic 1 short",
4112					 wm8994);
4113		if (ret != 0)
4114			dev_warn(component->dev,
4115				 "Failed to request Mic1 short IRQ: %d\n",
4116				 ret);
4117
4118		ret = wm8994_request_irq(wm8994->wm8994,
4119					 WM8994_IRQ_MIC2_DET,
4120					 wm8994_mic_irq, "Mic 2 detect",
4121					 wm8994);
4122		if (ret != 0)
4123			dev_warn(component->dev,
4124				 "Failed to request Mic2 detect IRQ: %d\n",
4125				 ret);
4126
4127		ret = wm8994_request_irq(wm8994->wm8994,
4128					 WM8994_IRQ_MIC2_SHRT,
4129					 wm8994_mic_irq, "Mic 2 short",
4130					 wm8994);
4131		if (ret != 0)
4132			dev_warn(component->dev,
4133				 "Failed to request Mic2 short IRQ: %d\n",
4134				 ret);
4135		break;
4136
4137	case WM8958:
4138	case WM1811:
4139		if (wm8994->micdet_irq) {
4140			ret = request_threaded_irq(wm8994->micdet_irq, NULL,
4141						   wm8958_mic_irq,
4142						   IRQF_TRIGGER_RISING |
4143						   IRQF_ONESHOT,
4144						   "Mic detect",
4145						   wm8994);
4146			if (ret != 0)
4147				dev_warn(component->dev,
4148					 "Failed to request Mic detect IRQ: %d\n",
4149					 ret);
4150		} else {
4151			wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_MIC1_DET,
4152					   wm8958_mic_irq, "Mic detect",
4153					   wm8994);
4154		}
4155	}
4156
4157	switch (control->type) {
4158	case WM1811:
4159		if (control->cust_id > 1 || control->revision > 1) {
4160			ret = wm8994_request_irq(wm8994->wm8994,
4161						 WM8994_IRQ_GPIO(6),
4162						 wm1811_jackdet_irq, "JACKDET",
4163						 wm8994);
4164			if (ret == 0)
4165				wm8994->jackdet = true;
4166		}
4167		break;
4168	default:
4169		break;
4170	}
4171
4172	wm8994->fll_locked_irq = true;
4173	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++) {
4174		ret = wm8994_request_irq(wm8994->wm8994,
4175					 WM8994_IRQ_FLL1_LOCK + i,
4176					 wm8994_fll_locked_irq, "FLL lock",
4177					 &wm8994->fll_locked[i]);
4178		if (ret != 0)
4179			wm8994->fll_locked_irq = false;
4180	}
4181
4182	/* Make sure we can read from the GPIOs if they're inputs */
4183	pm_runtime_get_sync(component->dev);
4184
4185	/* Remember if AIFnLRCLK is configured as a GPIO.  This should be
4186	 * configured on init - if a system wants to do this dynamically
4187	 * at runtime we can deal with that then.
4188	 */
4189	ret = regmap_read(control->regmap, WM8994_GPIO_1, &reg);
4190	if (ret < 0) {
4191		dev_err(component->dev, "Failed to read GPIO1 state: %d\n", ret);
4192		goto err_irq;
4193	}
4194	if ((reg & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
4195		wm8994->lrclk_shared[0] = 1;
4196		wm8994_dai[0].symmetric_rates = 1;
4197	} else {
4198		wm8994->lrclk_shared[0] = 0;
4199	}
4200
4201	ret = regmap_read(control->regmap, WM8994_GPIO_6, &reg);
4202	if (ret < 0) {
4203		dev_err(component->dev, "Failed to read GPIO6 state: %d\n", ret);
4204		goto err_irq;
4205	}
4206	if ((reg & WM8994_GPN_FN_MASK) != WM8994_GP_FN_PIN_SPECIFIC) {
4207		wm8994->lrclk_shared[1] = 1;
4208		wm8994_dai[1].symmetric_rates = 1;
4209	} else {
4210		wm8994->lrclk_shared[1] = 0;
4211	}
4212
4213	pm_runtime_put(component->dev);
4214
4215	/* Latch volume update bits */
4216	for (i = 0; i < ARRAY_SIZE(wm8994_vu_bits); i++)
4217		snd_soc_component_update_bits(component, wm8994_vu_bits[i].reg,
4218				    wm8994_vu_bits[i].mask,
4219				    wm8994_vu_bits[i].mask);
4220
 
 
 
 
 
 
 
 
4221	/* Set the low bit of the 3D stereo depth so TLV matches */
4222	snd_soc_component_update_bits(component, WM8994_AIF1_DAC1_FILTERS_2,
4223			    1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT,
4224			    1 << WM8994_AIF1DAC1_3D_GAIN_SHIFT);
4225	snd_soc_component_update_bits(component, WM8994_AIF1_DAC2_FILTERS_2,
4226			    1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT,
4227			    1 << WM8994_AIF1DAC2_3D_GAIN_SHIFT);
4228	snd_soc_component_update_bits(component, WM8994_AIF2_DAC_FILTERS_2,
4229			    1 << WM8994_AIF2DAC_3D_GAIN_SHIFT,
4230			    1 << WM8994_AIF2DAC_3D_GAIN_SHIFT);
4231
4232	/* Unconditionally enable AIF1 ADC TDM mode on chips which can
4233	 * use this; it only affects behaviour on idle TDM clock
4234	 * cycles. */
4235	switch (control->type) {
4236	case WM8994:
4237	case WM8958:
4238		snd_soc_component_update_bits(component, WM8994_AIF1_CONTROL_1,
4239				    WM8994_AIF1ADC_TDM, WM8994_AIF1ADC_TDM);
4240		break;
4241	default:
4242		break;
4243	}
4244
4245	/* Put MICBIAS into bypass mode by default on newer devices */
4246	switch (control->type) {
4247	case WM8958:
4248	case WM1811:
4249		snd_soc_component_update_bits(component, WM8958_MICBIAS1,
4250				    WM8958_MICB1_MODE, WM8958_MICB1_MODE);
4251		snd_soc_component_update_bits(component, WM8958_MICBIAS2,
4252				    WM8958_MICB2_MODE, WM8958_MICB2_MODE);
4253		break;
4254	default:
4255		break;
4256	}
4257
4258	wm8994->hubs.check_class_w_digital = wm8994_check_class_w_digital;
4259	wm_hubs_update_class_w(component);
4260
4261	wm8994_handle_pdata(wm8994);
4262
4263	wm_hubs_add_analogue_controls(component);
4264	snd_soc_add_component_controls(component, wm8994_snd_controls,
4265			     ARRAY_SIZE(wm8994_snd_controls));
4266	snd_soc_dapm_new_controls(dapm, wm8994_dapm_widgets,
4267				  ARRAY_SIZE(wm8994_dapm_widgets));
4268
4269	switch (control->type) {
4270	case WM8994:
 
 
4271		snd_soc_dapm_new_controls(dapm, wm8994_specific_dapm_widgets,
4272					  ARRAY_SIZE(wm8994_specific_dapm_widgets));
4273		if (control->revision < 4) {
4274			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets,
4275						  ARRAY_SIZE(wm8994_lateclk_revd_widgets));
4276			snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets,
4277						  ARRAY_SIZE(wm8994_adc_revd_widgets));
4278			snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets,
4279						  ARRAY_SIZE(wm8994_dac_revd_widgets));
4280		} else {
4281			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4282						  ARRAY_SIZE(wm8994_lateclk_widgets));
4283			snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4284						  ARRAY_SIZE(wm8994_adc_widgets));
4285			snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4286						  ARRAY_SIZE(wm8994_dac_widgets));
4287		}
4288		break;
4289	case WM8958:
 
 
4290		snd_soc_add_component_controls(component, wm8958_snd_controls,
4291				     ARRAY_SIZE(wm8958_snd_controls));
4292		snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets,
4293					  ARRAY_SIZE(wm8958_dapm_widgets));
4294		if (control->revision < 1) {
4295			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_revd_widgets,
4296						  ARRAY_SIZE(wm8994_lateclk_revd_widgets));
4297			snd_soc_dapm_new_controls(dapm, wm8994_adc_revd_widgets,
4298						  ARRAY_SIZE(wm8994_adc_revd_widgets));
4299			snd_soc_dapm_new_controls(dapm, wm8994_dac_revd_widgets,
4300						  ARRAY_SIZE(wm8994_dac_revd_widgets));
4301		} else {
4302			snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4303						  ARRAY_SIZE(wm8994_lateclk_widgets));
4304			snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4305						  ARRAY_SIZE(wm8994_adc_widgets));
4306			snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4307						  ARRAY_SIZE(wm8994_dac_widgets));
4308		}
4309		break;
4310
4311	case WM1811:
4312		snd_soc_add_component_controls(component, wm8958_snd_controls,
4313				     ARRAY_SIZE(wm8958_snd_controls));
4314		snd_soc_dapm_new_controls(dapm, wm8958_dapm_widgets,
4315					  ARRAY_SIZE(wm8958_dapm_widgets));
4316		snd_soc_dapm_new_controls(dapm, wm8994_lateclk_widgets,
4317					  ARRAY_SIZE(wm8994_lateclk_widgets));
4318		snd_soc_dapm_new_controls(dapm, wm8994_adc_widgets,
4319					  ARRAY_SIZE(wm8994_adc_widgets));
4320		snd_soc_dapm_new_controls(dapm, wm8994_dac_widgets,
4321					  ARRAY_SIZE(wm8994_dac_widgets));
4322		break;
4323	}
4324
4325	wm_hubs_add_analogue_routes(component, 0, 0);
4326	ret = wm8994_request_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4327				 wm_hubs_dcs_done, "DC servo done",
4328				 &wm8994->hubs);
4329	if (ret == 0)
4330		wm8994->hubs.dcs_done_irq = true;
4331	snd_soc_dapm_add_routes(dapm, intercon, ARRAY_SIZE(intercon));
4332
4333	switch (control->type) {
4334	case WM8994:
4335		snd_soc_dapm_add_routes(dapm, wm8994_intercon,
4336					ARRAY_SIZE(wm8994_intercon));
4337
4338		if (control->revision < 4) {
4339			snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon,
4340						ARRAY_SIZE(wm8994_revd_intercon));
4341			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon,
4342						ARRAY_SIZE(wm8994_lateclk_revd_intercon));
4343		} else {
4344			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4345						ARRAY_SIZE(wm8994_lateclk_intercon));
4346		}
4347		break;
4348	case WM8958:
4349		if (control->revision < 1) {
4350			snd_soc_dapm_add_routes(dapm, wm8994_intercon,
4351						ARRAY_SIZE(wm8994_intercon));
4352			snd_soc_dapm_add_routes(dapm, wm8994_revd_intercon,
4353						ARRAY_SIZE(wm8994_revd_intercon));
4354			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_revd_intercon,
4355						ARRAY_SIZE(wm8994_lateclk_revd_intercon));
4356		} else {
4357			snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4358						ARRAY_SIZE(wm8994_lateclk_intercon));
4359			snd_soc_dapm_add_routes(dapm, wm8958_intercon,
4360						ARRAY_SIZE(wm8958_intercon));
4361		}
4362
4363		wm8958_dsp2_init(component);
4364		break;
4365	case WM1811:
4366		snd_soc_dapm_add_routes(dapm, wm8994_lateclk_intercon,
4367					ARRAY_SIZE(wm8994_lateclk_intercon));
4368		snd_soc_dapm_add_routes(dapm, wm8958_intercon,
4369					ARRAY_SIZE(wm8958_intercon));
4370		break;
4371	}
4372
4373	return 0;
4374
4375err_irq:
4376	if (wm8994->jackdet)
4377		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_GPIO(6), wm8994);
4378	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_SHRT, wm8994);
4379	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_DET, wm8994);
4380	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_SHRT, wm8994);
4381	if (wm8994->micdet_irq)
4382		free_irq(wm8994->micdet_irq, wm8994);
4383	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4384		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FLL1_LOCK + i,
4385				&wm8994->fll_locked[i]);
4386	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4387			&wm8994->hubs);
4388	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR, component);
4389	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT, component);
4390	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN, component);
4391
4392	return ret;
4393}
4394
4395static void wm8994_component_remove(struct snd_soc_component *component)
4396{
4397	struct wm8994_priv *wm8994 = snd_soc_component_get_drvdata(component);
4398	struct wm8994 *control = wm8994->wm8994;
4399	int i;
4400
4401	for (i = 0; i < ARRAY_SIZE(wm8994->fll_locked); i++)
4402		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FLL1_LOCK + i,
4403				&wm8994->fll_locked[i]);
4404
4405	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_DCS_DONE,
4406			&wm8994->hubs);
4407	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_FIFOS_ERR, component);
4408	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_SHUT, component);
4409	wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_TEMP_WARN, component);
4410
4411	if (wm8994->jackdet)
4412		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_GPIO(6), wm8994);
4413
4414	switch (control->type) {
4415	case WM8994:
4416		if (wm8994->micdet_irq)
4417			free_irq(wm8994->micdet_irq, wm8994);
4418		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC2_DET,
4419				wm8994);
4420		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_SHRT,
4421				wm8994);
4422		wm8994_free_irq(wm8994->wm8994, WM8994_IRQ_MIC1_DET,
4423				wm8994);
4424		break;
4425
4426	case WM1811:
4427	case WM8958:
4428		if (wm8994->micdet_irq)
4429			free_irq(wm8994->micdet_irq, wm8994);
4430		break;
4431	}
4432	release_firmware(wm8994->mbc);
4433	release_firmware(wm8994->mbc_vss);
4434	release_firmware(wm8994->enh_eq);
4435	kfree(wm8994->retune_mobile_texts);
4436}
4437
4438static const struct snd_soc_component_driver soc_component_dev_wm8994 = {
4439	.probe			= wm8994_component_probe,
4440	.remove			= wm8994_component_remove,
4441	.suspend		= wm8994_component_suspend,
4442	.resume			= wm8994_component_resume,
4443	.set_bias_level		= wm8994_set_bias_level,
4444	.idle_bias_on		= 1,
4445	.use_pmdown_time	= 1,
4446	.endianness		= 1,
4447	.non_legacy_dai_naming	= 1,
4448};
4449
4450static int wm8994_probe(struct platform_device *pdev)
4451{
4452	struct wm8994_priv *wm8994;
 
4453
4454	wm8994 = devm_kzalloc(&pdev->dev, sizeof(struct wm8994_priv),
4455			      GFP_KERNEL);
4456	if (wm8994 == NULL)
4457		return -ENOMEM;
4458	platform_set_drvdata(pdev, wm8994);
4459
4460	mutex_init(&wm8994->fw_lock);
4461
4462	wm8994->wm8994 = dev_get_drvdata(pdev->dev.parent);
4463
 
 
 
 
 
 
 
 
 
 
4464	pm_runtime_enable(&pdev->dev);
4465	pm_runtime_idle(&pdev->dev);
4466
4467	return devm_snd_soc_register_component(&pdev->dev, &soc_component_dev_wm8994,
4468			wm8994_dai, ARRAY_SIZE(wm8994_dai));
 
 
 
 
4469}
4470
4471static int wm8994_remove(struct platform_device *pdev)
4472{
4473	pm_runtime_disable(&pdev->dev);
4474
4475	return 0;
4476}
4477
4478#ifdef CONFIG_PM_SLEEP
4479static int wm8994_suspend(struct device *dev)
4480{
4481	struct wm8994_priv *wm8994 = dev_get_drvdata(dev);
4482
4483	/* Drop down to power saving mode when system is suspended */
4484	if (wm8994->jackdet && !wm8994->active_refcount)
4485		regmap_update_bits(wm8994->wm8994->regmap, WM8994_ANTIPOP_2,
4486				   WM1811_JACKDET_MODE_MASK,
4487				   wm8994->jackdet_mode);
4488
4489	return 0;
4490}
4491
4492static int wm8994_resume(struct device *dev)
4493{
4494	struct wm8994_priv *wm8994 = dev_get_drvdata(dev);
4495
4496	if (wm8994->jackdet && wm8994->jackdet_mode)
4497		regmap_update_bits(wm8994->wm8994->regmap, WM8994_ANTIPOP_2,
4498				   WM1811_JACKDET_MODE_MASK,
4499				   WM1811_JACKDET_MODE_AUDIO);
4500
4501	return 0;
4502}
4503#endif
4504
4505static const struct dev_pm_ops wm8994_pm_ops = {
4506	SET_SYSTEM_SLEEP_PM_OPS(wm8994_suspend, wm8994_resume)
4507};
4508
4509static struct platform_driver wm8994_codec_driver = {
4510	.driver = {
4511		.name = "wm8994-codec",
4512		.pm = &wm8994_pm_ops,
4513	},
4514	.probe = wm8994_probe,
4515	.remove = wm8994_remove,
4516};
4517
4518module_platform_driver(wm8994_codec_driver);
4519
4520MODULE_DESCRIPTION("ASoC WM8994 driver");
4521MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
4522MODULE_LICENSE("GPL");
4523MODULE_ALIAS("platform:wm8994-codec");