Linux Audio

Check our new training course

Loading...
v6.13.7
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * ALSA SoC TWL4030 codec driver
   4 *
   5 * Author:      Steve Sakoman, <steve@sakoman.com>
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
   6 */
   7
   8#include <linux/module.h>
   9#include <linux/moduleparam.h>
  10#include <linux/init.h>
  11#include <linux/delay.h>
  12#include <linux/pm.h>
  13#include <linux/i2c.h>
  14#include <linux/platform_device.h>
  15#include <linux/of.h>
  16#include <linux/of_gpio.h>
  17#include <linux/mfd/twl.h>
  18#include <linux/slab.h>
  19#include <linux/gpio.h>
  20#include <sound/core.h>
  21#include <sound/pcm.h>
  22#include <sound/pcm_params.h>
  23#include <sound/soc.h>
  24#include <sound/initval.h>
  25#include <sound/tlv.h>
  26
  27/* Register descriptions are here */
  28#include <linux/mfd/twl4030-audio.h>
  29
  30/* TWL4030 PMBR1 Register */
  31#define TWL4030_PMBR1_REG		0x0D
  32/* TWL4030 PMBR1 Register GPIO6 mux bits */
  33#define TWL4030_GPIO6_PWM0_MUTE(value)	((value & 0x03) << 2)
  34
  35#define TWL4030_CACHEREGNUM	(TWL4030_REG_MISC_SET_2 + 1)
  36
  37struct twl4030_board_params {
  38	unsigned int digimic_delay; /* in ms */
  39	unsigned int ramp_delay_value;
  40	unsigned int offset_cncl_path;
  41	unsigned int hs_extmute:1;
  42	int hs_extmute_gpio;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  43};
  44
  45/* codec private data */
  46struct twl4030_priv {
 
 
  47	unsigned int codec_powered;
  48
  49	/* reference counts of AIF/APLL users */
  50	unsigned int apll_enabled;
  51
  52	struct snd_pcm_substream *master_substream;
  53	struct snd_pcm_substream *slave_substream;
  54
  55	unsigned int configured;
  56	unsigned int rate;
  57	unsigned int sample_bits;
  58	unsigned int channels;
  59
  60	unsigned int sysclk;
  61
  62	/* Output (with associated amp) states */
  63	u8 hsl_enabled, hsr_enabled;
  64	u8 earpiece_enabled;
  65	u8 predrivel_enabled, predriver_enabled;
  66	u8 carkitl_enabled, carkitr_enabled;
  67	u8 ctl_cache[TWL4030_REG_PRECKR_CTL - TWL4030_REG_EAR_CTL + 1];
  68
  69	struct twl4030_board_params *board_params;
 
  70};
  71
  72static void tw4030_init_ctl_cache(struct twl4030_priv *twl4030)
  73{
  74	int i;
  75	u8 byte;
  76
  77	for (i = TWL4030_REG_EAR_CTL; i <= TWL4030_REG_PRECKR_CTL; i++) {
  78		twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte, i);
  79		twl4030->ctl_cache[i - TWL4030_REG_EAR_CTL] = byte;
  80	}
  81}
  82
  83static unsigned int twl4030_read(struct snd_soc_component *component, unsigned int reg)
  84{
  85	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
  86	u8 value = 0;
  87
  88	if (reg >= TWL4030_CACHEREGNUM)
  89		return -EIO;
  90
  91	switch (reg) {
  92	case TWL4030_REG_EAR_CTL:
  93	case TWL4030_REG_PREDL_CTL:
  94	case TWL4030_REG_PREDR_CTL:
  95	case TWL4030_REG_PRECKL_CTL:
  96	case TWL4030_REG_PRECKR_CTL:
  97	case TWL4030_REG_HS_GAIN_SET:
  98		value = twl4030->ctl_cache[reg - TWL4030_REG_EAR_CTL];
  99		break;
 100	default:
 101		twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &value, reg);
 102		break;
 103	}
 104
 105	return value;
 106}
 107
 108static bool twl4030_can_write_to_chip(struct twl4030_priv *twl4030,
 109				      unsigned int reg)
 
 
 
 110{
 111	bool write_to_reg = false;
 112
 113	/* Decide if the given register can be written */
 114	switch (reg) {
 115	case TWL4030_REG_EAR_CTL:
 116		if (twl4030->earpiece_enabled)
 117			write_to_reg = true;
 118		break;
 119	case TWL4030_REG_PREDL_CTL:
 120		if (twl4030->predrivel_enabled)
 121			write_to_reg = true;
 122		break;
 123	case TWL4030_REG_PREDR_CTL:
 124		if (twl4030->predriver_enabled)
 125			write_to_reg = true;
 126		break;
 127	case TWL4030_REG_PRECKL_CTL:
 128		if (twl4030->carkitl_enabled)
 129			write_to_reg = true;
 130		break;
 131	case TWL4030_REG_PRECKR_CTL:
 132		if (twl4030->carkitr_enabled)
 133			write_to_reg = true;
 134		break;
 135	case TWL4030_REG_HS_GAIN_SET:
 136		if (twl4030->hsl_enabled || twl4030->hsr_enabled)
 137			write_to_reg = true;
 138		break;
 139	default:
 140		/* All other register can be written */
 141		write_to_reg = true;
 142		break;
 143	}
 144
 145	return write_to_reg;
 146}
 147
 148static int twl4030_write(struct snd_soc_component *component, unsigned int reg,
 149			 unsigned int value)
 
 
 
 150{
 151	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
 152
 153	/* Update the ctl cache */
 154	switch (reg) {
 155	case TWL4030_REG_EAR_CTL:
 156	case TWL4030_REG_PREDL_CTL:
 157	case TWL4030_REG_PREDR_CTL:
 158	case TWL4030_REG_PRECKL_CTL:
 159	case TWL4030_REG_PRECKR_CTL:
 160	case TWL4030_REG_HS_GAIN_SET:
 161		twl4030->ctl_cache[reg - TWL4030_REG_EAR_CTL] = value;
 162		break;
 163	default:
 164		break;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 165	}
 166
 167	if (twl4030_can_write_to_chip(twl4030, reg))
 168		return twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, value, reg);
 169
 170	return 0;
 171}
 172
 173static inline void twl4030_wait_ms(int time)
 174{
 175	if (time < 60) {
 176		time *= 1000;
 177		usleep_range(time, time + 500);
 178	} else {
 179		msleep(time);
 180	}
 181}
 182
 183static void twl4030_codec_enable(struct snd_soc_component *component, int enable)
 184{
 185	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 186	int mode;
 187
 188	if (enable == twl4030->codec_powered)
 189		return;
 190
 191	if (enable)
 192		mode = twl4030_audio_enable_resource(TWL4030_AUDIO_RES_POWER);
 193	else
 194		mode = twl4030_audio_disable_resource(TWL4030_AUDIO_RES_POWER);
 195
 196	if (mode >= 0)
 
 197		twl4030->codec_powered = enable;
 
 198
 199	/* REVISIT: this delay is present in TI sample drivers */
 200	/* but there seems to be no TRM requirement for it     */
 201	udelay(10);
 202}
 203
 204static void
 205twl4030_get_board_param_values(struct twl4030_board_params *board_params,
 206			       struct device_node *node)
 207{
 208	int value;
 209
 210	of_property_read_u32(node, "ti,digimic_delay", &board_params->digimic_delay);
 211	of_property_read_u32(node, "ti,ramp_delay_value", &board_params->ramp_delay_value);
 212	of_property_read_u32(node, "ti,offset_cncl_path", &board_params->offset_cncl_path);
 213	if (!of_property_read_u32(node, "ti,hs_extmute", &value))
 214		board_params->hs_extmute = value;
 215
 216	board_params->hs_extmute_gpio = of_get_named_gpio(node, "ti,hs_extmute_gpio", 0);
 217	if (gpio_is_valid(board_params->hs_extmute_gpio))
 218		board_params->hs_extmute = 1;
 219}
 220
 221static struct twl4030_board_params*
 222twl4030_get_board_params(struct snd_soc_component *component)
 223{
 224	struct twl4030_board_params *board_params = NULL;
 225	struct device_node *twl4030_codec_node = NULL;
 226
 227	twl4030_codec_node = of_get_child_by_name(component->dev->parent->of_node,
 228						  "codec");
 229
 230	if (twl4030_codec_node) {
 231		board_params = devm_kzalloc(component->dev,
 232					    sizeof(struct twl4030_board_params),
 233					    GFP_KERNEL);
 234		if (!board_params) {
 235			of_node_put(twl4030_codec_node);
 236			return NULL;
 237		}
 238		twl4030_get_board_param_values(board_params, twl4030_codec_node);
 239		of_node_put(twl4030_codec_node);
 240	}
 241
 242	return board_params;
 243}
 244
 245static void twl4030_init_chip(struct snd_soc_component *component)
 246{
 247	struct twl4030_board_params *board_params;
 248	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 249	u8 reg, byte;
 250	int i = 0;
 251
 252	board_params = twl4030_get_board_params(component);
 
 
 
 253
 254	if (board_params && board_params->hs_extmute) {
 255		if (gpio_is_valid(board_params->hs_extmute_gpio)) {
 256			int ret;
 257
 258			if (!board_params->hs_extmute_gpio)
 259				dev_warn(component->dev,
 260					"Extmute GPIO is 0 is this correct?\n");
 261
 262			ret = gpio_request_one(board_params->hs_extmute_gpio,
 263					       GPIOF_OUT_INIT_LOW,
 264					       "hs_extmute");
 265			if (ret) {
 266				dev_err(component->dev,
 267					"Failed to get hs_extmute GPIO\n");
 268				board_params->hs_extmute_gpio = -1;
 269			}
 270		} else {
 271			u8 pin_mux;
 272
 273			/* Set TWL4030 GPIO6 as EXTMUTE signal */
 274			twl_i2c_read_u8(TWL4030_MODULE_INTBR, &pin_mux,
 275					TWL4030_PMBR1_REG);
 276			pin_mux &= ~TWL4030_GPIO6_PWM0_MUTE(0x03);
 277			pin_mux |= TWL4030_GPIO6_PWM0_MUTE(0x02);
 278			twl_i2c_write_u8(TWL4030_MODULE_INTBR, pin_mux,
 279					 TWL4030_PMBR1_REG);
 280		}
 281	}
 282
 283	/* Initialize the local ctl register cache */
 284	tw4030_init_ctl_cache(twl4030);
 
 
 
 
 
 
 
 
 
 
 285
 286	/* anti-pop when changing analog gain */
 287	reg = twl4030_read(component, TWL4030_REG_MISC_SET_1);
 288	twl4030_write(component, TWL4030_REG_MISC_SET_1,
 289		      reg | TWL4030_SMOOTH_ANAVOL_EN);
 290
 291	twl4030_write(component, TWL4030_REG_OPTION,
 292		      TWL4030_ATXL1_EN | TWL4030_ATXR1_EN |
 293		      TWL4030_ARXL2_EN | TWL4030_ARXR2_EN);
 294
 295	/* REG_ARXR2_APGA_CTL reset according to the TRM: 0dB, DA_EN */
 296	twl4030_write(component, TWL4030_REG_ARXR2_APGA_CTL, 0x32);
 297
 298	/* Machine dependent setup */
 299	if (!board_params)
 300		return;
 301
 302	twl4030->board_params = board_params;
 303
 304	reg = twl4030_read(component, TWL4030_REG_HS_POPN_SET);
 305	reg &= ~TWL4030_RAMP_DELAY;
 306	reg |= (board_params->ramp_delay_value << 2);
 307	twl4030_write(component, TWL4030_REG_HS_POPN_SET, reg);
 308
 309	/* initiate offset cancellation */
 310	twl4030_codec_enable(component, 1);
 311
 312	reg = twl4030_read(component, TWL4030_REG_ANAMICL);
 313	reg &= ~TWL4030_OFFSET_CNCL_SEL;
 314	reg |= board_params->offset_cncl_path;
 315	twl4030_write(component, TWL4030_REG_ANAMICL,
 316		      reg | TWL4030_CNCL_OFFSET_START);
 317
 318	/*
 319	 * Wait for offset cancellation to complete.
 320	 * Since this takes a while, do not slam the i2c.
 321	 * Start polling the status after ~20ms.
 322	 */
 323	msleep(20);
 324	do {
 325		usleep_range(1000, 2000);
 326		twl_set_regcache_bypass(TWL4030_MODULE_AUDIO_VOICE, true);
 327		twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
 328				TWL4030_REG_ANAMICL);
 329		twl_set_regcache_bypass(TWL4030_MODULE_AUDIO_VOICE, false);
 330	} while ((i++ < 100) &&
 331		 ((byte & TWL4030_CNCL_OFFSET_START) ==
 332		  TWL4030_CNCL_OFFSET_START));
 333
 334	twl4030_codec_enable(component, 0);
 
 
 
 335}
 336
 337static void twl4030_apll_enable(struct snd_soc_component *component, int enable)
 338{
 339	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
 340
 341	if (enable) {
 342		twl4030->apll_enabled++;
 343		if (twl4030->apll_enabled == 1)
 344			twl4030_audio_enable_resource(
 345							TWL4030_AUDIO_RES_APLL);
 346	} else {
 347		twl4030->apll_enabled--;
 348		if (!twl4030->apll_enabled)
 349			twl4030_audio_disable_resource(
 350							TWL4030_AUDIO_RES_APLL);
 351	}
 
 
 
 352}
 353
 354/* Earpiece */
 355static const struct snd_kcontrol_new twl4030_dapm_earpiece_controls[] = {
 356	SOC_DAPM_SINGLE("Voice", TWL4030_REG_EAR_CTL, 0, 1, 0),
 357	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_EAR_CTL, 1, 1, 0),
 358	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_EAR_CTL, 2, 1, 0),
 359	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_EAR_CTL, 3, 1, 0),
 360};
 361
 362/* PreDrive Left */
 363static const struct snd_kcontrol_new twl4030_dapm_predrivel_controls[] = {
 364	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDL_CTL, 0, 1, 0),
 365	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PREDL_CTL, 1, 1, 0),
 366	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDL_CTL, 2, 1, 0),
 367	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDL_CTL, 3, 1, 0),
 368};
 369
 370/* PreDrive Right */
 371static const struct snd_kcontrol_new twl4030_dapm_predriver_controls[] = {
 372	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDR_CTL, 0, 1, 0),
 373	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PREDR_CTL, 1, 1, 0),
 374	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDR_CTL, 2, 1, 0),
 375	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDR_CTL, 3, 1, 0),
 376};
 377
 378/* Headset Left */
 379static const struct snd_kcontrol_new twl4030_dapm_hsol_controls[] = {
 380	SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 0, 1, 0),
 381	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_HS_SEL, 1, 1, 0),
 382	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_HS_SEL, 2, 1, 0),
 383};
 384
 385/* Headset Right */
 386static const struct snd_kcontrol_new twl4030_dapm_hsor_controls[] = {
 387	SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 3, 1, 0),
 388	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_HS_SEL, 4, 1, 0),
 389	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_HS_SEL, 5, 1, 0),
 390};
 391
 392/* Carkit Left */
 393static const struct snd_kcontrol_new twl4030_dapm_carkitl_controls[] = {
 394	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKL_CTL, 0, 1, 0),
 395	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PRECKL_CTL, 1, 1, 0),
 396	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PRECKL_CTL, 2, 1, 0),
 397};
 398
 399/* Carkit Right */
 400static const struct snd_kcontrol_new twl4030_dapm_carkitr_controls[] = {
 401	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKR_CTL, 0, 1, 0),
 402	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PRECKR_CTL, 1, 1, 0),
 403	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PRECKR_CTL, 2, 1, 0),
 404};
 405
 406/* Handsfree Left */
 407static const char *twl4030_handsfreel_texts[] =
 408		{"Voice", "AudioL1", "AudioL2", "AudioR2"};
 409
 410static SOC_ENUM_SINGLE_DECL(twl4030_handsfreel_enum,
 411			    TWL4030_REG_HFL_CTL, 0,
 412			    twl4030_handsfreel_texts);
 
 413
 414static const struct snd_kcontrol_new twl4030_dapm_handsfreel_control =
 415SOC_DAPM_ENUM("Route", twl4030_handsfreel_enum);
 416
 417/* Handsfree Left virtual mute */
 418static const struct snd_kcontrol_new twl4030_dapm_handsfreelmute_control =
 419	SOC_DAPM_SINGLE_VIRT("Switch", 1);
 420
 421/* Handsfree Right */
 422static const char *twl4030_handsfreer_texts[] =
 423		{"Voice", "AudioR1", "AudioR2", "AudioL2"};
 424
 425static SOC_ENUM_SINGLE_DECL(twl4030_handsfreer_enum,
 426			    TWL4030_REG_HFR_CTL, 0,
 427			    twl4030_handsfreer_texts);
 
 428
 429static const struct snd_kcontrol_new twl4030_dapm_handsfreer_control =
 430SOC_DAPM_ENUM("Route", twl4030_handsfreer_enum);
 431
 432/* Handsfree Right virtual mute */
 433static const struct snd_kcontrol_new twl4030_dapm_handsfreermute_control =
 434	SOC_DAPM_SINGLE_VIRT("Switch", 1);
 435
 436/* Vibra */
 437/* Vibra audio path selection */
 438static const char *twl4030_vibra_texts[] =
 439		{"AudioL1", "AudioR1", "AudioL2", "AudioR2"};
 440
 441static SOC_ENUM_SINGLE_DECL(twl4030_vibra_enum,
 442			    TWL4030_REG_VIBRA_CTL, 2,
 443			    twl4030_vibra_texts);
 
 444
 445static const struct snd_kcontrol_new twl4030_dapm_vibra_control =
 446SOC_DAPM_ENUM("Route", twl4030_vibra_enum);
 447
 448/* Vibra path selection: local vibrator (PWM) or audio driven */
 449static const char *twl4030_vibrapath_texts[] =
 450		{"Local vibrator", "Audio"};
 451
 452static SOC_ENUM_SINGLE_DECL(twl4030_vibrapath_enum,
 453			    TWL4030_REG_VIBRA_CTL, 4,
 454			    twl4030_vibrapath_texts);
 
 455
 456static const struct snd_kcontrol_new twl4030_dapm_vibrapath_control =
 457SOC_DAPM_ENUM("Route", twl4030_vibrapath_enum);
 458
 459/* Left analog microphone selection */
 460static const struct snd_kcontrol_new twl4030_dapm_analoglmic_controls[] = {
 461	SOC_DAPM_SINGLE("Main Mic Capture Switch",
 462			TWL4030_REG_ANAMICL, 0, 1, 0),
 463	SOC_DAPM_SINGLE("Headset Mic Capture Switch",
 464			TWL4030_REG_ANAMICL, 1, 1, 0),
 465	SOC_DAPM_SINGLE("AUXL Capture Switch",
 466			TWL4030_REG_ANAMICL, 2, 1, 0),
 467	SOC_DAPM_SINGLE("Carkit Mic Capture Switch",
 468			TWL4030_REG_ANAMICL, 3, 1, 0),
 469};
 470
 471/* Right analog microphone selection */
 472static const struct snd_kcontrol_new twl4030_dapm_analogrmic_controls[] = {
 473	SOC_DAPM_SINGLE("Sub Mic Capture Switch", TWL4030_REG_ANAMICR, 0, 1, 0),
 474	SOC_DAPM_SINGLE("AUXR Capture Switch", TWL4030_REG_ANAMICR, 2, 1, 0),
 475};
 476
 477/* TX1 L/R Analog/Digital microphone selection */
 478static const char *twl4030_micpathtx1_texts[] =
 479		{"Analog", "Digimic0"};
 480
 481static SOC_ENUM_SINGLE_DECL(twl4030_micpathtx1_enum,
 482			    TWL4030_REG_ADCMICSEL, 0,
 483			    twl4030_micpathtx1_texts);
 
 484
 485static const struct snd_kcontrol_new twl4030_dapm_micpathtx1_control =
 486SOC_DAPM_ENUM("Route", twl4030_micpathtx1_enum);
 487
 488/* TX2 L/R Analog/Digital microphone selection */
 489static const char *twl4030_micpathtx2_texts[] =
 490		{"Analog", "Digimic1"};
 491
 492static SOC_ENUM_SINGLE_DECL(twl4030_micpathtx2_enum,
 493			    TWL4030_REG_ADCMICSEL, 2,
 494			    twl4030_micpathtx2_texts);
 
 495
 496static const struct snd_kcontrol_new twl4030_dapm_micpathtx2_control =
 497SOC_DAPM_ENUM("Route", twl4030_micpathtx2_enum);
 498
 499/* Analog bypass for AudioR1 */
 500static const struct snd_kcontrol_new twl4030_dapm_abypassr1_control =
 501	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR1_APGA_CTL, 2, 1, 0);
 502
 503/* Analog bypass for AudioL1 */
 504static const struct snd_kcontrol_new twl4030_dapm_abypassl1_control =
 505	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL1_APGA_CTL, 2, 1, 0);
 506
 507/* Analog bypass for AudioR2 */
 508static const struct snd_kcontrol_new twl4030_dapm_abypassr2_control =
 509	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR2_APGA_CTL, 2, 1, 0);
 510
 511/* Analog bypass for AudioL2 */
 512static const struct snd_kcontrol_new twl4030_dapm_abypassl2_control =
 513	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL2_APGA_CTL, 2, 1, 0);
 514
 515/* Analog bypass for Voice */
 516static const struct snd_kcontrol_new twl4030_dapm_abypassv_control =
 517	SOC_DAPM_SINGLE("Switch", TWL4030_REG_VDL_APGA_CTL, 2, 1, 0);
 518
 519/* Digital bypass gain, mute instead of -30dB */
 520static const DECLARE_TLV_DB_RANGE(twl4030_dapm_dbypass_tlv,
 
 521	0, 1, TLV_DB_SCALE_ITEM(-3000, 600, 1),
 522	2, 3, TLV_DB_SCALE_ITEM(-2400, 0, 0),
 523	4, 7, TLV_DB_SCALE_ITEM(-1800, 600, 0)
 524);
 525
 526/* Digital bypass left (TX1L -> RX2L) */
 527static const struct snd_kcontrol_new twl4030_dapm_dbypassl_control =
 528	SOC_DAPM_SINGLE_TLV("Volume",
 529			TWL4030_REG_ATX2ARXPGA, 3, 7, 0,
 530			twl4030_dapm_dbypass_tlv);
 531
 532/* Digital bypass right (TX1R -> RX2R) */
 533static const struct snd_kcontrol_new twl4030_dapm_dbypassr_control =
 534	SOC_DAPM_SINGLE_TLV("Volume",
 535			TWL4030_REG_ATX2ARXPGA, 0, 7, 0,
 536			twl4030_dapm_dbypass_tlv);
 537
 538/*
 539 * Voice Sidetone GAIN volume control:
 540 * from -51 to -10 dB in 1 dB steps (mute instead of -51 dB)
 541 */
 542static DECLARE_TLV_DB_SCALE(twl4030_dapm_dbypassv_tlv, -5100, 100, 1);
 543
 544/* Digital bypass voice: sidetone (VUL -> VDL)*/
 545static const struct snd_kcontrol_new twl4030_dapm_dbypassv_control =
 546	SOC_DAPM_SINGLE_TLV("Volume",
 547			TWL4030_REG_VSTPGA, 0, 0x29, 0,
 548			twl4030_dapm_dbypassv_tlv);
 549
 550/*
 551 * Output PGA builder:
 552 * Handle the muting and unmuting of the given output (turning off the
 553 * amplifier associated with the output pin)
 554 * On mute bypass the reg_cache and write 0 to the register
 555 * On unmute: restore the register content from the reg_cache
 556 * Outputs handled in this way:  Earpiece, PreDrivL/R, CarkitL/R
 557 */
 558#define TWL4030_OUTPUT_PGA(pin_name, reg)				\
 559static int pin_name##pga_event(struct snd_soc_dapm_widget *w,		\
 560			       struct snd_kcontrol *kcontrol, int event) \
 561{									\
 562	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);	\
 563	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component); \
 564									\
 565	switch (event) {						\
 566	case SND_SOC_DAPM_POST_PMU:					\
 567		twl4030->pin_name##_enabled = 1;			\
 568		twl4030_write(component, reg, twl4030_read(component, reg));	\
 
 569		break;							\
 570	case SND_SOC_DAPM_POST_PMD:					\
 571		twl4030->pin_name##_enabled = 0;			\
 572		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, 0, reg);	\
 
 573		break;							\
 574	}								\
 575	return 0;							\
 576}
 577
 578TWL4030_OUTPUT_PGA(earpiece, TWL4030_REG_EAR_CTL);
 579TWL4030_OUTPUT_PGA(predrivel, TWL4030_REG_PREDL_CTL);
 580TWL4030_OUTPUT_PGA(predriver, TWL4030_REG_PREDR_CTL);
 581TWL4030_OUTPUT_PGA(carkitl, TWL4030_REG_PRECKL_CTL);
 582TWL4030_OUTPUT_PGA(carkitr, TWL4030_REG_PRECKR_CTL);
 583
 584static void handsfree_ramp(struct snd_soc_component *component, int reg, int ramp)
 585{
 586	unsigned char hs_ctl;
 587
 588	hs_ctl = twl4030_read(component, reg);
 589
 590	if (ramp) {
 591		/* HF ramp-up */
 592		hs_ctl |= TWL4030_HF_CTL_REF_EN;
 593		twl4030_write(component, reg, hs_ctl);
 594		udelay(10);
 595		hs_ctl |= TWL4030_HF_CTL_RAMP_EN;
 596		twl4030_write(component, reg, hs_ctl);
 597		udelay(40);
 598		hs_ctl |= TWL4030_HF_CTL_LOOP_EN;
 599		hs_ctl |= TWL4030_HF_CTL_HB_EN;
 600		twl4030_write(component, reg, hs_ctl);
 601	} else {
 602		/* HF ramp-down */
 603		hs_ctl &= ~TWL4030_HF_CTL_LOOP_EN;
 604		hs_ctl &= ~TWL4030_HF_CTL_HB_EN;
 605		twl4030_write(component, reg, hs_ctl);
 606		hs_ctl &= ~TWL4030_HF_CTL_RAMP_EN;
 607		twl4030_write(component, reg, hs_ctl);
 608		udelay(40);
 609		hs_ctl &= ~TWL4030_HF_CTL_REF_EN;
 610		twl4030_write(component, reg, hs_ctl);
 611	}
 612}
 613
 614static int handsfreelpga_event(struct snd_soc_dapm_widget *w,
 615			       struct snd_kcontrol *kcontrol, int event)
 616{
 617	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 618
 619	switch (event) {
 620	case SND_SOC_DAPM_POST_PMU:
 621		handsfree_ramp(component, TWL4030_REG_HFL_CTL, 1);
 622		break;
 623	case SND_SOC_DAPM_POST_PMD:
 624		handsfree_ramp(component, TWL4030_REG_HFL_CTL, 0);
 625		break;
 626	}
 627	return 0;
 628}
 629
 630static int handsfreerpga_event(struct snd_soc_dapm_widget *w,
 631			       struct snd_kcontrol *kcontrol, int event)
 632{
 633	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 634
 635	switch (event) {
 636	case SND_SOC_DAPM_POST_PMU:
 637		handsfree_ramp(component, TWL4030_REG_HFR_CTL, 1);
 638		break;
 639	case SND_SOC_DAPM_POST_PMD:
 640		handsfree_ramp(component, TWL4030_REG_HFR_CTL, 0);
 641		break;
 642	}
 643	return 0;
 644}
 645
 646static int vibramux_event(struct snd_soc_dapm_widget *w,
 647			  struct snd_kcontrol *kcontrol, int event)
 648{
 649	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 650
 651	twl4030_write(component, TWL4030_REG_VIBRA_SET, 0xff);
 652	return 0;
 653}
 654
 655static int apll_event(struct snd_soc_dapm_widget *w,
 656		      struct snd_kcontrol *kcontrol, int event)
 657{
 658	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 659
 660	switch (event) {
 661	case SND_SOC_DAPM_PRE_PMU:
 662		twl4030_apll_enable(component, 1);
 663		break;
 664	case SND_SOC_DAPM_POST_PMD:
 665		twl4030_apll_enable(component, 0);
 666		break;
 667	}
 668	return 0;
 669}
 670
 671static int aif_event(struct snd_soc_dapm_widget *w,
 672		     struct snd_kcontrol *kcontrol, int event)
 673{
 674	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 675	u8 audio_if;
 676
 677	audio_if = twl4030_read(component, TWL4030_REG_AUDIO_IF);
 678	switch (event) {
 679	case SND_SOC_DAPM_PRE_PMU:
 680		/* Enable AIF */
 681		/* enable the PLL before we use it to clock the DAI */
 682		twl4030_apll_enable(component, 1);
 683
 684		twl4030_write(component, TWL4030_REG_AUDIO_IF,
 685			      audio_if | TWL4030_AIF_EN);
 686		break;
 687	case SND_SOC_DAPM_POST_PMD:
 688		/* disable the DAI before we stop it's source PLL */
 689		twl4030_write(component, TWL4030_REG_AUDIO_IF,
 690			      audio_if &  ~TWL4030_AIF_EN);
 691		twl4030_apll_enable(component, 0);
 692		break;
 693	}
 694	return 0;
 695}
 696
 697static void headset_ramp(struct snd_soc_component *component, int ramp)
 698{
 
 699	unsigned char hs_gain, hs_pop;
 700	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 701	struct twl4030_board_params *board_params = twl4030->board_params;
 702	/* Base values for ramp delay calculation: 2^19 - 2^26 */
 703	static const unsigned int ramp_base[] = {
 704		524288, 1048576, 2097152, 4194304,
 705		8388608, 16777216, 33554432, 67108864
 706	};
 707	unsigned int delay;
 708
 709	hs_gain = twl4030_read(component, TWL4030_REG_HS_GAIN_SET);
 710	hs_pop = twl4030_read(component, TWL4030_REG_HS_POPN_SET);
 711	delay = (ramp_base[(hs_pop & TWL4030_RAMP_DELAY) >> 2] /
 712		twl4030->sysclk) + 1;
 713
 714	/* Enable external mute control, this dramatically reduces
 715	 * the pop-noise */
 716	if (board_params && board_params->hs_extmute) {
 717		if (gpio_is_valid(board_params->hs_extmute_gpio)) {
 718			gpio_set_value(board_params->hs_extmute_gpio, 1);
 719		} else {
 720			hs_pop |= TWL4030_EXTMUTE;
 721			twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 722		}
 723	}
 724
 725	if (ramp) {
 726		/* Headset ramp-up according to the TRM */
 727		hs_pop |= TWL4030_VMID_EN;
 728		twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 729		/* Actually write to the register */
 730		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, hs_gain,
 731				 TWL4030_REG_HS_GAIN_SET);
 
 732		hs_pop |= TWL4030_RAMP_EN;
 733		twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 734		/* Wait ramp delay time + 1, so the VMID can settle */
 735		twl4030_wait_ms(delay);
 736	} else {
 737		/* Headset ramp-down _not_ according to
 738		 * the TRM, but in a way that it is working */
 739		hs_pop &= ~TWL4030_RAMP_EN;
 740		twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 741		/* Wait ramp delay time + 1, so the VMID can settle */
 742		twl4030_wait_ms(delay);
 743		/* Bypass the reg_cache to mute the headset */
 744		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, hs_gain & (~0x0f),
 745				 TWL4030_REG_HS_GAIN_SET);
 
 746
 747		hs_pop &= ~TWL4030_VMID_EN;
 748		twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 749	}
 750
 751	/* Disable external mute */
 752	if (board_params && board_params->hs_extmute) {
 753		if (gpio_is_valid(board_params->hs_extmute_gpio)) {
 754			gpio_set_value(board_params->hs_extmute_gpio, 0);
 755		} else {
 756			hs_pop &= ~TWL4030_EXTMUTE;
 757			twl4030_write(component, TWL4030_REG_HS_POPN_SET, hs_pop);
 758		}
 759	}
 760}
 761
 762static int headsetlpga_event(struct snd_soc_dapm_widget *w,
 763			     struct snd_kcontrol *kcontrol, int event)
 764{
 765	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 766	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 767
 768	switch (event) {
 769	case SND_SOC_DAPM_POST_PMU:
 770		/* Do the ramp-up only once */
 771		if (!twl4030->hsr_enabled)
 772			headset_ramp(component, 1);
 773
 774		twl4030->hsl_enabled = 1;
 775		break;
 776	case SND_SOC_DAPM_POST_PMD:
 777		/* Do the ramp-down only if both headsetL/R is disabled */
 778		if (!twl4030->hsr_enabled)
 779			headset_ramp(component, 0);
 780
 781		twl4030->hsl_enabled = 0;
 782		break;
 783	}
 784	return 0;
 785}
 786
 787static int headsetrpga_event(struct snd_soc_dapm_widget *w,
 788			     struct snd_kcontrol *kcontrol, int event)
 789{
 790	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 791	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 792
 793	switch (event) {
 794	case SND_SOC_DAPM_POST_PMU:
 795		/* Do the ramp-up only once */
 796		if (!twl4030->hsl_enabled)
 797			headset_ramp(component, 1);
 798
 799		twl4030->hsr_enabled = 1;
 800		break;
 801	case SND_SOC_DAPM_POST_PMD:
 802		/* Do the ramp-down only if both headsetL/R is disabled */
 803		if (!twl4030->hsl_enabled)
 804			headset_ramp(component, 0);
 805
 806		twl4030->hsr_enabled = 0;
 807		break;
 808	}
 809	return 0;
 810}
 811
 812static int digimic_event(struct snd_soc_dapm_widget *w,
 813			 struct snd_kcontrol *kcontrol, int event)
 814{
 815	struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm);
 816	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 817	struct twl4030_board_params *board_params = twl4030->board_params;
 818
 819	if (board_params && board_params->digimic_delay)
 820		twl4030_wait_ms(board_params->digimic_delay);
 821	return 0;
 822}
 823
 824/*
 825 * Some of the gain controls in TWL (mostly those which are associated with
 826 * the outputs) are implemented in an interesting way:
 827 * 0x0 : Power down (mute)
 828 * 0x1 : 6dB
 829 * 0x2 : 0 dB
 830 * 0x3 : -6 dB
 831 * Inverting not going to help with these.
 832 * Custom volsw and volsw_2r get/put functions to handle these gain bits.
 833 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 834static int snd_soc_get_volsw_twl4030(struct snd_kcontrol *kcontrol,
 835				     struct snd_ctl_elem_value *ucontrol)
 836{
 837	struct soc_mixer_control *mc =
 838		(struct soc_mixer_control *)kcontrol->private_value;
 839	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 840	unsigned int reg = mc->reg;
 841	unsigned int shift = mc->shift;
 842	unsigned int rshift = mc->rshift;
 843	int max = mc->max;
 844	int mask = (1 << fls(max)) - 1;
 845
 846	ucontrol->value.integer.value[0] =
 847		(twl4030_read(component, reg) >> shift) & mask;
 848	if (ucontrol->value.integer.value[0])
 849		ucontrol->value.integer.value[0] =
 850			max + 1 - ucontrol->value.integer.value[0];
 851
 852	if (shift != rshift) {
 853		ucontrol->value.integer.value[1] =
 854			(twl4030_read(component, reg) >> rshift) & mask;
 855		if (ucontrol->value.integer.value[1])
 856			ucontrol->value.integer.value[1] =
 857				max + 1 - ucontrol->value.integer.value[1];
 858	}
 859
 860	return 0;
 861}
 862
 863static int snd_soc_put_volsw_twl4030(struct snd_kcontrol *kcontrol,
 864				     struct snd_ctl_elem_value *ucontrol)
 865{
 866	struct soc_mixer_control *mc =
 867		(struct soc_mixer_control *)kcontrol->private_value;
 868	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 869	unsigned int reg = mc->reg;
 870	unsigned int shift = mc->shift;
 871	unsigned int rshift = mc->rshift;
 872	int max = mc->max;
 873	int mask = (1 << fls(max)) - 1;
 874	unsigned short val, val2, val_mask;
 875
 876	val = (ucontrol->value.integer.value[0] & mask);
 877
 878	val_mask = mask << shift;
 879	if (val)
 880		val = max + 1 - val;
 881	val = val << shift;
 882	if (shift != rshift) {
 883		val2 = (ucontrol->value.integer.value[1] & mask);
 884		val_mask |= mask << rshift;
 885		if (val2)
 886			val2 = max + 1 - val2;
 887		val |= val2 << rshift;
 888	}
 889	return snd_soc_component_update_bits(component, reg, val_mask, val);
 890}
 891
 892static int snd_soc_get_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
 893					struct snd_ctl_elem_value *ucontrol)
 894{
 895	struct soc_mixer_control *mc =
 896		(struct soc_mixer_control *)kcontrol->private_value;
 897	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 898	unsigned int reg = mc->reg;
 899	unsigned int reg2 = mc->rreg;
 900	unsigned int shift = mc->shift;
 901	int max = mc->max;
 902	int mask = (1<<fls(max))-1;
 903
 904	ucontrol->value.integer.value[0] =
 905		(twl4030_read(component, reg) >> shift) & mask;
 906	ucontrol->value.integer.value[1] =
 907		(twl4030_read(component, reg2) >> shift) & mask;
 908
 909	if (ucontrol->value.integer.value[0])
 910		ucontrol->value.integer.value[0] =
 911			max + 1 - ucontrol->value.integer.value[0];
 912	if (ucontrol->value.integer.value[1])
 913		ucontrol->value.integer.value[1] =
 914			max + 1 - ucontrol->value.integer.value[1];
 915
 916	return 0;
 917}
 918
 919static int snd_soc_put_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
 920					struct snd_ctl_elem_value *ucontrol)
 921{
 922	struct soc_mixer_control *mc =
 923		(struct soc_mixer_control *)kcontrol->private_value;
 924	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 925	unsigned int reg = mc->reg;
 926	unsigned int reg2 = mc->rreg;
 927	unsigned int shift = mc->shift;
 928	int max = mc->max;
 929	int mask = (1 << fls(max)) - 1;
 930	int err;
 931	unsigned short val, val2, val_mask;
 932
 933	val_mask = mask << shift;
 934	val = (ucontrol->value.integer.value[0] & mask);
 935	val2 = (ucontrol->value.integer.value[1] & mask);
 936
 937	if (val)
 938		val = max + 1 - val;
 939	if (val2)
 940		val2 = max + 1 - val2;
 941
 942	val = val << shift;
 943	val2 = val2 << shift;
 944
 945	err = snd_soc_component_update_bits(component, reg, val_mask, val);
 946	if (err < 0)
 947		return err;
 948
 949	err = snd_soc_component_update_bits(component, reg2, val_mask, val2);
 950	return err;
 951}
 952
 953/* Codec operation modes */
 954static const char *twl4030_op_modes_texts[] = {
 955	"Option 2 (voice/audio)", "Option 1 (audio)"
 956};
 957
 958static SOC_ENUM_SINGLE_DECL(twl4030_op_modes_enum,
 959			    TWL4030_REG_CODEC_MODE, 0,
 960			    twl4030_op_modes_texts);
 
 961
 962static int snd_soc_put_twl4030_opmode_enum_double(struct snd_kcontrol *kcontrol,
 963	struct snd_ctl_elem_value *ucontrol)
 964{
 965	struct snd_soc_component *component = snd_soc_kcontrol_component(kcontrol);
 966	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
 
 
 967
 968	if (twl4030->configured) {
 969		dev_err(component->dev,
 970			"operation mode cannot be changed on-the-fly\n");
 971		return -EBUSY;
 972	}
 973
 974	return snd_soc_put_enum_double(kcontrol, ucontrol);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 975}
 976
 977/*
 978 * FGAIN volume control:
 979 * from -62 to 0 dB in 1 dB steps (mute instead of -63 dB)
 980 */
 981static DECLARE_TLV_DB_SCALE(digital_fine_tlv, -6300, 100, 1);
 982
 983/*
 984 * CGAIN volume control:
 985 * 0 dB to 12 dB in 6 dB steps
 986 * value 2 and 3 means 12 dB
 987 */
 988static DECLARE_TLV_DB_SCALE(digital_coarse_tlv, 0, 600, 0);
 989
 990/*
 991 * Voice Downlink GAIN volume control:
 992 * from -37 to 12 dB in 1 dB steps (mute instead of -37 dB)
 993 */
 994static DECLARE_TLV_DB_SCALE(digital_voice_downlink_tlv, -3700, 100, 1);
 995
 996/*
 997 * Analog playback gain
 998 * -24 dB to 12 dB in 2 dB steps
 999 */
1000static DECLARE_TLV_DB_SCALE(analog_tlv, -2400, 200, 0);
1001
1002/*
1003 * Gain controls tied to outputs
1004 * -6 dB to 6 dB in 6 dB steps (mute instead of -12)
1005 */
1006static DECLARE_TLV_DB_SCALE(output_tvl, -1200, 600, 1);
1007
1008/*
1009 * Gain control for earpiece amplifier
1010 * 0 dB to 12 dB in 6 dB steps (mute instead of -6)
1011 */
1012static DECLARE_TLV_DB_SCALE(output_ear_tvl, -600, 600, 1);
1013
1014/*
1015 * Capture gain after the ADCs
1016 * from 0 dB to 31 dB in 1 dB steps
1017 */
1018static DECLARE_TLV_DB_SCALE(digital_capture_tlv, 0, 100, 0);
1019
1020/*
1021 * Gain control for input amplifiers
1022 * 0 dB to 30 dB in 6 dB steps
1023 */
1024static DECLARE_TLV_DB_SCALE(input_gain_tlv, 0, 600, 0);
1025
1026/* AVADC clock priority */
1027static const char *twl4030_avadc_clk_priority_texts[] = {
1028	"Voice high priority", "HiFi high priority"
1029};
1030
1031static SOC_ENUM_SINGLE_DECL(twl4030_avadc_clk_priority_enum,
1032			    TWL4030_REG_AVADC_CTL, 2,
1033			    twl4030_avadc_clk_priority_texts);
 
1034
1035static const char *twl4030_rampdelay_texts[] = {
1036	"27/20/14 ms", "55/40/27 ms", "109/81/55 ms", "218/161/109 ms",
1037	"437/323/218 ms", "874/645/437 ms", "1748/1291/874 ms",
1038	"3495/2581/1748 ms"
1039};
1040
1041static SOC_ENUM_SINGLE_DECL(twl4030_rampdelay_enum,
1042			    TWL4030_REG_HS_POPN_SET, 2,
1043			    twl4030_rampdelay_texts);
 
1044
1045/* Vibra H-bridge direction mode */
1046static const char *twl4030_vibradirmode_texts[] = {
1047	"Vibra H-bridge direction", "Audio data MSB",
1048};
1049
1050static SOC_ENUM_SINGLE_DECL(twl4030_vibradirmode_enum,
1051			    TWL4030_REG_VIBRA_CTL, 5,
1052			    twl4030_vibradirmode_texts);
 
1053
1054/* Vibra H-bridge direction */
1055static const char *twl4030_vibradir_texts[] = {
1056	"Positive polarity", "Negative polarity",
1057};
1058
1059static SOC_ENUM_SINGLE_DECL(twl4030_vibradir_enum,
1060			    TWL4030_REG_VIBRA_CTL, 1,
1061			    twl4030_vibradir_texts);
 
1062
1063/* Digimic Left and right swapping */
1064static const char *twl4030_digimicswap_texts[] = {
1065	"Not swapped", "Swapped",
1066};
1067
1068static SOC_ENUM_SINGLE_DECL(twl4030_digimicswap_enum,
1069			    TWL4030_REG_MISC_SET_1, 0,
1070			    twl4030_digimicswap_texts);
 
1071
1072static const struct snd_kcontrol_new twl4030_snd_controls[] = {
1073	/* Codec operation mode control */
1074	SOC_ENUM_EXT("Codec Operation Mode", twl4030_op_modes_enum,
1075		snd_soc_get_enum_double,
1076		snd_soc_put_twl4030_opmode_enum_double),
1077
1078	/* Common playback gain controls */
1079	SOC_DOUBLE_R_TLV("DAC1 Digital Fine Playback Volume",
1080		TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1081		0, 0x3f, 0, digital_fine_tlv),
1082	SOC_DOUBLE_R_TLV("DAC2 Digital Fine Playback Volume",
1083		TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1084		0, 0x3f, 0, digital_fine_tlv),
1085
1086	SOC_DOUBLE_R_TLV("DAC1 Digital Coarse Playback Volume",
1087		TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1088		6, 0x2, 0, digital_coarse_tlv),
1089	SOC_DOUBLE_R_TLV("DAC2 Digital Coarse Playback Volume",
1090		TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1091		6, 0x2, 0, digital_coarse_tlv),
1092
1093	SOC_DOUBLE_R_TLV("DAC1 Analog Playback Volume",
1094		TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1095		3, 0x12, 1, analog_tlv),
1096	SOC_DOUBLE_R_TLV("DAC2 Analog Playback Volume",
1097		TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1098		3, 0x12, 1, analog_tlv),
1099	SOC_DOUBLE_R("DAC1 Analog Playback Switch",
1100		TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1101		1, 1, 0),
1102	SOC_DOUBLE_R("DAC2 Analog Playback Switch",
1103		TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1104		1, 1, 0),
1105
1106	/* Common voice downlink gain controls */
1107	SOC_SINGLE_TLV("DAC Voice Digital Downlink Volume",
1108		TWL4030_REG_VRXPGA, 0, 0x31, 0, digital_voice_downlink_tlv),
1109
1110	SOC_SINGLE_TLV("DAC Voice Analog Downlink Volume",
1111		TWL4030_REG_VDL_APGA_CTL, 3, 0x12, 1, analog_tlv),
1112
1113	SOC_SINGLE("DAC Voice Analog Downlink Switch",
1114		TWL4030_REG_VDL_APGA_CTL, 1, 1, 0),
1115
1116	/* Separate output gain controls */
1117	SOC_DOUBLE_R_EXT_TLV("PreDriv Playback Volume",
1118		TWL4030_REG_PREDL_CTL, TWL4030_REG_PREDR_CTL,
1119		4, 3, 0, snd_soc_get_volsw_r2_twl4030,
1120		snd_soc_put_volsw_r2_twl4030, output_tvl),
1121
1122	SOC_DOUBLE_EXT_TLV("Headset Playback Volume",
1123		TWL4030_REG_HS_GAIN_SET, 0, 2, 3, 0, snd_soc_get_volsw_twl4030,
1124		snd_soc_put_volsw_twl4030, output_tvl),
1125
1126	SOC_DOUBLE_R_EXT_TLV("Carkit Playback Volume",
1127		TWL4030_REG_PRECKL_CTL, TWL4030_REG_PRECKR_CTL,
1128		4, 3, 0, snd_soc_get_volsw_r2_twl4030,
1129		snd_soc_put_volsw_r2_twl4030, output_tvl),
1130
1131	SOC_SINGLE_EXT_TLV("Earpiece Playback Volume",
1132		TWL4030_REG_EAR_CTL, 4, 3, 0, snd_soc_get_volsw_twl4030,
1133		snd_soc_put_volsw_twl4030, output_ear_tvl),
1134
1135	/* Common capture gain controls */
1136	SOC_DOUBLE_R_TLV("TX1 Digital Capture Volume",
1137		TWL4030_REG_ATXL1PGA, TWL4030_REG_ATXR1PGA,
1138		0, 0x1f, 0, digital_capture_tlv),
1139	SOC_DOUBLE_R_TLV("TX2 Digital Capture Volume",
1140		TWL4030_REG_AVTXL2PGA, TWL4030_REG_AVTXR2PGA,
1141		0, 0x1f, 0, digital_capture_tlv),
1142
1143	SOC_DOUBLE_TLV("Analog Capture Volume", TWL4030_REG_ANAMIC_GAIN,
1144		0, 3, 5, 0, input_gain_tlv),
1145
1146	SOC_ENUM("AVADC Clock Priority", twl4030_avadc_clk_priority_enum),
1147
1148	SOC_ENUM("HS ramp delay", twl4030_rampdelay_enum),
1149
1150	SOC_ENUM("Vibra H-bridge mode", twl4030_vibradirmode_enum),
1151	SOC_ENUM("Vibra H-bridge direction", twl4030_vibradir_enum),
1152
1153	SOC_ENUM("Digimic LR Swap", twl4030_digimicswap_enum),
1154};
1155
1156static const struct snd_soc_dapm_widget twl4030_dapm_widgets[] = {
1157	/* Left channel inputs */
1158	SND_SOC_DAPM_INPUT("MAINMIC"),
1159	SND_SOC_DAPM_INPUT("HSMIC"),
1160	SND_SOC_DAPM_INPUT("AUXL"),
1161	SND_SOC_DAPM_INPUT("CARKITMIC"),
1162	/* Right channel inputs */
1163	SND_SOC_DAPM_INPUT("SUBMIC"),
1164	SND_SOC_DAPM_INPUT("AUXR"),
1165	/* Digital microphones (Stereo) */
1166	SND_SOC_DAPM_INPUT("DIGIMIC0"),
1167	SND_SOC_DAPM_INPUT("DIGIMIC1"),
1168
1169	/* Outputs */
1170	SND_SOC_DAPM_OUTPUT("EARPIECE"),
1171	SND_SOC_DAPM_OUTPUT("PREDRIVEL"),
1172	SND_SOC_DAPM_OUTPUT("PREDRIVER"),
1173	SND_SOC_DAPM_OUTPUT("HSOL"),
1174	SND_SOC_DAPM_OUTPUT("HSOR"),
1175	SND_SOC_DAPM_OUTPUT("CARKITL"),
1176	SND_SOC_DAPM_OUTPUT("CARKITR"),
1177	SND_SOC_DAPM_OUTPUT("HFL"),
1178	SND_SOC_DAPM_OUTPUT("HFR"),
1179	SND_SOC_DAPM_OUTPUT("VIBRA"),
1180
1181	/* AIF and APLL clocks for running DAIs (including loopback) */
1182	SND_SOC_DAPM_OUTPUT("Virtual HiFi OUT"),
1183	SND_SOC_DAPM_INPUT("Virtual HiFi IN"),
1184	SND_SOC_DAPM_OUTPUT("Virtual Voice OUT"),
1185
1186	/* DACs */
1187	SND_SOC_DAPM_DAC("DAC Right1", NULL, SND_SOC_NOPM, 0, 0),
1188	SND_SOC_DAPM_DAC("DAC Left1", NULL, SND_SOC_NOPM, 0, 0),
1189	SND_SOC_DAPM_DAC("DAC Right2", NULL, SND_SOC_NOPM, 0, 0),
1190	SND_SOC_DAPM_DAC("DAC Left2", NULL, SND_SOC_NOPM, 0, 0),
1191	SND_SOC_DAPM_DAC("DAC Voice", NULL, SND_SOC_NOPM, 0, 0),
1192
1193	SND_SOC_DAPM_AIF_IN("VAIFIN", "Voice Playback", 0,
1194			    TWL4030_REG_VOICE_IF, 6, 0),
 
 
1195
1196	/* Analog bypasses */
1197	SND_SOC_DAPM_SWITCH("Right1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1198			&twl4030_dapm_abypassr1_control),
1199	SND_SOC_DAPM_SWITCH("Left1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1200			&twl4030_dapm_abypassl1_control),
1201	SND_SOC_DAPM_SWITCH("Right2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1202			&twl4030_dapm_abypassr2_control),
1203	SND_SOC_DAPM_SWITCH("Left2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1204			&twl4030_dapm_abypassl2_control),
1205	SND_SOC_DAPM_SWITCH("Voice Analog Loopback", SND_SOC_NOPM, 0, 0,
1206			&twl4030_dapm_abypassv_control),
1207
1208	/* Master analog loopback switch */
1209	SND_SOC_DAPM_SUPPLY("FM Loop Enable", TWL4030_REG_MISC_SET_1, 5, 0,
1210			    NULL, 0),
1211
1212	/* Digital bypasses */
1213	SND_SOC_DAPM_SWITCH("Left Digital Loopback", SND_SOC_NOPM, 0, 0,
1214			&twl4030_dapm_dbypassl_control),
1215	SND_SOC_DAPM_SWITCH("Right Digital Loopback", SND_SOC_NOPM, 0, 0,
1216			&twl4030_dapm_dbypassr_control),
1217	SND_SOC_DAPM_SWITCH("Voice Digital Loopback", SND_SOC_NOPM, 0, 0,
1218			&twl4030_dapm_dbypassv_control),
1219
1220	/* Digital mixers, power control for the physical DACs */
1221	SND_SOC_DAPM_MIXER("Digital R1 Playback Mixer",
1222			TWL4030_REG_AVDAC_CTL, 0, 0, NULL, 0),
1223	SND_SOC_DAPM_MIXER("Digital L1 Playback Mixer",
1224			TWL4030_REG_AVDAC_CTL, 1, 0, NULL, 0),
1225	SND_SOC_DAPM_MIXER("Digital R2 Playback Mixer",
1226			TWL4030_REG_AVDAC_CTL, 2, 0, NULL, 0),
1227	SND_SOC_DAPM_MIXER("Digital L2 Playback Mixer",
1228			TWL4030_REG_AVDAC_CTL, 3, 0, NULL, 0),
1229	SND_SOC_DAPM_MIXER("Digital Voice Playback Mixer",
1230			TWL4030_REG_AVDAC_CTL, 4, 0, NULL, 0),
1231
1232	/* Analog mixers, power control for the physical PGAs */
1233	SND_SOC_DAPM_MIXER("Analog R1 Playback Mixer",
1234			TWL4030_REG_ARXR1_APGA_CTL, 0, 0, NULL, 0),
1235	SND_SOC_DAPM_MIXER("Analog L1 Playback Mixer",
1236			TWL4030_REG_ARXL1_APGA_CTL, 0, 0, NULL, 0),
1237	SND_SOC_DAPM_MIXER("Analog R2 Playback Mixer",
1238			TWL4030_REG_ARXR2_APGA_CTL, 0, 0, NULL, 0),
1239	SND_SOC_DAPM_MIXER("Analog L2 Playback Mixer",
1240			TWL4030_REG_ARXL2_APGA_CTL, 0, 0, NULL, 0),
1241	SND_SOC_DAPM_MIXER("Analog Voice Playback Mixer",
1242			TWL4030_REG_VDL_APGA_CTL, 0, 0, NULL, 0),
1243
1244	SND_SOC_DAPM_SUPPLY("APLL Enable", SND_SOC_NOPM, 0, 0, apll_event,
1245			    SND_SOC_DAPM_PRE_PMU|SND_SOC_DAPM_POST_PMD),
1246
1247	SND_SOC_DAPM_SUPPLY("AIF Enable", SND_SOC_NOPM, 0, 0, aif_event,
1248			    SND_SOC_DAPM_PRE_PMU|SND_SOC_DAPM_POST_PMD),
1249
1250	/* Output MIXER controls */
1251	/* Earpiece */
1252	SND_SOC_DAPM_MIXER("Earpiece Mixer", SND_SOC_NOPM, 0, 0,
1253			&twl4030_dapm_earpiece_controls[0],
1254			ARRAY_SIZE(twl4030_dapm_earpiece_controls)),
1255	SND_SOC_DAPM_PGA_E("Earpiece PGA", SND_SOC_NOPM,
1256			0, 0, NULL, 0, earpiecepga_event,
1257			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1258	/* PreDrivL/R */
1259	SND_SOC_DAPM_MIXER("PredriveL Mixer", SND_SOC_NOPM, 0, 0,
1260			&twl4030_dapm_predrivel_controls[0],
1261			ARRAY_SIZE(twl4030_dapm_predrivel_controls)),
1262	SND_SOC_DAPM_PGA_E("PredriveL PGA", SND_SOC_NOPM,
1263			0, 0, NULL, 0, predrivelpga_event,
1264			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1265	SND_SOC_DAPM_MIXER("PredriveR Mixer", SND_SOC_NOPM, 0, 0,
1266			&twl4030_dapm_predriver_controls[0],
1267			ARRAY_SIZE(twl4030_dapm_predriver_controls)),
1268	SND_SOC_DAPM_PGA_E("PredriveR PGA", SND_SOC_NOPM,
1269			0, 0, NULL, 0, predriverpga_event,
1270			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1271	/* HeadsetL/R */
1272	SND_SOC_DAPM_MIXER("HeadsetL Mixer", SND_SOC_NOPM, 0, 0,
1273			&twl4030_dapm_hsol_controls[0],
1274			ARRAY_SIZE(twl4030_dapm_hsol_controls)),
1275	SND_SOC_DAPM_PGA_E("HeadsetL PGA", SND_SOC_NOPM,
1276			0, 0, NULL, 0, headsetlpga_event,
1277			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1278	SND_SOC_DAPM_MIXER("HeadsetR Mixer", SND_SOC_NOPM, 0, 0,
1279			&twl4030_dapm_hsor_controls[0],
1280			ARRAY_SIZE(twl4030_dapm_hsor_controls)),
1281	SND_SOC_DAPM_PGA_E("HeadsetR PGA", SND_SOC_NOPM,
1282			0, 0, NULL, 0, headsetrpga_event,
1283			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1284	/* CarkitL/R */
1285	SND_SOC_DAPM_MIXER("CarkitL Mixer", SND_SOC_NOPM, 0, 0,
1286			&twl4030_dapm_carkitl_controls[0],
1287			ARRAY_SIZE(twl4030_dapm_carkitl_controls)),
1288	SND_SOC_DAPM_PGA_E("CarkitL PGA", SND_SOC_NOPM,
1289			0, 0, NULL, 0, carkitlpga_event,
1290			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1291	SND_SOC_DAPM_MIXER("CarkitR Mixer", SND_SOC_NOPM, 0, 0,
1292			&twl4030_dapm_carkitr_controls[0],
1293			ARRAY_SIZE(twl4030_dapm_carkitr_controls)),
1294	SND_SOC_DAPM_PGA_E("CarkitR PGA", SND_SOC_NOPM,
1295			0, 0, NULL, 0, carkitrpga_event,
1296			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1297
1298	/* Output MUX controls */
1299	/* HandsfreeL/R */
1300	SND_SOC_DAPM_MUX("HandsfreeL Mux", SND_SOC_NOPM, 0, 0,
1301		&twl4030_dapm_handsfreel_control),
1302	SND_SOC_DAPM_SWITCH("HandsfreeL", SND_SOC_NOPM, 0, 0,
1303			&twl4030_dapm_handsfreelmute_control),
1304	SND_SOC_DAPM_PGA_E("HandsfreeL PGA", SND_SOC_NOPM,
1305			0, 0, NULL, 0, handsfreelpga_event,
1306			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1307	SND_SOC_DAPM_MUX("HandsfreeR Mux", SND_SOC_NOPM, 5, 0,
1308		&twl4030_dapm_handsfreer_control),
1309	SND_SOC_DAPM_SWITCH("HandsfreeR", SND_SOC_NOPM, 0, 0,
1310			&twl4030_dapm_handsfreermute_control),
1311	SND_SOC_DAPM_PGA_E("HandsfreeR PGA", SND_SOC_NOPM,
1312			0, 0, NULL, 0, handsfreerpga_event,
1313			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1314	/* Vibra */
1315	SND_SOC_DAPM_MUX_E("Vibra Mux", TWL4030_REG_VIBRA_CTL, 0, 0,
1316			   &twl4030_dapm_vibra_control, vibramux_event,
1317			   SND_SOC_DAPM_PRE_PMU),
1318	SND_SOC_DAPM_MUX("Vibra Route", SND_SOC_NOPM, 0, 0,
1319		&twl4030_dapm_vibrapath_control),
1320
1321	/* Introducing four virtual ADC, since TWL4030 have four channel for
1322	   capture */
1323	SND_SOC_DAPM_ADC("ADC Virtual Left1", NULL, SND_SOC_NOPM, 0, 0),
1324	SND_SOC_DAPM_ADC("ADC Virtual Right1", NULL, SND_SOC_NOPM, 0, 0),
1325	SND_SOC_DAPM_ADC("ADC Virtual Left2", NULL, SND_SOC_NOPM, 0, 0),
1326	SND_SOC_DAPM_ADC("ADC Virtual Right2", NULL, SND_SOC_NOPM, 0, 0),
1327
1328	SND_SOC_DAPM_AIF_OUT("VAIFOUT", "Voice Capture", 0,
1329			     TWL4030_REG_VOICE_IF, 5, 0),
 
1330
1331	/* Analog/Digital mic path selection.
1332	   TX1 Left/Right: either analog Left/Right or Digimic0
1333	   TX2 Left/Right: either analog Left/Right or Digimic1 */
1334	SND_SOC_DAPM_MUX("TX1 Capture Route", SND_SOC_NOPM, 0, 0,
1335		&twl4030_dapm_micpathtx1_control),
1336	SND_SOC_DAPM_MUX("TX2 Capture Route", SND_SOC_NOPM, 0, 0,
1337		&twl4030_dapm_micpathtx2_control),
1338
1339	/* Analog input mixers for the capture amplifiers */
1340	SND_SOC_DAPM_MIXER("Analog Left",
1341		TWL4030_REG_ANAMICL, 4, 0,
1342		&twl4030_dapm_analoglmic_controls[0],
1343		ARRAY_SIZE(twl4030_dapm_analoglmic_controls)),
1344	SND_SOC_DAPM_MIXER("Analog Right",
1345		TWL4030_REG_ANAMICR, 4, 0,
1346		&twl4030_dapm_analogrmic_controls[0],
1347		ARRAY_SIZE(twl4030_dapm_analogrmic_controls)),
1348
1349	SND_SOC_DAPM_PGA("ADC Physical Left",
1350		TWL4030_REG_AVADC_CTL, 3, 0, NULL, 0),
1351	SND_SOC_DAPM_PGA("ADC Physical Right",
1352		TWL4030_REG_AVADC_CTL, 1, 0, NULL, 0),
1353
1354	SND_SOC_DAPM_PGA_E("Digimic0 Enable",
1355		TWL4030_REG_ADCMICSEL, 1, 0, NULL, 0,
1356		digimic_event, SND_SOC_DAPM_POST_PMU),
1357	SND_SOC_DAPM_PGA_E("Digimic1 Enable",
1358		TWL4030_REG_ADCMICSEL, 3, 0, NULL, 0,
1359		digimic_event, SND_SOC_DAPM_POST_PMU),
1360
1361	SND_SOC_DAPM_SUPPLY("micbias1 select", TWL4030_REG_MICBIAS_CTL, 5, 0,
1362			    NULL, 0),
1363	SND_SOC_DAPM_SUPPLY("micbias2 select", TWL4030_REG_MICBIAS_CTL, 6, 0,
1364			    NULL, 0),
1365
1366	/* Microphone bias */
1367	SND_SOC_DAPM_SUPPLY("Mic Bias 1",
1368			    TWL4030_REG_MICBIAS_CTL, 0, 0, NULL, 0),
1369	SND_SOC_DAPM_SUPPLY("Mic Bias 2",
1370			    TWL4030_REG_MICBIAS_CTL, 1, 0, NULL, 0),
1371	SND_SOC_DAPM_SUPPLY("Headset Mic Bias",
1372			    TWL4030_REG_MICBIAS_CTL, 2, 0, NULL, 0),
1373
1374	SND_SOC_DAPM_SUPPLY("VIF Enable", TWL4030_REG_VOICE_IF, 0, 0, NULL, 0),
1375};
1376
1377static const struct snd_soc_dapm_route intercon[] = {
1378	/* Stream -> DAC mapping */
1379	{"DAC Right1", NULL, "HiFi Playback"},
1380	{"DAC Left1", NULL, "HiFi Playback"},
1381	{"DAC Right2", NULL, "HiFi Playback"},
1382	{"DAC Left2", NULL, "HiFi Playback"},
1383	{"DAC Voice", NULL, "VAIFIN"},
1384
1385	/* ADC -> Stream mapping */
1386	{"HiFi Capture", NULL, "ADC Virtual Left1"},
1387	{"HiFi Capture", NULL, "ADC Virtual Right1"},
1388	{"HiFi Capture", NULL, "ADC Virtual Left2"},
1389	{"HiFi Capture", NULL, "ADC Virtual Right2"},
1390	{"VAIFOUT", NULL, "ADC Virtual Left2"},
1391	{"VAIFOUT", NULL, "ADC Virtual Right2"},
1392	{"VAIFOUT", NULL, "VIF Enable"},
1393
1394	{"Digital L1 Playback Mixer", NULL, "DAC Left1"},
1395	{"Digital R1 Playback Mixer", NULL, "DAC Right1"},
1396	{"Digital L2 Playback Mixer", NULL, "DAC Left2"},
1397	{"Digital R2 Playback Mixer", NULL, "DAC Right2"},
1398	{"Digital Voice Playback Mixer", NULL, "DAC Voice"},
1399
1400	/* Supply for the digital part (APLL) */
1401	{"Digital Voice Playback Mixer", NULL, "APLL Enable"},
1402
1403	{"DAC Left1", NULL, "AIF Enable"},
1404	{"DAC Right1", NULL, "AIF Enable"},
1405	{"DAC Left2", NULL, "AIF Enable"},
1406	{"DAC Right1", NULL, "AIF Enable"},
1407	{"DAC Voice", NULL, "VIF Enable"},
1408
1409	{"Digital R2 Playback Mixer", NULL, "AIF Enable"},
1410	{"Digital L2 Playback Mixer", NULL, "AIF Enable"},
1411
1412	{"Analog L1 Playback Mixer", NULL, "Digital L1 Playback Mixer"},
1413	{"Analog R1 Playback Mixer", NULL, "Digital R1 Playback Mixer"},
1414	{"Analog L2 Playback Mixer", NULL, "Digital L2 Playback Mixer"},
1415	{"Analog R2 Playback Mixer", NULL, "Digital R2 Playback Mixer"},
1416	{"Analog Voice Playback Mixer", NULL, "Digital Voice Playback Mixer"},
1417
1418	/* Internal playback routings */
1419	/* Earpiece */
1420	{"Earpiece Mixer", "Voice", "Analog Voice Playback Mixer"},
1421	{"Earpiece Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1422	{"Earpiece Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1423	{"Earpiece Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1424	{"Earpiece PGA", NULL, "Earpiece Mixer"},
1425	/* PreDrivL */
1426	{"PredriveL Mixer", "Voice", "Analog Voice Playback Mixer"},
1427	{"PredriveL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1428	{"PredriveL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1429	{"PredriveL Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1430	{"PredriveL PGA", NULL, "PredriveL Mixer"},
1431	/* PreDrivR */
1432	{"PredriveR Mixer", "Voice", "Analog Voice Playback Mixer"},
1433	{"PredriveR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1434	{"PredriveR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1435	{"PredriveR Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1436	{"PredriveR PGA", NULL, "PredriveR Mixer"},
1437	/* HeadsetL */
1438	{"HeadsetL Mixer", "Voice", "Analog Voice Playback Mixer"},
1439	{"HeadsetL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1440	{"HeadsetL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1441	{"HeadsetL PGA", NULL, "HeadsetL Mixer"},
1442	/* HeadsetR */
1443	{"HeadsetR Mixer", "Voice", "Analog Voice Playback Mixer"},
1444	{"HeadsetR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1445	{"HeadsetR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1446	{"HeadsetR PGA", NULL, "HeadsetR Mixer"},
1447	/* CarkitL */
1448	{"CarkitL Mixer", "Voice", "Analog Voice Playback Mixer"},
1449	{"CarkitL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1450	{"CarkitL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1451	{"CarkitL PGA", NULL, "CarkitL Mixer"},
1452	/* CarkitR */
1453	{"CarkitR Mixer", "Voice", "Analog Voice Playback Mixer"},
1454	{"CarkitR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1455	{"CarkitR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1456	{"CarkitR PGA", NULL, "CarkitR Mixer"},
1457	/* HandsfreeL */
1458	{"HandsfreeL Mux", "Voice", "Analog Voice Playback Mixer"},
1459	{"HandsfreeL Mux", "AudioL1", "Analog L1 Playback Mixer"},
1460	{"HandsfreeL Mux", "AudioL2", "Analog L2 Playback Mixer"},
1461	{"HandsfreeL Mux", "AudioR2", "Analog R2 Playback Mixer"},
1462	{"HandsfreeL", "Switch", "HandsfreeL Mux"},
1463	{"HandsfreeL PGA", NULL, "HandsfreeL"},
1464	/* HandsfreeR */
1465	{"HandsfreeR Mux", "Voice", "Analog Voice Playback Mixer"},
1466	{"HandsfreeR Mux", "AudioR1", "Analog R1 Playback Mixer"},
1467	{"HandsfreeR Mux", "AudioR2", "Analog R2 Playback Mixer"},
1468	{"HandsfreeR Mux", "AudioL2", "Analog L2 Playback Mixer"},
1469	{"HandsfreeR", "Switch", "HandsfreeR Mux"},
1470	{"HandsfreeR PGA", NULL, "HandsfreeR"},
1471	/* Vibra */
1472	{"Vibra Mux", "AudioL1", "DAC Left1"},
1473	{"Vibra Mux", "AudioR1", "DAC Right1"},
1474	{"Vibra Mux", "AudioL2", "DAC Left2"},
1475	{"Vibra Mux", "AudioR2", "DAC Right2"},
1476
1477	/* outputs */
1478	/* Must be always connected (for AIF and APLL) */
1479	{"Virtual HiFi OUT", NULL, "DAC Left1"},
1480	{"Virtual HiFi OUT", NULL, "DAC Right1"},
1481	{"Virtual HiFi OUT", NULL, "DAC Left2"},
1482	{"Virtual HiFi OUT", NULL, "DAC Right2"},
1483	/* Must be always connected (for APLL) */
1484	{"Virtual Voice OUT", NULL, "Digital Voice Playback Mixer"},
1485	/* Physical outputs */
1486	{"EARPIECE", NULL, "Earpiece PGA"},
1487	{"PREDRIVEL", NULL, "PredriveL PGA"},
1488	{"PREDRIVER", NULL, "PredriveR PGA"},
1489	{"HSOL", NULL, "HeadsetL PGA"},
1490	{"HSOR", NULL, "HeadsetR PGA"},
1491	{"CARKITL", NULL, "CarkitL PGA"},
1492	{"CARKITR", NULL, "CarkitR PGA"},
1493	{"HFL", NULL, "HandsfreeL PGA"},
1494	{"HFR", NULL, "HandsfreeR PGA"},
1495	{"Vibra Route", "Audio", "Vibra Mux"},
1496	{"VIBRA", NULL, "Vibra Route"},
1497
1498	/* Capture path */
1499	/* Must be always connected (for AIF and APLL) */
1500	{"ADC Virtual Left1", NULL, "Virtual HiFi IN"},
1501	{"ADC Virtual Right1", NULL, "Virtual HiFi IN"},
1502	{"ADC Virtual Left2", NULL, "Virtual HiFi IN"},
1503	{"ADC Virtual Right2", NULL, "Virtual HiFi IN"},
1504	/* Physical inputs */
1505	{"Analog Left", "Main Mic Capture Switch", "MAINMIC"},
1506	{"Analog Left", "Headset Mic Capture Switch", "HSMIC"},
1507	{"Analog Left", "AUXL Capture Switch", "AUXL"},
1508	{"Analog Left", "Carkit Mic Capture Switch", "CARKITMIC"},
1509
1510	{"Analog Right", "Sub Mic Capture Switch", "SUBMIC"},
1511	{"Analog Right", "AUXR Capture Switch", "AUXR"},
1512
1513	{"ADC Physical Left", NULL, "Analog Left"},
1514	{"ADC Physical Right", NULL, "Analog Right"},
1515
1516	{"Digimic0 Enable", NULL, "DIGIMIC0"},
1517	{"Digimic1 Enable", NULL, "DIGIMIC1"},
1518
1519	{"DIGIMIC0", NULL, "micbias1 select"},
1520	{"DIGIMIC1", NULL, "micbias2 select"},
1521
1522	/* TX1 Left capture path */
1523	{"TX1 Capture Route", "Analog", "ADC Physical Left"},
1524	{"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1525	/* TX1 Right capture path */
1526	{"TX1 Capture Route", "Analog", "ADC Physical Right"},
1527	{"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1528	/* TX2 Left capture path */
1529	{"TX2 Capture Route", "Analog", "ADC Physical Left"},
1530	{"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1531	/* TX2 Right capture path */
1532	{"TX2 Capture Route", "Analog", "ADC Physical Right"},
1533	{"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1534
1535	{"ADC Virtual Left1", NULL, "TX1 Capture Route"},
1536	{"ADC Virtual Right1", NULL, "TX1 Capture Route"},
1537	{"ADC Virtual Left2", NULL, "TX2 Capture Route"},
1538	{"ADC Virtual Right2", NULL, "TX2 Capture Route"},
1539
1540	{"ADC Virtual Left1", NULL, "AIF Enable"},
1541	{"ADC Virtual Right1", NULL, "AIF Enable"},
1542	{"ADC Virtual Left2", NULL, "AIF Enable"},
1543	{"ADC Virtual Right2", NULL, "AIF Enable"},
1544
1545	/* Analog bypass routes */
1546	{"Right1 Analog Loopback", "Switch", "Analog Right"},
1547	{"Left1 Analog Loopback", "Switch", "Analog Left"},
1548	{"Right2 Analog Loopback", "Switch", "Analog Right"},
1549	{"Left2 Analog Loopback", "Switch", "Analog Left"},
1550	{"Voice Analog Loopback", "Switch", "Analog Left"},
1551
1552	/* Supply for the Analog loopbacks */
1553	{"Right1 Analog Loopback", NULL, "FM Loop Enable"},
1554	{"Left1 Analog Loopback", NULL, "FM Loop Enable"},
1555	{"Right2 Analog Loopback", NULL, "FM Loop Enable"},
1556	{"Left2 Analog Loopback", NULL, "FM Loop Enable"},
1557	{"Voice Analog Loopback", NULL, "FM Loop Enable"},
1558
1559	{"Analog R1 Playback Mixer", NULL, "Right1 Analog Loopback"},
1560	{"Analog L1 Playback Mixer", NULL, "Left1 Analog Loopback"},
1561	{"Analog R2 Playback Mixer", NULL, "Right2 Analog Loopback"},
1562	{"Analog L2 Playback Mixer", NULL, "Left2 Analog Loopback"},
1563	{"Analog Voice Playback Mixer", NULL, "Voice Analog Loopback"},
1564
1565	/* Digital bypass routes */
1566	{"Right Digital Loopback", "Volume", "TX1 Capture Route"},
1567	{"Left Digital Loopback", "Volume", "TX1 Capture Route"},
1568	{"Voice Digital Loopback", "Volume", "TX2 Capture Route"},
1569
1570	{"Digital R2 Playback Mixer", NULL, "Right Digital Loopback"},
1571	{"Digital L2 Playback Mixer", NULL, "Left Digital Loopback"},
1572	{"Digital Voice Playback Mixer", NULL, "Voice Digital Loopback"},
1573
1574};
1575
1576static int twl4030_set_bias_level(struct snd_soc_component *component,
 
 
 
 
 
 
 
 
 
 
 
1577				  enum snd_soc_bias_level level)
1578{
1579	switch (level) {
1580	case SND_SOC_BIAS_ON:
1581		break;
1582	case SND_SOC_BIAS_PREPARE:
1583		break;
1584	case SND_SOC_BIAS_STANDBY:
1585		if (snd_soc_component_get_bias_level(component) == SND_SOC_BIAS_OFF)
1586			twl4030_codec_enable(component, 1);
1587		break;
1588	case SND_SOC_BIAS_OFF:
1589		twl4030_codec_enable(component, 0);
1590		break;
1591	}
 
1592
1593	return 0;
1594}
1595
1596static void twl4030_constraints(struct twl4030_priv *twl4030,
1597				struct snd_pcm_substream *mst_substream)
1598{
1599	struct snd_pcm_substream *slv_substream;
1600
1601	/* Pick the stream, which need to be constrained */
1602	if (mst_substream == twl4030->master_substream)
1603		slv_substream = twl4030->slave_substream;
1604	else if (mst_substream == twl4030->slave_substream)
1605		slv_substream = twl4030->master_substream;
1606	else /* This should not happen.. */
1607		return;
1608
1609	/* Set the constraints according to the already configured stream */
1610	snd_pcm_hw_constraint_single(slv_substream->runtime,
1611				SNDRV_PCM_HW_PARAM_RATE,
 
1612				twl4030->rate);
1613
1614	snd_pcm_hw_constraint_single(slv_substream->runtime,
1615				SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
 
1616				twl4030->sample_bits);
1617
1618	snd_pcm_hw_constraint_single(slv_substream->runtime,
1619				SNDRV_PCM_HW_PARAM_CHANNELS,
 
1620				twl4030->channels);
1621}
1622
1623/* In case of 4 channel mode, the RX1 L/R for playback and the TX2 L/R for
1624 * capture has to be enabled/disabled. */
1625static void twl4030_tdm_enable(struct snd_soc_component *component, int direction,
1626			       int enable)
1627{
1628	u8 reg, mask;
1629
1630	reg = twl4030_read(component, TWL4030_REG_OPTION);
1631
1632	if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1633		mask = TWL4030_ARXL1_VRX_EN | TWL4030_ARXR1_EN;
1634	else
1635		mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1636
1637	if (enable)
1638		reg |= mask;
1639	else
1640		reg &= ~mask;
1641
1642	twl4030_write(component, TWL4030_REG_OPTION, reg);
1643}
1644
1645static int twl4030_startup(struct snd_pcm_substream *substream,
1646			   struct snd_soc_dai *dai)
1647{
1648	struct snd_soc_component *component = dai->component;
1649	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
1650
 
1651	if (twl4030->master_substream) {
1652		twl4030->slave_substream = substream;
1653		/* The DAI has one configuration for playback and capture, so
1654		 * if the DAI has been already configured then constrain this
1655		 * substream to match it. */
1656		if (twl4030->configured)
1657			twl4030_constraints(twl4030, twl4030->master_substream);
1658	} else {
1659		if (!(twl4030_read(component, TWL4030_REG_CODEC_MODE) &
1660			TWL4030_OPTION_1)) {
1661			/* In option2 4 channel is not supported, set the
1662			 * constraint for the first stream for channels, the
1663			 * second stream will 'inherit' this cosntraint */
1664			snd_pcm_hw_constraint_single(substream->runtime,
1665						     SNDRV_PCM_HW_PARAM_CHANNELS,
1666						     2);
1667		}
1668		twl4030->master_substream = substream;
1669	}
1670
1671	return 0;
1672}
1673
1674static void twl4030_shutdown(struct snd_pcm_substream *substream,
1675			     struct snd_soc_dai *dai)
1676{
1677	struct snd_soc_component *component = dai->component;
1678	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
1679
1680	if (twl4030->master_substream == substream)
1681		twl4030->master_substream = twl4030->slave_substream;
1682
1683	twl4030->slave_substream = NULL;
1684
1685	/* If all streams are closed, or the remaining stream has not yet
1686	 * been configured than set the DAI as not configured. */
1687	if (!twl4030->master_substream)
1688		twl4030->configured = 0;
1689	 else if (!twl4030->master_substream->runtime->channels)
1690		twl4030->configured = 0;
1691
1692	 /* If the closing substream had 4 channel, do the necessary cleanup */
1693	if (substream->runtime->channels == 4)
1694		twl4030_tdm_enable(component, substream->stream, 0);
1695}
1696
1697static int twl4030_hw_params(struct snd_pcm_substream *substream,
1698			     struct snd_pcm_hw_params *params,
1699			     struct snd_soc_dai *dai)
1700{
1701	struct snd_soc_component *component = dai->component;
1702	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
1703	u8 mode, old_mode, format, old_format;
1704
1705	 /* If the substream has 4 channel, do the necessary setup */
1706	if (params_channels(params) == 4) {
1707		format = twl4030_read(component, TWL4030_REG_AUDIO_IF);
1708		mode = twl4030_read(component, TWL4030_REG_CODEC_MODE);
1709
1710		/* Safety check: are we in the correct operating mode and
1711		 * the interface is in TDM mode? */
1712		if ((mode & TWL4030_OPTION_1) &&
1713		    ((format & TWL4030_AIF_FORMAT) == TWL4030_AIF_FORMAT_TDM))
1714			twl4030_tdm_enable(component, substream->stream, 1);
1715		else
1716			return -EINVAL;
1717	}
1718
1719	if (twl4030->configured)
1720		/* Ignoring hw_params for already configured DAI */
1721		return 0;
1722
1723	/* bit rate */
1724	old_mode = twl4030_read(component,
1725				TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1726	mode = old_mode & ~TWL4030_APLL_RATE;
1727
1728	switch (params_rate(params)) {
1729	case 8000:
1730		mode |= TWL4030_APLL_RATE_8000;
1731		break;
1732	case 11025:
1733		mode |= TWL4030_APLL_RATE_11025;
1734		break;
1735	case 12000:
1736		mode |= TWL4030_APLL_RATE_12000;
1737		break;
1738	case 16000:
1739		mode |= TWL4030_APLL_RATE_16000;
1740		break;
1741	case 22050:
1742		mode |= TWL4030_APLL_RATE_22050;
1743		break;
1744	case 24000:
1745		mode |= TWL4030_APLL_RATE_24000;
1746		break;
1747	case 32000:
1748		mode |= TWL4030_APLL_RATE_32000;
1749		break;
1750	case 44100:
1751		mode |= TWL4030_APLL_RATE_44100;
1752		break;
1753	case 48000:
1754		mode |= TWL4030_APLL_RATE_48000;
1755		break;
1756	case 96000:
1757		mode |= TWL4030_APLL_RATE_96000;
1758		break;
1759	default:
1760		dev_err(component->dev, "%s: unknown rate %d\n", __func__,
1761			params_rate(params));
1762		return -EINVAL;
1763	}
1764
1765	/* sample size */
1766	old_format = twl4030_read(component, TWL4030_REG_AUDIO_IF);
1767	format = old_format;
1768	format &= ~TWL4030_DATA_WIDTH;
1769	switch (params_width(params)) {
1770	case 16:
1771		format |= TWL4030_DATA_WIDTH_16S_16W;
1772		break;
1773	case 32:
1774		format |= TWL4030_DATA_WIDTH_32S_24W;
1775		break;
1776	default:
1777		dev_err(component->dev, "%s: unsupported bits/sample %d\n",
1778			__func__, params_width(params));
1779		return -EINVAL;
1780	}
1781
1782	if (format != old_format || mode != old_mode) {
1783		if (twl4030->codec_powered) {
1784			/*
1785			 * If the codec is powered, than we need to toggle the
1786			 * codec power.
1787			 */
1788			twl4030_codec_enable(component, 0);
1789			twl4030_write(component, TWL4030_REG_CODEC_MODE, mode);
1790			twl4030_write(component, TWL4030_REG_AUDIO_IF, format);
1791			twl4030_codec_enable(component, 1);
1792		} else {
1793			twl4030_write(component, TWL4030_REG_CODEC_MODE, mode);
1794			twl4030_write(component, TWL4030_REG_AUDIO_IF, format);
1795		}
1796	}
1797
1798	/* Store the important parameters for the DAI configuration and set
1799	 * the DAI as configured */
1800	twl4030->configured = 1;
1801	twl4030->rate = params_rate(params);
1802	twl4030->sample_bits = hw_param_interval(params,
1803					SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
1804	twl4030->channels = params_channels(params);
1805
1806	/* If both playback and capture streams are open, and one of them
1807	 * is setting the hw parameters right now (since we are here), set
1808	 * constraints to the other stream to match the current one. */
1809	if (twl4030->slave_substream)
1810		twl4030_constraints(twl4030, substream);
1811
1812	return 0;
1813}
1814
1815static int twl4030_set_dai_sysclk(struct snd_soc_dai *codec_dai, int clk_id,
1816				  unsigned int freq, int dir)
1817{
1818	struct snd_soc_component *component = codec_dai->component;
1819	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
1820
1821	switch (freq) {
1822	case 19200000:
1823	case 26000000:
1824	case 38400000:
1825		break;
1826	default:
1827		dev_err(component->dev, "Unsupported HFCLKIN: %u\n", freq);
1828		return -EINVAL;
1829	}
1830
1831	if ((freq / 1000) != twl4030->sysclk) {
1832		dev_err(component->dev,
1833			"Mismatch in HFCLKIN: %u (configured: %u)\n",
1834			freq, twl4030->sysclk * 1000);
1835		return -EINVAL;
1836	}
1837
1838	return 0;
1839}
1840
1841static int twl4030_set_dai_fmt(struct snd_soc_dai *codec_dai, unsigned int fmt)
 
1842{
1843	struct snd_soc_component *component = codec_dai->component;
1844	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
1845	u8 old_format, format;
1846
1847	/* get format */
1848	old_format = twl4030_read(component, TWL4030_REG_AUDIO_IF);
1849	format = old_format;
1850
1851	switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
1852	case SND_SOC_DAIFMT_CBP_CFP:
 
1853		format &= ~(TWL4030_AIF_SLAVE_EN);
1854		format &= ~(TWL4030_CLK256FS_EN);
1855		break;
1856	case SND_SOC_DAIFMT_CBC_CFC:
1857		format |= TWL4030_AIF_SLAVE_EN;
1858		format |= TWL4030_CLK256FS_EN;
1859		break;
1860	default:
1861		return -EINVAL;
1862	}
1863
1864	/* interface format */
1865	format &= ~TWL4030_AIF_FORMAT;
1866	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1867	case SND_SOC_DAIFMT_I2S:
1868		format |= TWL4030_AIF_FORMAT_CODEC;
1869		break;
1870	case SND_SOC_DAIFMT_DSP_A:
1871		format |= TWL4030_AIF_FORMAT_TDM;
1872		break;
1873	default:
1874		return -EINVAL;
1875	}
1876
1877	if (format != old_format) {
1878		if (twl4030->codec_powered) {
1879			/*
1880			 * If the codec is powered, than we need to toggle the
1881			 * codec power.
1882			 */
1883			twl4030_codec_enable(component, 0);
1884			twl4030_write(component, TWL4030_REG_AUDIO_IF, format);
1885			twl4030_codec_enable(component, 1);
1886		} else {
1887			twl4030_write(component, TWL4030_REG_AUDIO_IF, format);
1888		}
1889	}
1890
1891	return 0;
1892}
1893
1894static int twl4030_set_tristate(struct snd_soc_dai *dai, int tristate)
1895{
1896	struct snd_soc_component *component = dai->component;
1897	u8 reg = twl4030_read(component, TWL4030_REG_AUDIO_IF);
1898
1899	if (tristate)
1900		reg |= TWL4030_AIF_TRI_EN;
1901	else
1902		reg &= ~TWL4030_AIF_TRI_EN;
1903
1904	return twl4030_write(component, TWL4030_REG_AUDIO_IF, reg);
1905}
1906
1907/* In case of voice mode, the RX1 L(VRX) for downlink and the TX2 L/R
1908 * (VTXL, VTXR) for uplink has to be enabled/disabled. */
1909static void twl4030_voice_enable(struct snd_soc_component *component, int direction,
1910				 int enable)
1911{
1912	u8 reg, mask;
1913
1914	reg = twl4030_read(component, TWL4030_REG_OPTION);
1915
1916	if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1917		mask = TWL4030_ARXL1_VRX_EN;
1918	else
1919		mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1920
1921	if (enable)
1922		reg |= mask;
1923	else
1924		reg &= ~mask;
1925
1926	twl4030_write(component, TWL4030_REG_OPTION, reg);
1927}
1928
1929static int twl4030_voice_startup(struct snd_pcm_substream *substream,
1930				 struct snd_soc_dai *dai)
1931{
1932	struct snd_soc_component *component = dai->component;
1933	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
1934	u8 mode;
1935
1936	/* If the system master clock is not 26MHz, the voice PCM interface is
1937	 * not available.
1938	 */
1939	if (twl4030->sysclk != 26000) {
1940		dev_err(component->dev,
1941			"%s: HFCLKIN is %u KHz, voice interface needs 26MHz\n",
1942			__func__, twl4030->sysclk);
1943		return -EINVAL;
1944	}
1945
1946	/* If the codec mode is not option2, the voice PCM interface is not
1947	 * available.
1948	 */
1949	mode = twl4030_read(component, TWL4030_REG_CODEC_MODE)
1950		& TWL4030_OPT_MODE;
1951
1952	if (mode != TWL4030_OPTION_2) {
1953		dev_err(component->dev, "%s: the codec mode is not option2\n",
1954			__func__);
1955		return -EINVAL;
1956	}
1957
1958	return 0;
1959}
1960
1961static void twl4030_voice_shutdown(struct snd_pcm_substream *substream,
1962				   struct snd_soc_dai *dai)
1963{
1964	struct snd_soc_component *component = dai->component;
 
1965
1966	/* Enable voice digital filters */
1967	twl4030_voice_enable(component, substream->stream, 0);
1968}
1969
1970static int twl4030_voice_hw_params(struct snd_pcm_substream *substream,
1971				   struct snd_pcm_hw_params *params,
1972				   struct snd_soc_dai *dai)
1973{
1974	struct snd_soc_component *component = dai->component;
1975	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
 
1976	u8 old_mode, mode;
1977
1978	/* Enable voice digital filters */
1979	twl4030_voice_enable(component, substream->stream, 1);
1980
1981	/* bit rate */
1982	old_mode = twl4030_read(component,
1983				TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1984	mode = old_mode;
1985
1986	switch (params_rate(params)) {
1987	case 8000:
1988		mode &= ~(TWL4030_SEL_16K);
1989		break;
1990	case 16000:
1991		mode |= TWL4030_SEL_16K;
1992		break;
1993	default:
1994		dev_err(component->dev, "%s: unknown rate %d\n", __func__,
1995			params_rate(params));
1996		return -EINVAL;
1997	}
1998
1999	if (mode != old_mode) {
2000		if (twl4030->codec_powered) {
2001			/*
2002			 * If the codec is powered, than we need to toggle the
2003			 * codec power.
2004			 */
2005			twl4030_codec_enable(component, 0);
2006			twl4030_write(component, TWL4030_REG_CODEC_MODE, mode);
2007			twl4030_codec_enable(component, 1);
2008		} else {
2009			twl4030_write(component, TWL4030_REG_CODEC_MODE, mode);
2010		}
2011	}
2012
2013	return 0;
2014}
2015
2016static int twl4030_voice_set_dai_sysclk(struct snd_soc_dai *codec_dai,
2017					int clk_id, unsigned int freq, int dir)
2018{
2019	struct snd_soc_component *component = codec_dai->component;
2020	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
2021
2022	if (freq != 26000000) {
2023		dev_err(component->dev,
2024			"%s: HFCLKIN is %u KHz, voice interface needs 26MHz\n",
2025			__func__, freq / 1000);
2026		return -EINVAL;
2027	}
2028	if ((freq / 1000) != twl4030->sysclk) {
2029		dev_err(component->dev,
2030			"Mismatch in HFCLKIN: %u (configured: %u)\n",
2031			freq, twl4030->sysclk * 1000);
2032		return -EINVAL;
2033	}
2034	return 0;
2035}
2036
2037static int twl4030_voice_set_dai_fmt(struct snd_soc_dai *codec_dai,
2038				     unsigned int fmt)
2039{
2040	struct snd_soc_component *component = codec_dai->component;
2041	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
2042	u8 old_format, format;
2043
2044	/* get format */
2045	old_format = twl4030_read(component, TWL4030_REG_VOICE_IF);
2046	format = old_format;
2047
2048	switch (fmt & SND_SOC_DAIFMT_CLOCK_PROVIDER_MASK) {
2049	case SND_SOC_DAIFMT_CBP_CFP:
 
2050		format &= ~(TWL4030_VIF_SLAVE_EN);
2051		break;
2052	case SND_SOC_DAIFMT_CBS_CFS:
2053		format |= TWL4030_VIF_SLAVE_EN;
2054		break;
2055	default:
2056		return -EINVAL;
2057	}
2058
2059	/* clock inversion */
2060	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2061	case SND_SOC_DAIFMT_IB_NF:
2062		format &= ~(TWL4030_VIF_FORMAT);
2063		break;
2064	case SND_SOC_DAIFMT_NB_IF:
2065		format |= TWL4030_VIF_FORMAT;
2066		break;
2067	default:
2068		return -EINVAL;
2069	}
2070
2071	if (format != old_format) {
2072		if (twl4030->codec_powered) {
2073			/*
2074			 * If the codec is powered, than we need to toggle the
2075			 * codec power.
2076			 */
2077			twl4030_codec_enable(component, 0);
2078			twl4030_write(component, TWL4030_REG_VOICE_IF, format);
2079			twl4030_codec_enable(component, 1);
2080		} else {
2081			twl4030_write(component, TWL4030_REG_VOICE_IF, format);
2082		}
2083	}
2084
2085	return 0;
2086}
2087
2088static int twl4030_voice_set_tristate(struct snd_soc_dai *dai, int tristate)
2089{
2090	struct snd_soc_component *component = dai->component;
2091	u8 reg = twl4030_read(component, TWL4030_REG_VOICE_IF);
2092
2093	if (tristate)
2094		reg |= TWL4030_VIF_TRI_EN;
2095	else
2096		reg &= ~TWL4030_VIF_TRI_EN;
2097
2098	return twl4030_write(component, TWL4030_REG_VOICE_IF, reg);
2099}
2100
2101#define TWL4030_RATES	 (SNDRV_PCM_RATE_8000_48000)
2102#define TWL4030_FORMATS	 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
2103
2104static const struct snd_soc_dai_ops twl4030_dai_hifi_ops = {
2105	.startup	= twl4030_startup,
2106	.shutdown	= twl4030_shutdown,
2107	.hw_params	= twl4030_hw_params,
2108	.set_sysclk	= twl4030_set_dai_sysclk,
2109	.set_fmt	= twl4030_set_dai_fmt,
2110	.set_tristate	= twl4030_set_tristate,
2111};
2112
2113static const struct snd_soc_dai_ops twl4030_dai_voice_ops = {
2114	.startup	= twl4030_voice_startup,
2115	.shutdown	= twl4030_voice_shutdown,
2116	.hw_params	= twl4030_voice_hw_params,
2117	.set_sysclk	= twl4030_voice_set_dai_sysclk,
2118	.set_fmt	= twl4030_voice_set_dai_fmt,
2119	.set_tristate	= twl4030_voice_set_tristate,
2120};
2121
2122static struct snd_soc_dai_driver twl4030_dai[] = {
2123{
2124	.name = "twl4030-hifi",
2125	.playback = {
2126		.stream_name = "HiFi Playback",
2127		.channels_min = 2,
2128		.channels_max = 4,
2129		.rates = TWL4030_RATES | SNDRV_PCM_RATE_96000,
2130		.formats = TWL4030_FORMATS,
2131		.sig_bits = 24,},
2132	.capture = {
2133		.stream_name = "HiFi Capture",
2134		.channels_min = 2,
2135		.channels_max = 4,
2136		.rates = TWL4030_RATES,
2137		.formats = TWL4030_FORMATS,
2138		.sig_bits = 24,},
2139	.ops = &twl4030_dai_hifi_ops,
2140},
2141{
2142	.name = "twl4030-voice",
2143	.playback = {
2144		.stream_name = "Voice Playback",
2145		.channels_min = 1,
2146		.channels_max = 1,
2147		.rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2148		.formats = SNDRV_PCM_FMTBIT_S16_LE,},
2149	.capture = {
2150		.stream_name = "Voice Capture",
2151		.channels_min = 1,
2152		.channels_max = 2,
2153		.rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2154		.formats = SNDRV_PCM_FMTBIT_S16_LE,},
2155	.ops = &twl4030_dai_voice_ops,
2156},
2157};
2158
2159static int twl4030_soc_probe(struct snd_soc_component *component)
 
 
 
 
 
 
 
 
 
 
 
 
2160{
2161	struct twl4030_priv *twl4030;
2162
2163	twl4030 = devm_kzalloc(component->dev, sizeof(struct twl4030_priv),
2164			       GFP_KERNEL);
2165	if (!twl4030)
2166		return -ENOMEM;
2167	snd_soc_component_set_drvdata(component, twl4030);
 
2168	/* Set the defaults, and power up the codec */
2169	twl4030->sysclk = twl4030_audio_get_mclk() / 1000;
 
2170
2171	twl4030_init_chip(component);
2172
 
 
 
2173	return 0;
2174}
2175
2176static void twl4030_soc_remove(struct snd_soc_component *component)
2177{
2178	struct twl4030_priv *twl4030 = snd_soc_component_get_drvdata(component);
2179	struct twl4030_board_params *board_params = twl4030->board_params;
2180
2181	if (board_params && board_params->hs_extmute &&
2182	    gpio_is_valid(board_params->hs_extmute_gpio))
2183		gpio_free(board_params->hs_extmute_gpio);
 
 
2184}
2185
2186static const struct snd_soc_component_driver soc_component_dev_twl4030 = {
2187	.probe			= twl4030_soc_probe,
2188	.remove			= twl4030_soc_remove,
2189	.read			= twl4030_read,
2190	.write			= twl4030_write,
2191	.set_bias_level		= twl4030_set_bias_level,
2192	.controls		= twl4030_snd_controls,
2193	.num_controls		= ARRAY_SIZE(twl4030_snd_controls),
2194	.dapm_widgets		= twl4030_dapm_widgets,
2195	.num_dapm_widgets	= ARRAY_SIZE(twl4030_dapm_widgets),
2196	.dapm_routes		= intercon,
2197	.num_dapm_routes	= ARRAY_SIZE(intercon),
2198	.use_pmdown_time	= 1,
2199	.endianness		= 1,
2200};
2201
2202static int twl4030_codec_probe(struct platform_device *pdev)
2203{
2204	return devm_snd_soc_register_component(&pdev->dev,
2205				      &soc_component_dev_twl4030,
2206				      twl4030_dai, ARRAY_SIZE(twl4030_dai));
 
 
 
 
 
 
 
 
 
 
 
 
2207}
2208
2209MODULE_ALIAS("platform:twl4030-codec");
2210
2211static struct platform_driver twl4030_codec_driver = {
2212	.probe		= twl4030_codec_probe,
 
2213	.driver		= {
2214		.name	= "twl4030-codec",
 
2215	},
2216};
2217
2218module_platform_driver(twl4030_codec_driver);
 
 
 
 
 
 
 
 
 
 
2219
2220MODULE_DESCRIPTION("ASoC TWL4030 codec driver");
2221MODULE_AUTHOR("Steve Sakoman");
2222MODULE_LICENSE("GPL");
v3.1
 
   1/*
   2 * ALSA SoC TWL4030 codec driver
   3 *
   4 * Author:      Steve Sakoman, <steve@sakoman.com>
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of the GNU General Public License
   8 * version 2 as published by the Free Software Foundation.
   9 *
  10 * This program is distributed in the hope that it will be useful, but
  11 * WITHOUT ANY WARRANTY; without even the implied warranty of
  12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  13 * General Public License for more details.
  14 *
  15 * You should have received a copy of the GNU General Public License
  16 * along with this program; if not, write to the Free Software
  17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
  18 * 02110-1301 USA
  19 *
  20 */
  21
  22#include <linux/module.h>
  23#include <linux/moduleparam.h>
  24#include <linux/init.h>
  25#include <linux/delay.h>
  26#include <linux/pm.h>
  27#include <linux/i2c.h>
  28#include <linux/platform_device.h>
  29#include <linux/i2c/twl.h>
 
 
  30#include <linux/slab.h>
 
  31#include <sound/core.h>
  32#include <sound/pcm.h>
  33#include <sound/pcm_params.h>
  34#include <sound/soc.h>
  35#include <sound/initval.h>
  36#include <sound/tlv.h>
  37
  38/* Register descriptions are here */
  39#include <linux/mfd/twl4030-audio.h>
  40
  41/* Shadow register used by the audio driver */
  42#define TWL4030_REG_SW_SHADOW		0x4A
  43#define TWL4030_CACHEREGNUM	(TWL4030_REG_SW_SHADOW + 1)
  44
  45/* TWL4030_REG_SW_SHADOW (0x4A) Fields */
  46#define TWL4030_HFL_EN			0x01
  47#define TWL4030_HFR_EN			0x02
  48
  49/*
  50 * twl4030 register cache & default register settings
  51 */
  52static const u8 twl4030_reg[TWL4030_CACHEREGNUM] = {
  53	0x00, /* this register not used		*/
  54	0x00, /* REG_CODEC_MODE		(0x1)	*/
  55	0x00, /* REG_OPTION		(0x2)	*/
  56	0x00, /* REG_UNKNOWN		(0x3)	*/
  57	0x00, /* REG_MICBIAS_CTL	(0x4)	*/
  58	0x00, /* REG_ANAMICL		(0x5)	*/
  59	0x00, /* REG_ANAMICR		(0x6)	*/
  60	0x00, /* REG_AVADC_CTL		(0x7)	*/
  61	0x00, /* REG_ADCMICSEL		(0x8)	*/
  62	0x00, /* REG_DIGMIXING		(0x9)	*/
  63	0x0f, /* REG_ATXL1PGA		(0xA)	*/
  64	0x0f, /* REG_ATXR1PGA		(0xB)	*/
  65	0x0f, /* REG_AVTXL2PGA		(0xC)	*/
  66	0x0f, /* REG_AVTXR2PGA		(0xD)	*/
  67	0x00, /* REG_AUDIO_IF		(0xE)	*/
  68	0x00, /* REG_VOICE_IF		(0xF)	*/
  69	0x3f, /* REG_ARXR1PGA		(0x10)	*/
  70	0x3f, /* REG_ARXL1PGA		(0x11)	*/
  71	0x3f, /* REG_ARXR2PGA		(0x12)	*/
  72	0x3f, /* REG_ARXL2PGA		(0x13)	*/
  73	0x25, /* REG_VRXPGA		(0x14)	*/
  74	0x00, /* REG_VSTPGA		(0x15)	*/
  75	0x00, /* REG_VRX2ARXPGA		(0x16)	*/
  76	0x00, /* REG_AVDAC_CTL		(0x17)	*/
  77	0x00, /* REG_ARX2VTXPGA		(0x18)	*/
  78	0x32, /* REG_ARXL1_APGA_CTL	(0x19)	*/
  79	0x32, /* REG_ARXR1_APGA_CTL	(0x1A)	*/
  80	0x32, /* REG_ARXL2_APGA_CTL	(0x1B)	*/
  81	0x32, /* REG_ARXR2_APGA_CTL	(0x1C)	*/
  82	0x00, /* REG_ATX2ARXPGA		(0x1D)	*/
  83	0x00, /* REG_BT_IF		(0x1E)	*/
  84	0x55, /* REG_BTPGA		(0x1F)	*/
  85	0x00, /* REG_BTSTPGA		(0x20)	*/
  86	0x00, /* REG_EAR_CTL		(0x21)	*/
  87	0x00, /* REG_HS_SEL		(0x22)	*/
  88	0x00, /* REG_HS_GAIN_SET	(0x23)	*/
  89	0x00, /* REG_HS_POPN_SET	(0x24)	*/
  90	0x00, /* REG_PREDL_CTL		(0x25)	*/
  91	0x00, /* REG_PREDR_CTL		(0x26)	*/
  92	0x00, /* REG_PRECKL_CTL		(0x27)	*/
  93	0x00, /* REG_PRECKR_CTL		(0x28)	*/
  94	0x00, /* REG_HFL_CTL		(0x29)	*/
  95	0x00, /* REG_HFR_CTL		(0x2A)	*/
  96	0x05, /* REG_ALC_CTL		(0x2B)	*/
  97	0x00, /* REG_ALC_SET1		(0x2C)	*/
  98	0x00, /* REG_ALC_SET2		(0x2D)	*/
  99	0x00, /* REG_BOOST_CTL		(0x2E)	*/
 100	0x00, /* REG_SOFTVOL_CTL	(0x2F)	*/
 101	0x13, /* REG_DTMF_FREQSEL	(0x30)	*/
 102	0x00, /* REG_DTMF_TONEXT1H	(0x31)	*/
 103	0x00, /* REG_DTMF_TONEXT1L	(0x32)	*/
 104	0x00, /* REG_DTMF_TONEXT2H	(0x33)	*/
 105	0x00, /* REG_DTMF_TONEXT2L	(0x34)	*/
 106	0x79, /* REG_DTMF_TONOFF	(0x35)	*/
 107	0x11, /* REG_DTMF_WANONOFF	(0x36)	*/
 108	0x00, /* REG_I2S_RX_SCRAMBLE_H	(0x37)	*/
 109	0x00, /* REG_I2S_RX_SCRAMBLE_M	(0x38)	*/
 110	0x00, /* REG_I2S_RX_SCRAMBLE_L	(0x39)	*/
 111	0x06, /* REG_APLL_CTL		(0x3A)	*/
 112	0x00, /* REG_DTMF_CTL		(0x3B)	*/
 113	0x44, /* REG_DTMF_PGA_CTL2	(0x3C)	*/
 114	0x69, /* REG_DTMF_PGA_CTL1	(0x3D)	*/
 115	0x00, /* REG_MISC_SET_1		(0x3E)	*/
 116	0x00, /* REG_PCMBTMUX		(0x3F)	*/
 117	0x00, /* not used		(0x40)	*/
 118	0x00, /* not used		(0x41)	*/
 119	0x00, /* not used		(0x42)	*/
 120	0x00, /* REG_RX_PATH_SEL	(0x43)	*/
 121	0x32, /* REG_VDL_APGA_CTL	(0x44)	*/
 122	0x00, /* REG_VIBRA_CTL		(0x45)	*/
 123	0x00, /* REG_VIBRA_SET		(0x46)	*/
 124	0x00, /* REG_VIBRA_PWM_SET	(0x47)	*/
 125	0x00, /* REG_ANAMIC_GAIN	(0x48)	*/
 126	0x00, /* REG_MISC_SET_2		(0x49)	*/
 127	0x00, /* REG_SW_SHADOW		(0x4A)	- Shadow, non HW register */
 128};
 129
 130/* codec private data */
 131struct twl4030_priv {
 132	struct snd_soc_codec codec;
 133
 134	unsigned int codec_powered;
 135
 136	/* reference counts of AIF/APLL users */
 137	unsigned int apll_enabled;
 138
 139	struct snd_pcm_substream *master_substream;
 140	struct snd_pcm_substream *slave_substream;
 141
 142	unsigned int configured;
 143	unsigned int rate;
 144	unsigned int sample_bits;
 145	unsigned int channels;
 146
 147	unsigned int sysclk;
 148
 149	/* Output (with associated amp) states */
 150	u8 hsl_enabled, hsr_enabled;
 151	u8 earpiece_enabled;
 152	u8 predrivel_enabled, predriver_enabled;
 153	u8 carkitl_enabled, carkitr_enabled;
 
 154
 155	/* Delay needed after enabling the digimic interface */
 156	unsigned int digimic_delay;
 157};
 158
 159/*
 160 * read twl4030 register cache
 161 */
 162static inline unsigned int twl4030_read_reg_cache(struct snd_soc_codec *codec,
 163	unsigned int reg)
 
 
 
 
 
 
 
 164{
 165	u8 *cache = codec->reg_cache;
 
 166
 167	if (reg >= TWL4030_CACHEREGNUM)
 168		return -EIO;
 169
 170	return cache[reg];
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 171}
 172
 173/*
 174 * write twl4030 register cache
 175 */
 176static inline void twl4030_write_reg_cache(struct snd_soc_codec *codec,
 177						u8 reg, u8 value)
 178{
 179	u8 *cache = codec->reg_cache;
 180
 181	if (reg >= TWL4030_CACHEREGNUM)
 182		return;
 183	cache[reg] = value;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 184}
 185
 186/*
 187 * write to the twl4030 register space
 188 */
 189static int twl4030_write(struct snd_soc_codec *codec,
 190			unsigned int reg, unsigned int value)
 191{
 192	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 193	int write_to_reg = 0;
 194
 195	twl4030_write_reg_cache(codec, reg, value);
 196	if (likely(reg < TWL4030_REG_SW_SHADOW)) {
 197		/* Decide if the given register can be written */
 198		switch (reg) {
 199		case TWL4030_REG_EAR_CTL:
 200			if (twl4030->earpiece_enabled)
 201				write_to_reg = 1;
 202			break;
 203		case TWL4030_REG_PREDL_CTL:
 204			if (twl4030->predrivel_enabled)
 205				write_to_reg = 1;
 206			break;
 207		case TWL4030_REG_PREDR_CTL:
 208			if (twl4030->predriver_enabled)
 209				write_to_reg = 1;
 210			break;
 211		case TWL4030_REG_PRECKL_CTL:
 212			if (twl4030->carkitl_enabled)
 213				write_to_reg = 1;
 214			break;
 215		case TWL4030_REG_PRECKR_CTL:
 216			if (twl4030->carkitr_enabled)
 217				write_to_reg = 1;
 218			break;
 219		case TWL4030_REG_HS_GAIN_SET:
 220			if (twl4030->hsl_enabled || twl4030->hsr_enabled)
 221				write_to_reg = 1;
 222			break;
 223		default:
 224			/* All other register can be written */
 225			write_to_reg = 1;
 226			break;
 227		}
 228		if (write_to_reg)
 229			return twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
 230						    value, reg);
 231	}
 
 
 
 
 232	return 0;
 233}
 234
 235static inline void twl4030_wait_ms(int time)
 236{
 237	if (time < 60) {
 238		time *= 1000;
 239		usleep_range(time, time + 500);
 240	} else {
 241		msleep(time);
 242	}
 243}
 244
 245static void twl4030_codec_enable(struct snd_soc_codec *codec, int enable)
 246{
 247	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 248	int mode;
 249
 250	if (enable == twl4030->codec_powered)
 251		return;
 252
 253	if (enable)
 254		mode = twl4030_audio_enable_resource(TWL4030_AUDIO_RES_POWER);
 255	else
 256		mode = twl4030_audio_disable_resource(TWL4030_AUDIO_RES_POWER);
 257
 258	if (mode >= 0) {
 259		twl4030_write_reg_cache(codec, TWL4030_REG_CODEC_MODE, mode);
 260		twl4030->codec_powered = enable;
 261	}
 262
 263	/* REVISIT: this delay is present in TI sample drivers */
 264	/* but there seems to be no TRM requirement for it     */
 265	udelay(10);
 266}
 267
 268static inline void twl4030_check_defaults(struct snd_soc_codec *codec)
 269{
 270	int i, difference = 0;
 271	u8 val;
 272
 273	dev_dbg(codec->dev, "Checking TWL audio default configuration\n");
 274	for (i = 1; i <= TWL4030_REG_MISC_SET_2; i++) {
 275		twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &val, i);
 276		if (val != twl4030_reg[i]) {
 277			difference++;
 278			dev_dbg(codec->dev,
 279				 "Reg 0x%02x: chip: 0x%02x driver: 0x%02x\n",
 280				 i, val, twl4030_reg[i]);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 281		}
 
 
 282	}
 283	dev_dbg(codec->dev, "Found %d non-matching registers. %s\n",
 284		 difference, difference ? "Not OK" : "OK");
 285}
 286
 287static inline void twl4030_reset_registers(struct snd_soc_codec *codec)
 288{
 289	int i;
 
 
 
 290
 291	/* set all audio section registers to reasonable defaults */
 292	for (i = TWL4030_REG_OPTION; i <= TWL4030_REG_MISC_SET_2; i++)
 293		if (i != TWL4030_REG_APLL_CTL)
 294			twl4030_write(codec, i, twl4030_reg[i]);
 295
 296}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 297
 298static void twl4030_init_chip(struct snd_soc_codec *codec)
 299{
 300	struct twl4030_codec_data *pdata = dev_get_platdata(codec->dev);
 301	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 302	u8 reg, byte;
 303	int i = 0;
 
 
 
 304
 305	/* Check defaults, if instructed before anything else */
 306	if (pdata && pdata->check_defaults)
 307		twl4030_check_defaults(codec);
 308
 309	/* Reset registers, if no setup data or if instructed to do so */
 310	if (!pdata || (pdata && pdata->reset_registers))
 311		twl4030_reset_registers(codec);
 312
 313	/* Refresh APLL_CTL register from HW */
 314	twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
 315			    TWL4030_REG_APLL_CTL);
 316	twl4030_write_reg_cache(codec, TWL4030_REG_APLL_CTL, byte);
 317
 318	/* anti-pop when changing analog gain */
 319	reg = twl4030_read_reg_cache(codec, TWL4030_REG_MISC_SET_1);
 320	twl4030_write(codec, TWL4030_REG_MISC_SET_1,
 321		reg | TWL4030_SMOOTH_ANAVOL_EN);
 322
 323	twl4030_write(codec, TWL4030_REG_OPTION,
 324		TWL4030_ATXL1_EN | TWL4030_ATXR1_EN |
 325		TWL4030_ARXL2_EN | TWL4030_ARXR2_EN);
 326
 327	/* REG_ARXR2_APGA_CTL reset according to the TRM: 0dB, DA_EN */
 328	twl4030_write(codec, TWL4030_REG_ARXR2_APGA_CTL, 0x32);
 329
 330	/* Machine dependent setup */
 331	if (!pdata)
 332		return;
 333
 334	twl4030->digimic_delay = pdata->digimic_delay;
 335
 336	reg = twl4030_read_reg_cache(codec, TWL4030_REG_HS_POPN_SET);
 337	reg &= ~TWL4030_RAMP_DELAY;
 338	reg |= (pdata->ramp_delay_value << 2);
 339	twl4030_write_reg_cache(codec, TWL4030_REG_HS_POPN_SET, reg);
 340
 341	/* initiate offset cancellation */
 342	twl4030_codec_enable(codec, 1);
 343
 344	reg = twl4030_read_reg_cache(codec, TWL4030_REG_ANAMICL);
 345	reg &= ~TWL4030_OFFSET_CNCL_SEL;
 346	reg |= pdata->offset_cncl_path;
 347	twl4030_write(codec, TWL4030_REG_ANAMICL,
 348		reg | TWL4030_CNCL_OFFSET_START);
 349
 350	/*
 351	 * Wait for offset cancellation to complete.
 352	 * Since this takes a while, do not slam the i2c.
 353	 * Start polling the status after ~20ms.
 354	 */
 355	msleep(20);
 356	do {
 357		usleep_range(1000, 2000);
 
 358		twl_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
 359				    TWL4030_REG_ANAMICL);
 
 360	} while ((i++ < 100) &&
 361		 ((byte & TWL4030_CNCL_OFFSET_START) ==
 362		  TWL4030_CNCL_OFFSET_START));
 363
 364	/* Make sure that the reg_cache has the same value as the HW */
 365	twl4030_write_reg_cache(codec, TWL4030_REG_ANAMICL, byte);
 366
 367	twl4030_codec_enable(codec, 0);
 368}
 369
 370static void twl4030_apll_enable(struct snd_soc_codec *codec, int enable)
 371{
 372	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 373	int status = -1;
 374
 375	if (enable) {
 376		twl4030->apll_enabled++;
 377		if (twl4030->apll_enabled == 1)
 378			status = twl4030_audio_enable_resource(
 379							TWL4030_AUDIO_RES_APLL);
 380	} else {
 381		twl4030->apll_enabled--;
 382		if (!twl4030->apll_enabled)
 383			status = twl4030_audio_disable_resource(
 384							TWL4030_AUDIO_RES_APLL);
 385	}
 386
 387	if (status >= 0)
 388		twl4030_write_reg_cache(codec, TWL4030_REG_APLL_CTL, status);
 389}
 390
 391/* Earpiece */
 392static const struct snd_kcontrol_new twl4030_dapm_earpiece_controls[] = {
 393	SOC_DAPM_SINGLE("Voice", TWL4030_REG_EAR_CTL, 0, 1, 0),
 394	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_EAR_CTL, 1, 1, 0),
 395	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_EAR_CTL, 2, 1, 0),
 396	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_EAR_CTL, 3, 1, 0),
 397};
 398
 399/* PreDrive Left */
 400static const struct snd_kcontrol_new twl4030_dapm_predrivel_controls[] = {
 401	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDL_CTL, 0, 1, 0),
 402	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PREDL_CTL, 1, 1, 0),
 403	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDL_CTL, 2, 1, 0),
 404	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDL_CTL, 3, 1, 0),
 405};
 406
 407/* PreDrive Right */
 408static const struct snd_kcontrol_new twl4030_dapm_predriver_controls[] = {
 409	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDR_CTL, 0, 1, 0),
 410	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PREDR_CTL, 1, 1, 0),
 411	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDR_CTL, 2, 1, 0),
 412	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDR_CTL, 3, 1, 0),
 413};
 414
 415/* Headset Left */
 416static const struct snd_kcontrol_new twl4030_dapm_hsol_controls[] = {
 417	SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 0, 1, 0),
 418	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_HS_SEL, 1, 1, 0),
 419	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_HS_SEL, 2, 1, 0),
 420};
 421
 422/* Headset Right */
 423static const struct snd_kcontrol_new twl4030_dapm_hsor_controls[] = {
 424	SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 3, 1, 0),
 425	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_HS_SEL, 4, 1, 0),
 426	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_HS_SEL, 5, 1, 0),
 427};
 428
 429/* Carkit Left */
 430static const struct snd_kcontrol_new twl4030_dapm_carkitl_controls[] = {
 431	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKL_CTL, 0, 1, 0),
 432	SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PRECKL_CTL, 1, 1, 0),
 433	SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PRECKL_CTL, 2, 1, 0),
 434};
 435
 436/* Carkit Right */
 437static const struct snd_kcontrol_new twl4030_dapm_carkitr_controls[] = {
 438	SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKR_CTL, 0, 1, 0),
 439	SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PRECKR_CTL, 1, 1, 0),
 440	SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PRECKR_CTL, 2, 1, 0),
 441};
 442
 443/* Handsfree Left */
 444static const char *twl4030_handsfreel_texts[] =
 445		{"Voice", "AudioL1", "AudioL2", "AudioR2"};
 446
 447static const struct soc_enum twl4030_handsfreel_enum =
 448	SOC_ENUM_SINGLE(TWL4030_REG_HFL_CTL, 0,
 449			ARRAY_SIZE(twl4030_handsfreel_texts),
 450			twl4030_handsfreel_texts);
 451
 452static const struct snd_kcontrol_new twl4030_dapm_handsfreel_control =
 453SOC_DAPM_ENUM("Route", twl4030_handsfreel_enum);
 454
 455/* Handsfree Left virtual mute */
 456static const struct snd_kcontrol_new twl4030_dapm_handsfreelmute_control =
 457	SOC_DAPM_SINGLE("Switch", TWL4030_REG_SW_SHADOW, 0, 1, 0);
 458
 459/* Handsfree Right */
 460static const char *twl4030_handsfreer_texts[] =
 461		{"Voice", "AudioR1", "AudioR2", "AudioL2"};
 462
 463static const struct soc_enum twl4030_handsfreer_enum =
 464	SOC_ENUM_SINGLE(TWL4030_REG_HFR_CTL, 0,
 465			ARRAY_SIZE(twl4030_handsfreer_texts),
 466			twl4030_handsfreer_texts);
 467
 468static const struct snd_kcontrol_new twl4030_dapm_handsfreer_control =
 469SOC_DAPM_ENUM("Route", twl4030_handsfreer_enum);
 470
 471/* Handsfree Right virtual mute */
 472static const struct snd_kcontrol_new twl4030_dapm_handsfreermute_control =
 473	SOC_DAPM_SINGLE("Switch", TWL4030_REG_SW_SHADOW, 1, 1, 0);
 474
 475/* Vibra */
 476/* Vibra audio path selection */
 477static const char *twl4030_vibra_texts[] =
 478		{"AudioL1", "AudioR1", "AudioL2", "AudioR2"};
 479
 480static const struct soc_enum twl4030_vibra_enum =
 481	SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 2,
 482			ARRAY_SIZE(twl4030_vibra_texts),
 483			twl4030_vibra_texts);
 484
 485static const struct snd_kcontrol_new twl4030_dapm_vibra_control =
 486SOC_DAPM_ENUM("Route", twl4030_vibra_enum);
 487
 488/* Vibra path selection: local vibrator (PWM) or audio driven */
 489static const char *twl4030_vibrapath_texts[] =
 490		{"Local vibrator", "Audio"};
 491
 492static const struct soc_enum twl4030_vibrapath_enum =
 493	SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 4,
 494			ARRAY_SIZE(twl4030_vibrapath_texts),
 495			twl4030_vibrapath_texts);
 496
 497static const struct snd_kcontrol_new twl4030_dapm_vibrapath_control =
 498SOC_DAPM_ENUM("Route", twl4030_vibrapath_enum);
 499
 500/* Left analog microphone selection */
 501static const struct snd_kcontrol_new twl4030_dapm_analoglmic_controls[] = {
 502	SOC_DAPM_SINGLE("Main Mic Capture Switch",
 503			TWL4030_REG_ANAMICL, 0, 1, 0),
 504	SOC_DAPM_SINGLE("Headset Mic Capture Switch",
 505			TWL4030_REG_ANAMICL, 1, 1, 0),
 506	SOC_DAPM_SINGLE("AUXL Capture Switch",
 507			TWL4030_REG_ANAMICL, 2, 1, 0),
 508	SOC_DAPM_SINGLE("Carkit Mic Capture Switch",
 509			TWL4030_REG_ANAMICL, 3, 1, 0),
 510};
 511
 512/* Right analog microphone selection */
 513static const struct snd_kcontrol_new twl4030_dapm_analogrmic_controls[] = {
 514	SOC_DAPM_SINGLE("Sub Mic Capture Switch", TWL4030_REG_ANAMICR, 0, 1, 0),
 515	SOC_DAPM_SINGLE("AUXR Capture Switch", TWL4030_REG_ANAMICR, 2, 1, 0),
 516};
 517
 518/* TX1 L/R Analog/Digital microphone selection */
 519static const char *twl4030_micpathtx1_texts[] =
 520		{"Analog", "Digimic0"};
 521
 522static const struct soc_enum twl4030_micpathtx1_enum =
 523	SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 0,
 524			ARRAY_SIZE(twl4030_micpathtx1_texts),
 525			twl4030_micpathtx1_texts);
 526
 527static const struct snd_kcontrol_new twl4030_dapm_micpathtx1_control =
 528SOC_DAPM_ENUM("Route", twl4030_micpathtx1_enum);
 529
 530/* TX2 L/R Analog/Digital microphone selection */
 531static const char *twl4030_micpathtx2_texts[] =
 532		{"Analog", "Digimic1"};
 533
 534static const struct soc_enum twl4030_micpathtx2_enum =
 535	SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 2,
 536			ARRAY_SIZE(twl4030_micpathtx2_texts),
 537			twl4030_micpathtx2_texts);
 538
 539static const struct snd_kcontrol_new twl4030_dapm_micpathtx2_control =
 540SOC_DAPM_ENUM("Route", twl4030_micpathtx2_enum);
 541
 542/* Analog bypass for AudioR1 */
 543static const struct snd_kcontrol_new twl4030_dapm_abypassr1_control =
 544	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR1_APGA_CTL, 2, 1, 0);
 545
 546/* Analog bypass for AudioL1 */
 547static const struct snd_kcontrol_new twl4030_dapm_abypassl1_control =
 548	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL1_APGA_CTL, 2, 1, 0);
 549
 550/* Analog bypass for AudioR2 */
 551static const struct snd_kcontrol_new twl4030_dapm_abypassr2_control =
 552	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR2_APGA_CTL, 2, 1, 0);
 553
 554/* Analog bypass for AudioL2 */
 555static const struct snd_kcontrol_new twl4030_dapm_abypassl2_control =
 556	SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL2_APGA_CTL, 2, 1, 0);
 557
 558/* Analog bypass for Voice */
 559static const struct snd_kcontrol_new twl4030_dapm_abypassv_control =
 560	SOC_DAPM_SINGLE("Switch", TWL4030_REG_VDL_APGA_CTL, 2, 1, 0);
 561
 562/* Digital bypass gain, mute instead of -30dB */
 563static const unsigned int twl4030_dapm_dbypass_tlv[] = {
 564	TLV_DB_RANGE_HEAD(3),
 565	0, 1, TLV_DB_SCALE_ITEM(-3000, 600, 1),
 566	2, 3, TLV_DB_SCALE_ITEM(-2400, 0, 0),
 567	4, 7, TLV_DB_SCALE_ITEM(-1800, 600, 0),
 568};
 569
 570/* Digital bypass left (TX1L -> RX2L) */
 571static const struct snd_kcontrol_new twl4030_dapm_dbypassl_control =
 572	SOC_DAPM_SINGLE_TLV("Volume",
 573			TWL4030_REG_ATX2ARXPGA, 3, 7, 0,
 574			twl4030_dapm_dbypass_tlv);
 575
 576/* Digital bypass right (TX1R -> RX2R) */
 577static const struct snd_kcontrol_new twl4030_dapm_dbypassr_control =
 578	SOC_DAPM_SINGLE_TLV("Volume",
 579			TWL4030_REG_ATX2ARXPGA, 0, 7, 0,
 580			twl4030_dapm_dbypass_tlv);
 581
 582/*
 583 * Voice Sidetone GAIN volume control:
 584 * from -51 to -10 dB in 1 dB steps (mute instead of -51 dB)
 585 */
 586static DECLARE_TLV_DB_SCALE(twl4030_dapm_dbypassv_tlv, -5100, 100, 1);
 587
 588/* Digital bypass voice: sidetone (VUL -> VDL)*/
 589static const struct snd_kcontrol_new twl4030_dapm_dbypassv_control =
 590	SOC_DAPM_SINGLE_TLV("Volume",
 591			TWL4030_REG_VSTPGA, 0, 0x29, 0,
 592			twl4030_dapm_dbypassv_tlv);
 593
 594/*
 595 * Output PGA builder:
 596 * Handle the muting and unmuting of the given output (turning off the
 597 * amplifier associated with the output pin)
 598 * On mute bypass the reg_cache and write 0 to the register
 599 * On unmute: restore the register content from the reg_cache
 600 * Outputs handled in this way:  Earpiece, PreDrivL/R, CarkitL/R
 601 */
 602#define TWL4030_OUTPUT_PGA(pin_name, reg, mask)				\
 603static int pin_name##pga_event(struct snd_soc_dapm_widget *w,		\
 604		struct snd_kcontrol *kcontrol, int event)		\
 605{									\
 606	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(w->codec); \
 
 607									\
 608	switch (event) {						\
 609	case SND_SOC_DAPM_POST_PMU:					\
 610		twl4030->pin_name##_enabled = 1;			\
 611		twl4030_write(w->codec, reg,				\
 612			twl4030_read_reg_cache(w->codec, reg));		\
 613		break;							\
 614	case SND_SOC_DAPM_POST_PMD:					\
 615		twl4030->pin_name##_enabled = 0;			\
 616		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,		\
 617					0, reg);			\
 618		break;							\
 619	}								\
 620	return 0;							\
 621}
 622
 623TWL4030_OUTPUT_PGA(earpiece, TWL4030_REG_EAR_CTL, TWL4030_EAR_GAIN);
 624TWL4030_OUTPUT_PGA(predrivel, TWL4030_REG_PREDL_CTL, TWL4030_PREDL_GAIN);
 625TWL4030_OUTPUT_PGA(predriver, TWL4030_REG_PREDR_CTL, TWL4030_PREDR_GAIN);
 626TWL4030_OUTPUT_PGA(carkitl, TWL4030_REG_PRECKL_CTL, TWL4030_PRECKL_GAIN);
 627TWL4030_OUTPUT_PGA(carkitr, TWL4030_REG_PRECKR_CTL, TWL4030_PRECKR_GAIN);
 628
 629static void handsfree_ramp(struct snd_soc_codec *codec, int reg, int ramp)
 630{
 631	unsigned char hs_ctl;
 632
 633	hs_ctl = twl4030_read_reg_cache(codec, reg);
 634
 635	if (ramp) {
 636		/* HF ramp-up */
 637		hs_ctl |= TWL4030_HF_CTL_REF_EN;
 638		twl4030_write(codec, reg, hs_ctl);
 639		udelay(10);
 640		hs_ctl |= TWL4030_HF_CTL_RAMP_EN;
 641		twl4030_write(codec, reg, hs_ctl);
 642		udelay(40);
 643		hs_ctl |= TWL4030_HF_CTL_LOOP_EN;
 644		hs_ctl |= TWL4030_HF_CTL_HB_EN;
 645		twl4030_write(codec, reg, hs_ctl);
 646	} else {
 647		/* HF ramp-down */
 648		hs_ctl &= ~TWL4030_HF_CTL_LOOP_EN;
 649		hs_ctl &= ~TWL4030_HF_CTL_HB_EN;
 650		twl4030_write(codec, reg, hs_ctl);
 651		hs_ctl &= ~TWL4030_HF_CTL_RAMP_EN;
 652		twl4030_write(codec, reg, hs_ctl);
 653		udelay(40);
 654		hs_ctl &= ~TWL4030_HF_CTL_REF_EN;
 655		twl4030_write(codec, reg, hs_ctl);
 656	}
 657}
 658
 659static int handsfreelpga_event(struct snd_soc_dapm_widget *w,
 660		struct snd_kcontrol *kcontrol, int event)
 661{
 
 
 662	switch (event) {
 663	case SND_SOC_DAPM_POST_PMU:
 664		handsfree_ramp(w->codec, TWL4030_REG_HFL_CTL, 1);
 665		break;
 666	case SND_SOC_DAPM_POST_PMD:
 667		handsfree_ramp(w->codec, TWL4030_REG_HFL_CTL, 0);
 668		break;
 669	}
 670	return 0;
 671}
 672
 673static int handsfreerpga_event(struct snd_soc_dapm_widget *w,
 674		struct snd_kcontrol *kcontrol, int event)
 675{
 
 
 676	switch (event) {
 677	case SND_SOC_DAPM_POST_PMU:
 678		handsfree_ramp(w->codec, TWL4030_REG_HFR_CTL, 1);
 679		break;
 680	case SND_SOC_DAPM_POST_PMD:
 681		handsfree_ramp(w->codec, TWL4030_REG_HFR_CTL, 0);
 682		break;
 683	}
 684	return 0;
 685}
 686
 687static int vibramux_event(struct snd_soc_dapm_widget *w,
 688		struct snd_kcontrol *kcontrol, int event)
 689{
 690	twl4030_write(w->codec, TWL4030_REG_VIBRA_SET, 0xff);
 
 
 691	return 0;
 692}
 693
 694static int apll_event(struct snd_soc_dapm_widget *w,
 695		struct snd_kcontrol *kcontrol, int event)
 696{
 
 
 697	switch (event) {
 698	case SND_SOC_DAPM_PRE_PMU:
 699		twl4030_apll_enable(w->codec, 1);
 700		break;
 701	case SND_SOC_DAPM_POST_PMD:
 702		twl4030_apll_enable(w->codec, 0);
 703		break;
 704	}
 705	return 0;
 706}
 707
 708static int aif_event(struct snd_soc_dapm_widget *w,
 709		struct snd_kcontrol *kcontrol, int event)
 710{
 
 711	u8 audio_if;
 712
 713	audio_if = twl4030_read_reg_cache(w->codec, TWL4030_REG_AUDIO_IF);
 714	switch (event) {
 715	case SND_SOC_DAPM_PRE_PMU:
 716		/* Enable AIF */
 717		/* enable the PLL before we use it to clock the DAI */
 718		twl4030_apll_enable(w->codec, 1);
 719
 720		twl4030_write(w->codec, TWL4030_REG_AUDIO_IF,
 721						audio_if | TWL4030_AIF_EN);
 722		break;
 723	case SND_SOC_DAPM_POST_PMD:
 724		/* disable the DAI before we stop it's source PLL */
 725		twl4030_write(w->codec, TWL4030_REG_AUDIO_IF,
 726						audio_if &  ~TWL4030_AIF_EN);
 727		twl4030_apll_enable(w->codec, 0);
 728		break;
 729	}
 730	return 0;
 731}
 732
 733static void headset_ramp(struct snd_soc_codec *codec, int ramp)
 734{
 735	struct twl4030_codec_data *pdata = codec->dev->platform_data;
 736	unsigned char hs_gain, hs_pop;
 737	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 
 738	/* Base values for ramp delay calculation: 2^19 - 2^26 */
 739	unsigned int ramp_base[] = {524288, 1048576, 2097152, 4194304,
 740				    8388608, 16777216, 33554432, 67108864};
 
 
 741	unsigned int delay;
 742
 743	hs_gain = twl4030_read_reg_cache(codec, TWL4030_REG_HS_GAIN_SET);
 744	hs_pop = twl4030_read_reg_cache(codec, TWL4030_REG_HS_POPN_SET);
 745	delay = (ramp_base[(hs_pop & TWL4030_RAMP_DELAY) >> 2] /
 746		twl4030->sysclk) + 1;
 747
 748	/* Enable external mute control, this dramatically reduces
 749	 * the pop-noise */
 750	if (pdata && pdata->hs_extmute) {
 751		if (pdata->set_hs_extmute) {
 752			pdata->set_hs_extmute(1);
 753		} else {
 754			hs_pop |= TWL4030_EXTMUTE;
 755			twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 756		}
 757	}
 758
 759	if (ramp) {
 760		/* Headset ramp-up according to the TRM */
 761		hs_pop |= TWL4030_VMID_EN;
 762		twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 763		/* Actually write to the register */
 764		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
 765					hs_gain,
 766					TWL4030_REG_HS_GAIN_SET);
 767		hs_pop |= TWL4030_RAMP_EN;
 768		twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 769		/* Wait ramp delay time + 1, so the VMID can settle */
 770		twl4030_wait_ms(delay);
 771	} else {
 772		/* Headset ramp-down _not_ according to
 773		 * the TRM, but in a way that it is working */
 774		hs_pop &= ~TWL4030_RAMP_EN;
 775		twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 776		/* Wait ramp delay time + 1, so the VMID can settle */
 777		twl4030_wait_ms(delay);
 778		/* Bypass the reg_cache to mute the headset */
 779		twl_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
 780					hs_gain & (~0x0f),
 781					TWL4030_REG_HS_GAIN_SET);
 782
 783		hs_pop &= ~TWL4030_VMID_EN;
 784		twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 785	}
 786
 787	/* Disable external mute */
 788	if (pdata && pdata->hs_extmute) {
 789		if (pdata->set_hs_extmute) {
 790			pdata->set_hs_extmute(0);
 791		} else {
 792			hs_pop &= ~TWL4030_EXTMUTE;
 793			twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
 794		}
 795	}
 796}
 797
 798static int headsetlpga_event(struct snd_soc_dapm_widget *w,
 799		struct snd_kcontrol *kcontrol, int event)
 800{
 801	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(w->codec);
 
 802
 803	switch (event) {
 804	case SND_SOC_DAPM_POST_PMU:
 805		/* Do the ramp-up only once */
 806		if (!twl4030->hsr_enabled)
 807			headset_ramp(w->codec, 1);
 808
 809		twl4030->hsl_enabled = 1;
 810		break;
 811	case SND_SOC_DAPM_POST_PMD:
 812		/* Do the ramp-down only if both headsetL/R is disabled */
 813		if (!twl4030->hsr_enabled)
 814			headset_ramp(w->codec, 0);
 815
 816		twl4030->hsl_enabled = 0;
 817		break;
 818	}
 819	return 0;
 820}
 821
 822static int headsetrpga_event(struct snd_soc_dapm_widget *w,
 823		struct snd_kcontrol *kcontrol, int event)
 824{
 825	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(w->codec);
 
 826
 827	switch (event) {
 828	case SND_SOC_DAPM_POST_PMU:
 829		/* Do the ramp-up only once */
 830		if (!twl4030->hsl_enabled)
 831			headset_ramp(w->codec, 1);
 832
 833		twl4030->hsr_enabled = 1;
 834		break;
 835	case SND_SOC_DAPM_POST_PMD:
 836		/* Do the ramp-down only if both headsetL/R is disabled */
 837		if (!twl4030->hsl_enabled)
 838			headset_ramp(w->codec, 0);
 839
 840		twl4030->hsr_enabled = 0;
 841		break;
 842	}
 843	return 0;
 844}
 845
 846static int digimic_event(struct snd_soc_dapm_widget *w,
 847		struct snd_kcontrol *kcontrol, int event)
 848{
 849	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(w->codec);
 
 
 850
 851	if (twl4030->digimic_delay)
 852		twl4030_wait_ms(twl4030->digimic_delay);
 853	return 0;
 854}
 855
 856/*
 857 * Some of the gain controls in TWL (mostly those which are associated with
 858 * the outputs) are implemented in an interesting way:
 859 * 0x0 : Power down (mute)
 860 * 0x1 : 6dB
 861 * 0x2 : 0 dB
 862 * 0x3 : -6 dB
 863 * Inverting not going to help with these.
 864 * Custom volsw and volsw_2r get/put functions to handle these gain bits.
 865 */
 866#define SOC_DOUBLE_TLV_TWL4030(xname, xreg, shift_left, shift_right, xmax,\
 867			       xinvert, tlv_array) \
 868{	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
 869	.access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
 870		 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
 871	.tlv.p = (tlv_array), \
 872	.info = snd_soc_info_volsw, \
 873	.get = snd_soc_get_volsw_twl4030, \
 874	.put = snd_soc_put_volsw_twl4030, \
 875	.private_value = (unsigned long)&(struct soc_mixer_control) \
 876		{.reg = xreg, .shift = shift_left, .rshift = shift_right,\
 877		 .max = xmax, .invert = xinvert} }
 878#define SOC_DOUBLE_R_TLV_TWL4030(xname, reg_left, reg_right, xshift, xmax,\
 879				 xinvert, tlv_array) \
 880{	.iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
 881	.access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
 882		 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
 883	.tlv.p = (tlv_array), \
 884	.info = snd_soc_info_volsw_2r, \
 885	.get = snd_soc_get_volsw_r2_twl4030,\
 886	.put = snd_soc_put_volsw_r2_twl4030, \
 887	.private_value = (unsigned long)&(struct soc_mixer_control) \
 888		{.reg = reg_left, .rreg = reg_right, .shift = xshift, \
 889		 .rshift = xshift, .max = xmax, .invert = xinvert} }
 890#define SOC_SINGLE_TLV_TWL4030(xname, xreg, xshift, xmax, xinvert, tlv_array) \
 891	SOC_DOUBLE_TLV_TWL4030(xname, xreg, xshift, xshift, xmax, \
 892			       xinvert, tlv_array)
 893
 894static int snd_soc_get_volsw_twl4030(struct snd_kcontrol *kcontrol,
 895	struct snd_ctl_elem_value *ucontrol)
 896{
 897	struct soc_mixer_control *mc =
 898		(struct soc_mixer_control *)kcontrol->private_value;
 899	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 900	unsigned int reg = mc->reg;
 901	unsigned int shift = mc->shift;
 902	unsigned int rshift = mc->rshift;
 903	int max = mc->max;
 904	int mask = (1 << fls(max)) - 1;
 905
 906	ucontrol->value.integer.value[0] =
 907		(snd_soc_read(codec, reg) >> shift) & mask;
 908	if (ucontrol->value.integer.value[0])
 909		ucontrol->value.integer.value[0] =
 910			max + 1 - ucontrol->value.integer.value[0];
 911
 912	if (shift != rshift) {
 913		ucontrol->value.integer.value[1] =
 914			(snd_soc_read(codec, reg) >> rshift) & mask;
 915		if (ucontrol->value.integer.value[1])
 916			ucontrol->value.integer.value[1] =
 917				max + 1 - ucontrol->value.integer.value[1];
 918	}
 919
 920	return 0;
 921}
 922
 923static int snd_soc_put_volsw_twl4030(struct snd_kcontrol *kcontrol,
 924	struct snd_ctl_elem_value *ucontrol)
 925{
 926	struct soc_mixer_control *mc =
 927		(struct soc_mixer_control *)kcontrol->private_value;
 928	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 929	unsigned int reg = mc->reg;
 930	unsigned int shift = mc->shift;
 931	unsigned int rshift = mc->rshift;
 932	int max = mc->max;
 933	int mask = (1 << fls(max)) - 1;
 934	unsigned short val, val2, val_mask;
 935
 936	val = (ucontrol->value.integer.value[0] & mask);
 937
 938	val_mask = mask << shift;
 939	if (val)
 940		val = max + 1 - val;
 941	val = val << shift;
 942	if (shift != rshift) {
 943		val2 = (ucontrol->value.integer.value[1] & mask);
 944		val_mask |= mask << rshift;
 945		if (val2)
 946			val2 = max + 1 - val2;
 947		val |= val2 << rshift;
 948	}
 949	return snd_soc_update_bits(codec, reg, val_mask, val);
 950}
 951
 952static int snd_soc_get_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
 953	struct snd_ctl_elem_value *ucontrol)
 954{
 955	struct soc_mixer_control *mc =
 956		(struct soc_mixer_control *)kcontrol->private_value;
 957	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 958	unsigned int reg = mc->reg;
 959	unsigned int reg2 = mc->rreg;
 960	unsigned int shift = mc->shift;
 961	int max = mc->max;
 962	int mask = (1<<fls(max))-1;
 963
 964	ucontrol->value.integer.value[0] =
 965		(snd_soc_read(codec, reg) >> shift) & mask;
 966	ucontrol->value.integer.value[1] =
 967		(snd_soc_read(codec, reg2) >> shift) & mask;
 968
 969	if (ucontrol->value.integer.value[0])
 970		ucontrol->value.integer.value[0] =
 971			max + 1 - ucontrol->value.integer.value[0];
 972	if (ucontrol->value.integer.value[1])
 973		ucontrol->value.integer.value[1] =
 974			max + 1 - ucontrol->value.integer.value[1];
 975
 976	return 0;
 977}
 978
 979static int snd_soc_put_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
 980	struct snd_ctl_elem_value *ucontrol)
 981{
 982	struct soc_mixer_control *mc =
 983		(struct soc_mixer_control *)kcontrol->private_value;
 984	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
 985	unsigned int reg = mc->reg;
 986	unsigned int reg2 = mc->rreg;
 987	unsigned int shift = mc->shift;
 988	int max = mc->max;
 989	int mask = (1 << fls(max)) - 1;
 990	int err;
 991	unsigned short val, val2, val_mask;
 992
 993	val_mask = mask << shift;
 994	val = (ucontrol->value.integer.value[0] & mask);
 995	val2 = (ucontrol->value.integer.value[1] & mask);
 996
 997	if (val)
 998		val = max + 1 - val;
 999	if (val2)
1000		val2 = max + 1 - val2;
1001
1002	val = val << shift;
1003	val2 = val2 << shift;
1004
1005	err = snd_soc_update_bits(codec, reg, val_mask, val);
1006	if (err < 0)
1007		return err;
1008
1009	err = snd_soc_update_bits(codec, reg2, val_mask, val2);
1010	return err;
1011}
1012
1013/* Codec operation modes */
1014static const char *twl4030_op_modes_texts[] = {
1015	"Option 2 (voice/audio)", "Option 1 (audio)"
1016};
1017
1018static const struct soc_enum twl4030_op_modes_enum =
1019	SOC_ENUM_SINGLE(TWL4030_REG_CODEC_MODE, 0,
1020			ARRAY_SIZE(twl4030_op_modes_texts),
1021			twl4030_op_modes_texts);
1022
1023static int snd_soc_put_twl4030_opmode_enum_double(struct snd_kcontrol *kcontrol,
1024	struct snd_ctl_elem_value *ucontrol)
1025{
1026	struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
1027	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1028	struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
1029	unsigned short val;
1030	unsigned short mask, bitmask;
1031
1032	if (twl4030->configured) {
1033		printk(KERN_ERR "twl4030 operation mode cannot be "
1034			"changed on-the-fly\n");
1035		return -EBUSY;
1036	}
1037
1038	for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
1039		;
1040	if (ucontrol->value.enumerated.item[0] > e->max - 1)
1041		return -EINVAL;
1042
1043	val = ucontrol->value.enumerated.item[0] << e->shift_l;
1044	mask = (bitmask - 1) << e->shift_l;
1045	if (e->shift_l != e->shift_r) {
1046		if (ucontrol->value.enumerated.item[1] > e->max - 1)
1047			return -EINVAL;
1048		val |= ucontrol->value.enumerated.item[1] << e->shift_r;
1049		mask |= (bitmask - 1) << e->shift_r;
1050	}
1051
1052	return snd_soc_update_bits(codec, e->reg, mask, val);
1053}
1054
1055/*
1056 * FGAIN volume control:
1057 * from -62 to 0 dB in 1 dB steps (mute instead of -63 dB)
1058 */
1059static DECLARE_TLV_DB_SCALE(digital_fine_tlv, -6300, 100, 1);
1060
1061/*
1062 * CGAIN volume control:
1063 * 0 dB to 12 dB in 6 dB steps
1064 * value 2 and 3 means 12 dB
1065 */
1066static DECLARE_TLV_DB_SCALE(digital_coarse_tlv, 0, 600, 0);
1067
1068/*
1069 * Voice Downlink GAIN volume control:
1070 * from -37 to 12 dB in 1 dB steps (mute instead of -37 dB)
1071 */
1072static DECLARE_TLV_DB_SCALE(digital_voice_downlink_tlv, -3700, 100, 1);
1073
1074/*
1075 * Analog playback gain
1076 * -24 dB to 12 dB in 2 dB steps
1077 */
1078static DECLARE_TLV_DB_SCALE(analog_tlv, -2400, 200, 0);
1079
1080/*
1081 * Gain controls tied to outputs
1082 * -6 dB to 6 dB in 6 dB steps (mute instead of -12)
1083 */
1084static DECLARE_TLV_DB_SCALE(output_tvl, -1200, 600, 1);
1085
1086/*
1087 * Gain control for earpiece amplifier
1088 * 0 dB to 12 dB in 6 dB steps (mute instead of -6)
1089 */
1090static DECLARE_TLV_DB_SCALE(output_ear_tvl, -600, 600, 1);
1091
1092/*
1093 * Capture gain after the ADCs
1094 * from 0 dB to 31 dB in 1 dB steps
1095 */
1096static DECLARE_TLV_DB_SCALE(digital_capture_tlv, 0, 100, 0);
1097
1098/*
1099 * Gain control for input amplifiers
1100 * 0 dB to 30 dB in 6 dB steps
1101 */
1102static DECLARE_TLV_DB_SCALE(input_gain_tlv, 0, 600, 0);
1103
1104/* AVADC clock priority */
1105static const char *twl4030_avadc_clk_priority_texts[] = {
1106	"Voice high priority", "HiFi high priority"
1107};
1108
1109static const struct soc_enum twl4030_avadc_clk_priority_enum =
1110	SOC_ENUM_SINGLE(TWL4030_REG_AVADC_CTL, 2,
1111			ARRAY_SIZE(twl4030_avadc_clk_priority_texts),
1112			twl4030_avadc_clk_priority_texts);
1113
1114static const char *twl4030_rampdelay_texts[] = {
1115	"27/20/14 ms", "55/40/27 ms", "109/81/55 ms", "218/161/109 ms",
1116	"437/323/218 ms", "874/645/437 ms", "1748/1291/874 ms",
1117	"3495/2581/1748 ms"
1118};
1119
1120static const struct soc_enum twl4030_rampdelay_enum =
1121	SOC_ENUM_SINGLE(TWL4030_REG_HS_POPN_SET, 2,
1122			ARRAY_SIZE(twl4030_rampdelay_texts),
1123			twl4030_rampdelay_texts);
1124
1125/* Vibra H-bridge direction mode */
1126static const char *twl4030_vibradirmode_texts[] = {
1127	"Vibra H-bridge direction", "Audio data MSB",
1128};
1129
1130static const struct soc_enum twl4030_vibradirmode_enum =
1131	SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 5,
1132			ARRAY_SIZE(twl4030_vibradirmode_texts),
1133			twl4030_vibradirmode_texts);
1134
1135/* Vibra H-bridge direction */
1136static const char *twl4030_vibradir_texts[] = {
1137	"Positive polarity", "Negative polarity",
1138};
1139
1140static const struct soc_enum twl4030_vibradir_enum =
1141	SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 1,
1142			ARRAY_SIZE(twl4030_vibradir_texts),
1143			twl4030_vibradir_texts);
1144
1145/* Digimic Left and right swapping */
1146static const char *twl4030_digimicswap_texts[] = {
1147	"Not swapped", "Swapped",
1148};
1149
1150static const struct soc_enum twl4030_digimicswap_enum =
1151	SOC_ENUM_SINGLE(TWL4030_REG_MISC_SET_1, 0,
1152			ARRAY_SIZE(twl4030_digimicswap_texts),
1153			twl4030_digimicswap_texts);
1154
1155static const struct snd_kcontrol_new twl4030_snd_controls[] = {
1156	/* Codec operation mode control */
1157	SOC_ENUM_EXT("Codec Operation Mode", twl4030_op_modes_enum,
1158		snd_soc_get_enum_double,
1159		snd_soc_put_twl4030_opmode_enum_double),
1160
1161	/* Common playback gain controls */
1162	SOC_DOUBLE_R_TLV("DAC1 Digital Fine Playback Volume",
1163		TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1164		0, 0x3f, 0, digital_fine_tlv),
1165	SOC_DOUBLE_R_TLV("DAC2 Digital Fine Playback Volume",
1166		TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1167		0, 0x3f, 0, digital_fine_tlv),
1168
1169	SOC_DOUBLE_R_TLV("DAC1 Digital Coarse Playback Volume",
1170		TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1171		6, 0x2, 0, digital_coarse_tlv),
1172	SOC_DOUBLE_R_TLV("DAC2 Digital Coarse Playback Volume",
1173		TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1174		6, 0x2, 0, digital_coarse_tlv),
1175
1176	SOC_DOUBLE_R_TLV("DAC1 Analog Playback Volume",
1177		TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1178		3, 0x12, 1, analog_tlv),
1179	SOC_DOUBLE_R_TLV("DAC2 Analog Playback Volume",
1180		TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1181		3, 0x12, 1, analog_tlv),
1182	SOC_DOUBLE_R("DAC1 Analog Playback Switch",
1183		TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1184		1, 1, 0),
1185	SOC_DOUBLE_R("DAC2 Analog Playback Switch",
1186		TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1187		1, 1, 0),
1188
1189	/* Common voice downlink gain controls */
1190	SOC_SINGLE_TLV("DAC Voice Digital Downlink Volume",
1191		TWL4030_REG_VRXPGA, 0, 0x31, 0, digital_voice_downlink_tlv),
1192
1193	SOC_SINGLE_TLV("DAC Voice Analog Downlink Volume",
1194		TWL4030_REG_VDL_APGA_CTL, 3, 0x12, 1, analog_tlv),
1195
1196	SOC_SINGLE("DAC Voice Analog Downlink Switch",
1197		TWL4030_REG_VDL_APGA_CTL, 1, 1, 0),
1198
1199	/* Separate output gain controls */
1200	SOC_DOUBLE_R_TLV_TWL4030("PreDriv Playback Volume",
1201		TWL4030_REG_PREDL_CTL, TWL4030_REG_PREDR_CTL,
1202		4, 3, 0, output_tvl),
 
1203
1204	SOC_DOUBLE_TLV_TWL4030("Headset Playback Volume",
1205		TWL4030_REG_HS_GAIN_SET, 0, 2, 3, 0, output_tvl),
 
1206
1207	SOC_DOUBLE_R_TLV_TWL4030("Carkit Playback Volume",
1208		TWL4030_REG_PRECKL_CTL, TWL4030_REG_PRECKR_CTL,
1209		4, 3, 0, output_tvl),
 
1210
1211	SOC_SINGLE_TLV_TWL4030("Earpiece Playback Volume",
1212		TWL4030_REG_EAR_CTL, 4, 3, 0, output_ear_tvl),
 
1213
1214	/* Common capture gain controls */
1215	SOC_DOUBLE_R_TLV("TX1 Digital Capture Volume",
1216		TWL4030_REG_ATXL1PGA, TWL4030_REG_ATXR1PGA,
1217		0, 0x1f, 0, digital_capture_tlv),
1218	SOC_DOUBLE_R_TLV("TX2 Digital Capture Volume",
1219		TWL4030_REG_AVTXL2PGA, TWL4030_REG_AVTXR2PGA,
1220		0, 0x1f, 0, digital_capture_tlv),
1221
1222	SOC_DOUBLE_TLV("Analog Capture Volume", TWL4030_REG_ANAMIC_GAIN,
1223		0, 3, 5, 0, input_gain_tlv),
1224
1225	SOC_ENUM("AVADC Clock Priority", twl4030_avadc_clk_priority_enum),
1226
1227	SOC_ENUM("HS ramp delay", twl4030_rampdelay_enum),
1228
1229	SOC_ENUM("Vibra H-bridge mode", twl4030_vibradirmode_enum),
1230	SOC_ENUM("Vibra H-bridge direction", twl4030_vibradir_enum),
1231
1232	SOC_ENUM("Digimic LR Swap", twl4030_digimicswap_enum),
1233};
1234
1235static const struct snd_soc_dapm_widget twl4030_dapm_widgets[] = {
1236	/* Left channel inputs */
1237	SND_SOC_DAPM_INPUT("MAINMIC"),
1238	SND_SOC_DAPM_INPUT("HSMIC"),
1239	SND_SOC_DAPM_INPUT("AUXL"),
1240	SND_SOC_DAPM_INPUT("CARKITMIC"),
1241	/* Right channel inputs */
1242	SND_SOC_DAPM_INPUT("SUBMIC"),
1243	SND_SOC_DAPM_INPUT("AUXR"),
1244	/* Digital microphones (Stereo) */
1245	SND_SOC_DAPM_INPUT("DIGIMIC0"),
1246	SND_SOC_DAPM_INPUT("DIGIMIC1"),
1247
1248	/* Outputs */
1249	SND_SOC_DAPM_OUTPUT("EARPIECE"),
1250	SND_SOC_DAPM_OUTPUT("PREDRIVEL"),
1251	SND_SOC_DAPM_OUTPUT("PREDRIVER"),
1252	SND_SOC_DAPM_OUTPUT("HSOL"),
1253	SND_SOC_DAPM_OUTPUT("HSOR"),
1254	SND_SOC_DAPM_OUTPUT("CARKITL"),
1255	SND_SOC_DAPM_OUTPUT("CARKITR"),
1256	SND_SOC_DAPM_OUTPUT("HFL"),
1257	SND_SOC_DAPM_OUTPUT("HFR"),
1258	SND_SOC_DAPM_OUTPUT("VIBRA"),
1259
1260	/* AIF and APLL clocks for running DAIs (including loopback) */
1261	SND_SOC_DAPM_OUTPUT("Virtual HiFi OUT"),
1262	SND_SOC_DAPM_INPUT("Virtual HiFi IN"),
1263	SND_SOC_DAPM_OUTPUT("Virtual Voice OUT"),
1264
1265	/* DACs */
1266	SND_SOC_DAPM_DAC("DAC Right1", "Right Front HiFi Playback",
1267			SND_SOC_NOPM, 0, 0),
1268	SND_SOC_DAPM_DAC("DAC Left1", "Left Front HiFi Playback",
1269			SND_SOC_NOPM, 0, 0),
1270	SND_SOC_DAPM_DAC("DAC Right2", "Right Rear HiFi Playback",
1271			SND_SOC_NOPM, 0, 0),
1272	SND_SOC_DAPM_DAC("DAC Left2", "Left Rear HiFi Playback",
1273			SND_SOC_NOPM, 0, 0),
1274	SND_SOC_DAPM_DAC("DAC Voice", "Voice Playback",
1275			SND_SOC_NOPM, 0, 0),
1276
1277	/* Analog bypasses */
1278	SND_SOC_DAPM_SWITCH("Right1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1279			&twl4030_dapm_abypassr1_control),
1280	SND_SOC_DAPM_SWITCH("Left1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1281			&twl4030_dapm_abypassl1_control),
1282	SND_SOC_DAPM_SWITCH("Right2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1283			&twl4030_dapm_abypassr2_control),
1284	SND_SOC_DAPM_SWITCH("Left2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1285			&twl4030_dapm_abypassl2_control),
1286	SND_SOC_DAPM_SWITCH("Voice Analog Loopback", SND_SOC_NOPM, 0, 0,
1287			&twl4030_dapm_abypassv_control),
1288
1289	/* Master analog loopback switch */
1290	SND_SOC_DAPM_SUPPLY("FM Loop Enable", TWL4030_REG_MISC_SET_1, 5, 0,
1291			    NULL, 0),
1292
1293	/* Digital bypasses */
1294	SND_SOC_DAPM_SWITCH("Left Digital Loopback", SND_SOC_NOPM, 0, 0,
1295			&twl4030_dapm_dbypassl_control),
1296	SND_SOC_DAPM_SWITCH("Right Digital Loopback", SND_SOC_NOPM, 0, 0,
1297			&twl4030_dapm_dbypassr_control),
1298	SND_SOC_DAPM_SWITCH("Voice Digital Loopback", SND_SOC_NOPM, 0, 0,
1299			&twl4030_dapm_dbypassv_control),
1300
1301	/* Digital mixers, power control for the physical DACs */
1302	SND_SOC_DAPM_MIXER("Digital R1 Playback Mixer",
1303			TWL4030_REG_AVDAC_CTL, 0, 0, NULL, 0),
1304	SND_SOC_DAPM_MIXER("Digital L1 Playback Mixer",
1305			TWL4030_REG_AVDAC_CTL, 1, 0, NULL, 0),
1306	SND_SOC_DAPM_MIXER("Digital R2 Playback Mixer",
1307			TWL4030_REG_AVDAC_CTL, 2, 0, NULL, 0),
1308	SND_SOC_DAPM_MIXER("Digital L2 Playback Mixer",
1309			TWL4030_REG_AVDAC_CTL, 3, 0, NULL, 0),
1310	SND_SOC_DAPM_MIXER("Digital Voice Playback Mixer",
1311			TWL4030_REG_AVDAC_CTL, 4, 0, NULL, 0),
1312
1313	/* Analog mixers, power control for the physical PGAs */
1314	SND_SOC_DAPM_MIXER("Analog R1 Playback Mixer",
1315			TWL4030_REG_ARXR1_APGA_CTL, 0, 0, NULL, 0),
1316	SND_SOC_DAPM_MIXER("Analog L1 Playback Mixer",
1317			TWL4030_REG_ARXL1_APGA_CTL, 0, 0, NULL, 0),
1318	SND_SOC_DAPM_MIXER("Analog R2 Playback Mixer",
1319			TWL4030_REG_ARXR2_APGA_CTL, 0, 0, NULL, 0),
1320	SND_SOC_DAPM_MIXER("Analog L2 Playback Mixer",
1321			TWL4030_REG_ARXL2_APGA_CTL, 0, 0, NULL, 0),
1322	SND_SOC_DAPM_MIXER("Analog Voice Playback Mixer",
1323			TWL4030_REG_VDL_APGA_CTL, 0, 0, NULL, 0),
1324
1325	SND_SOC_DAPM_SUPPLY("APLL Enable", SND_SOC_NOPM, 0, 0, apll_event,
1326			    SND_SOC_DAPM_PRE_PMU|SND_SOC_DAPM_POST_PMD),
1327
1328	SND_SOC_DAPM_SUPPLY("AIF Enable", SND_SOC_NOPM, 0, 0, aif_event,
1329			    SND_SOC_DAPM_PRE_PMU|SND_SOC_DAPM_POST_PMD),
1330
1331	/* Output MIXER controls */
1332	/* Earpiece */
1333	SND_SOC_DAPM_MIXER("Earpiece Mixer", SND_SOC_NOPM, 0, 0,
1334			&twl4030_dapm_earpiece_controls[0],
1335			ARRAY_SIZE(twl4030_dapm_earpiece_controls)),
1336	SND_SOC_DAPM_PGA_E("Earpiece PGA", SND_SOC_NOPM,
1337			0, 0, NULL, 0, earpiecepga_event,
1338			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1339	/* PreDrivL/R */
1340	SND_SOC_DAPM_MIXER("PredriveL Mixer", SND_SOC_NOPM, 0, 0,
1341			&twl4030_dapm_predrivel_controls[0],
1342			ARRAY_SIZE(twl4030_dapm_predrivel_controls)),
1343	SND_SOC_DAPM_PGA_E("PredriveL PGA", SND_SOC_NOPM,
1344			0, 0, NULL, 0, predrivelpga_event,
1345			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1346	SND_SOC_DAPM_MIXER("PredriveR Mixer", SND_SOC_NOPM, 0, 0,
1347			&twl4030_dapm_predriver_controls[0],
1348			ARRAY_SIZE(twl4030_dapm_predriver_controls)),
1349	SND_SOC_DAPM_PGA_E("PredriveR PGA", SND_SOC_NOPM,
1350			0, 0, NULL, 0, predriverpga_event,
1351			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1352	/* HeadsetL/R */
1353	SND_SOC_DAPM_MIXER("HeadsetL Mixer", SND_SOC_NOPM, 0, 0,
1354			&twl4030_dapm_hsol_controls[0],
1355			ARRAY_SIZE(twl4030_dapm_hsol_controls)),
1356	SND_SOC_DAPM_PGA_E("HeadsetL PGA", SND_SOC_NOPM,
1357			0, 0, NULL, 0, headsetlpga_event,
1358			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1359	SND_SOC_DAPM_MIXER("HeadsetR Mixer", SND_SOC_NOPM, 0, 0,
1360			&twl4030_dapm_hsor_controls[0],
1361			ARRAY_SIZE(twl4030_dapm_hsor_controls)),
1362	SND_SOC_DAPM_PGA_E("HeadsetR PGA", SND_SOC_NOPM,
1363			0, 0, NULL, 0, headsetrpga_event,
1364			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1365	/* CarkitL/R */
1366	SND_SOC_DAPM_MIXER("CarkitL Mixer", SND_SOC_NOPM, 0, 0,
1367			&twl4030_dapm_carkitl_controls[0],
1368			ARRAY_SIZE(twl4030_dapm_carkitl_controls)),
1369	SND_SOC_DAPM_PGA_E("CarkitL PGA", SND_SOC_NOPM,
1370			0, 0, NULL, 0, carkitlpga_event,
1371			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1372	SND_SOC_DAPM_MIXER("CarkitR Mixer", SND_SOC_NOPM, 0, 0,
1373			&twl4030_dapm_carkitr_controls[0],
1374			ARRAY_SIZE(twl4030_dapm_carkitr_controls)),
1375	SND_SOC_DAPM_PGA_E("CarkitR PGA", SND_SOC_NOPM,
1376			0, 0, NULL, 0, carkitrpga_event,
1377			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1378
1379	/* Output MUX controls */
1380	/* HandsfreeL/R */
1381	SND_SOC_DAPM_MUX("HandsfreeL Mux", SND_SOC_NOPM, 0, 0,
1382		&twl4030_dapm_handsfreel_control),
1383	SND_SOC_DAPM_SWITCH("HandsfreeL", SND_SOC_NOPM, 0, 0,
1384			&twl4030_dapm_handsfreelmute_control),
1385	SND_SOC_DAPM_PGA_E("HandsfreeL PGA", SND_SOC_NOPM,
1386			0, 0, NULL, 0, handsfreelpga_event,
1387			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1388	SND_SOC_DAPM_MUX("HandsfreeR Mux", SND_SOC_NOPM, 5, 0,
1389		&twl4030_dapm_handsfreer_control),
1390	SND_SOC_DAPM_SWITCH("HandsfreeR", SND_SOC_NOPM, 0, 0,
1391			&twl4030_dapm_handsfreermute_control),
1392	SND_SOC_DAPM_PGA_E("HandsfreeR PGA", SND_SOC_NOPM,
1393			0, 0, NULL, 0, handsfreerpga_event,
1394			SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1395	/* Vibra */
1396	SND_SOC_DAPM_MUX_E("Vibra Mux", TWL4030_REG_VIBRA_CTL, 0, 0,
1397			   &twl4030_dapm_vibra_control, vibramux_event,
1398			   SND_SOC_DAPM_PRE_PMU),
1399	SND_SOC_DAPM_MUX("Vibra Route", SND_SOC_NOPM, 0, 0,
1400		&twl4030_dapm_vibrapath_control),
1401
1402	/* Introducing four virtual ADC, since TWL4030 have four channel for
1403	   capture */
1404	SND_SOC_DAPM_ADC("ADC Virtual Left1", "Left Front Capture",
1405		SND_SOC_NOPM, 0, 0),
1406	SND_SOC_DAPM_ADC("ADC Virtual Right1", "Right Front Capture",
1407		SND_SOC_NOPM, 0, 0),
1408	SND_SOC_DAPM_ADC("ADC Virtual Left2", "Left Rear Capture",
1409		SND_SOC_NOPM, 0, 0),
1410	SND_SOC_DAPM_ADC("ADC Virtual Right2", "Right Rear Capture",
1411		SND_SOC_NOPM, 0, 0),
1412
1413	/* Analog/Digital mic path selection.
1414	   TX1 Left/Right: either analog Left/Right or Digimic0
1415	   TX2 Left/Right: either analog Left/Right or Digimic1 */
1416	SND_SOC_DAPM_MUX("TX1 Capture Route", SND_SOC_NOPM, 0, 0,
1417		&twl4030_dapm_micpathtx1_control),
1418	SND_SOC_DAPM_MUX("TX2 Capture Route", SND_SOC_NOPM, 0, 0,
1419		&twl4030_dapm_micpathtx2_control),
1420
1421	/* Analog input mixers for the capture amplifiers */
1422	SND_SOC_DAPM_MIXER("Analog Left",
1423		TWL4030_REG_ANAMICL, 4, 0,
1424		&twl4030_dapm_analoglmic_controls[0],
1425		ARRAY_SIZE(twl4030_dapm_analoglmic_controls)),
1426	SND_SOC_DAPM_MIXER("Analog Right",
1427		TWL4030_REG_ANAMICR, 4, 0,
1428		&twl4030_dapm_analogrmic_controls[0],
1429		ARRAY_SIZE(twl4030_dapm_analogrmic_controls)),
1430
1431	SND_SOC_DAPM_PGA("ADC Physical Left",
1432		TWL4030_REG_AVADC_CTL, 3, 0, NULL, 0),
1433	SND_SOC_DAPM_PGA("ADC Physical Right",
1434		TWL4030_REG_AVADC_CTL, 1, 0, NULL, 0),
1435
1436	SND_SOC_DAPM_PGA_E("Digimic0 Enable",
1437		TWL4030_REG_ADCMICSEL, 1, 0, NULL, 0,
1438		digimic_event, SND_SOC_DAPM_POST_PMU),
1439	SND_SOC_DAPM_PGA_E("Digimic1 Enable",
1440		TWL4030_REG_ADCMICSEL, 3, 0, NULL, 0,
1441		digimic_event, SND_SOC_DAPM_POST_PMU),
1442
1443	SND_SOC_DAPM_SUPPLY("micbias1 select", TWL4030_REG_MICBIAS_CTL, 5, 0,
1444			    NULL, 0),
1445	SND_SOC_DAPM_SUPPLY("micbias2 select", TWL4030_REG_MICBIAS_CTL, 6, 0,
1446			    NULL, 0),
1447
1448	SND_SOC_DAPM_MICBIAS("Mic Bias 1", TWL4030_REG_MICBIAS_CTL, 0, 0),
1449	SND_SOC_DAPM_MICBIAS("Mic Bias 2", TWL4030_REG_MICBIAS_CTL, 1, 0),
1450	SND_SOC_DAPM_MICBIAS("Headset Mic Bias", TWL4030_REG_MICBIAS_CTL, 2, 0),
 
 
 
 
1451
 
1452};
1453
1454static const struct snd_soc_dapm_route intercon[] = {
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1455	{"Digital L1 Playback Mixer", NULL, "DAC Left1"},
1456	{"Digital R1 Playback Mixer", NULL, "DAC Right1"},
1457	{"Digital L2 Playback Mixer", NULL, "DAC Left2"},
1458	{"Digital R2 Playback Mixer", NULL, "DAC Right2"},
1459	{"Digital Voice Playback Mixer", NULL, "DAC Voice"},
1460
1461	/* Supply for the digital part (APLL) */
1462	{"Digital Voice Playback Mixer", NULL, "APLL Enable"},
1463
1464	{"DAC Left1", NULL, "AIF Enable"},
1465	{"DAC Right1", NULL, "AIF Enable"},
1466	{"DAC Left2", NULL, "AIF Enable"},
1467	{"DAC Right1", NULL, "AIF Enable"},
 
1468
1469	{"Digital R2 Playback Mixer", NULL, "AIF Enable"},
1470	{"Digital L2 Playback Mixer", NULL, "AIF Enable"},
1471
1472	{"Analog L1 Playback Mixer", NULL, "Digital L1 Playback Mixer"},
1473	{"Analog R1 Playback Mixer", NULL, "Digital R1 Playback Mixer"},
1474	{"Analog L2 Playback Mixer", NULL, "Digital L2 Playback Mixer"},
1475	{"Analog R2 Playback Mixer", NULL, "Digital R2 Playback Mixer"},
1476	{"Analog Voice Playback Mixer", NULL, "Digital Voice Playback Mixer"},
1477
1478	/* Internal playback routings */
1479	/* Earpiece */
1480	{"Earpiece Mixer", "Voice", "Analog Voice Playback Mixer"},
1481	{"Earpiece Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1482	{"Earpiece Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1483	{"Earpiece Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1484	{"Earpiece PGA", NULL, "Earpiece Mixer"},
1485	/* PreDrivL */
1486	{"PredriveL Mixer", "Voice", "Analog Voice Playback Mixer"},
1487	{"PredriveL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1488	{"PredriveL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1489	{"PredriveL Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1490	{"PredriveL PGA", NULL, "PredriveL Mixer"},
1491	/* PreDrivR */
1492	{"PredriveR Mixer", "Voice", "Analog Voice Playback Mixer"},
1493	{"PredriveR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1494	{"PredriveR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1495	{"PredriveR Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1496	{"PredriveR PGA", NULL, "PredriveR Mixer"},
1497	/* HeadsetL */
1498	{"HeadsetL Mixer", "Voice", "Analog Voice Playback Mixer"},
1499	{"HeadsetL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1500	{"HeadsetL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1501	{"HeadsetL PGA", NULL, "HeadsetL Mixer"},
1502	/* HeadsetR */
1503	{"HeadsetR Mixer", "Voice", "Analog Voice Playback Mixer"},
1504	{"HeadsetR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1505	{"HeadsetR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1506	{"HeadsetR PGA", NULL, "HeadsetR Mixer"},
1507	/* CarkitL */
1508	{"CarkitL Mixer", "Voice", "Analog Voice Playback Mixer"},
1509	{"CarkitL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1510	{"CarkitL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1511	{"CarkitL PGA", NULL, "CarkitL Mixer"},
1512	/* CarkitR */
1513	{"CarkitR Mixer", "Voice", "Analog Voice Playback Mixer"},
1514	{"CarkitR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1515	{"CarkitR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1516	{"CarkitR PGA", NULL, "CarkitR Mixer"},
1517	/* HandsfreeL */
1518	{"HandsfreeL Mux", "Voice", "Analog Voice Playback Mixer"},
1519	{"HandsfreeL Mux", "AudioL1", "Analog L1 Playback Mixer"},
1520	{"HandsfreeL Mux", "AudioL2", "Analog L2 Playback Mixer"},
1521	{"HandsfreeL Mux", "AudioR2", "Analog R2 Playback Mixer"},
1522	{"HandsfreeL", "Switch", "HandsfreeL Mux"},
1523	{"HandsfreeL PGA", NULL, "HandsfreeL"},
1524	/* HandsfreeR */
1525	{"HandsfreeR Mux", "Voice", "Analog Voice Playback Mixer"},
1526	{"HandsfreeR Mux", "AudioR1", "Analog R1 Playback Mixer"},
1527	{"HandsfreeR Mux", "AudioR2", "Analog R2 Playback Mixer"},
1528	{"HandsfreeR Mux", "AudioL2", "Analog L2 Playback Mixer"},
1529	{"HandsfreeR", "Switch", "HandsfreeR Mux"},
1530	{"HandsfreeR PGA", NULL, "HandsfreeR"},
1531	/* Vibra */
1532	{"Vibra Mux", "AudioL1", "DAC Left1"},
1533	{"Vibra Mux", "AudioR1", "DAC Right1"},
1534	{"Vibra Mux", "AudioL2", "DAC Left2"},
1535	{"Vibra Mux", "AudioR2", "DAC Right2"},
1536
1537	/* outputs */
1538	/* Must be always connected (for AIF and APLL) */
1539	{"Virtual HiFi OUT", NULL, "DAC Left1"},
1540	{"Virtual HiFi OUT", NULL, "DAC Right1"},
1541	{"Virtual HiFi OUT", NULL, "DAC Left2"},
1542	{"Virtual HiFi OUT", NULL, "DAC Right2"},
1543	/* Must be always connected (for APLL) */
1544	{"Virtual Voice OUT", NULL, "Digital Voice Playback Mixer"},
1545	/* Physical outputs */
1546	{"EARPIECE", NULL, "Earpiece PGA"},
1547	{"PREDRIVEL", NULL, "PredriveL PGA"},
1548	{"PREDRIVER", NULL, "PredriveR PGA"},
1549	{"HSOL", NULL, "HeadsetL PGA"},
1550	{"HSOR", NULL, "HeadsetR PGA"},
1551	{"CARKITL", NULL, "CarkitL PGA"},
1552	{"CARKITR", NULL, "CarkitR PGA"},
1553	{"HFL", NULL, "HandsfreeL PGA"},
1554	{"HFR", NULL, "HandsfreeR PGA"},
1555	{"Vibra Route", "Audio", "Vibra Mux"},
1556	{"VIBRA", NULL, "Vibra Route"},
1557
1558	/* Capture path */
1559	/* Must be always connected (for AIF and APLL) */
1560	{"ADC Virtual Left1", NULL, "Virtual HiFi IN"},
1561	{"ADC Virtual Right1", NULL, "Virtual HiFi IN"},
1562	{"ADC Virtual Left2", NULL, "Virtual HiFi IN"},
1563	{"ADC Virtual Right2", NULL, "Virtual HiFi IN"},
1564	/* Physical inputs */
1565	{"Analog Left", "Main Mic Capture Switch", "MAINMIC"},
1566	{"Analog Left", "Headset Mic Capture Switch", "HSMIC"},
1567	{"Analog Left", "AUXL Capture Switch", "AUXL"},
1568	{"Analog Left", "Carkit Mic Capture Switch", "CARKITMIC"},
1569
1570	{"Analog Right", "Sub Mic Capture Switch", "SUBMIC"},
1571	{"Analog Right", "AUXR Capture Switch", "AUXR"},
1572
1573	{"ADC Physical Left", NULL, "Analog Left"},
1574	{"ADC Physical Right", NULL, "Analog Right"},
1575
1576	{"Digimic0 Enable", NULL, "DIGIMIC0"},
1577	{"Digimic1 Enable", NULL, "DIGIMIC1"},
1578
1579	{"DIGIMIC0", NULL, "micbias1 select"},
1580	{"DIGIMIC1", NULL, "micbias2 select"},
1581
1582	/* TX1 Left capture path */
1583	{"TX1 Capture Route", "Analog", "ADC Physical Left"},
1584	{"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1585	/* TX1 Right capture path */
1586	{"TX1 Capture Route", "Analog", "ADC Physical Right"},
1587	{"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1588	/* TX2 Left capture path */
1589	{"TX2 Capture Route", "Analog", "ADC Physical Left"},
1590	{"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1591	/* TX2 Right capture path */
1592	{"TX2 Capture Route", "Analog", "ADC Physical Right"},
1593	{"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1594
1595	{"ADC Virtual Left1", NULL, "TX1 Capture Route"},
1596	{"ADC Virtual Right1", NULL, "TX1 Capture Route"},
1597	{"ADC Virtual Left2", NULL, "TX2 Capture Route"},
1598	{"ADC Virtual Right2", NULL, "TX2 Capture Route"},
1599
1600	{"ADC Virtual Left1", NULL, "AIF Enable"},
1601	{"ADC Virtual Right1", NULL, "AIF Enable"},
1602	{"ADC Virtual Left2", NULL, "AIF Enable"},
1603	{"ADC Virtual Right2", NULL, "AIF Enable"},
1604
1605	/* Analog bypass routes */
1606	{"Right1 Analog Loopback", "Switch", "Analog Right"},
1607	{"Left1 Analog Loopback", "Switch", "Analog Left"},
1608	{"Right2 Analog Loopback", "Switch", "Analog Right"},
1609	{"Left2 Analog Loopback", "Switch", "Analog Left"},
1610	{"Voice Analog Loopback", "Switch", "Analog Left"},
1611
1612	/* Supply for the Analog loopbacks */
1613	{"Right1 Analog Loopback", NULL, "FM Loop Enable"},
1614	{"Left1 Analog Loopback", NULL, "FM Loop Enable"},
1615	{"Right2 Analog Loopback", NULL, "FM Loop Enable"},
1616	{"Left2 Analog Loopback", NULL, "FM Loop Enable"},
1617	{"Voice Analog Loopback", NULL, "FM Loop Enable"},
1618
1619	{"Analog R1 Playback Mixer", NULL, "Right1 Analog Loopback"},
1620	{"Analog L1 Playback Mixer", NULL, "Left1 Analog Loopback"},
1621	{"Analog R2 Playback Mixer", NULL, "Right2 Analog Loopback"},
1622	{"Analog L2 Playback Mixer", NULL, "Left2 Analog Loopback"},
1623	{"Analog Voice Playback Mixer", NULL, "Voice Analog Loopback"},
1624
1625	/* Digital bypass routes */
1626	{"Right Digital Loopback", "Volume", "TX1 Capture Route"},
1627	{"Left Digital Loopback", "Volume", "TX1 Capture Route"},
1628	{"Voice Digital Loopback", "Volume", "TX2 Capture Route"},
1629
1630	{"Digital R2 Playback Mixer", NULL, "Right Digital Loopback"},
1631	{"Digital L2 Playback Mixer", NULL, "Left Digital Loopback"},
1632	{"Digital Voice Playback Mixer", NULL, "Voice Digital Loopback"},
1633
1634};
1635
1636static int twl4030_add_widgets(struct snd_soc_codec *codec)
1637{
1638	struct snd_soc_dapm_context *dapm = &codec->dapm;
1639
1640	snd_soc_dapm_new_controls(dapm, twl4030_dapm_widgets,
1641				 ARRAY_SIZE(twl4030_dapm_widgets));
1642	snd_soc_dapm_add_routes(dapm, intercon, ARRAY_SIZE(intercon));
1643
1644	return 0;
1645}
1646
1647static int twl4030_set_bias_level(struct snd_soc_codec *codec,
1648				  enum snd_soc_bias_level level)
1649{
1650	switch (level) {
1651	case SND_SOC_BIAS_ON:
1652		break;
1653	case SND_SOC_BIAS_PREPARE:
1654		break;
1655	case SND_SOC_BIAS_STANDBY:
1656		if (codec->dapm.bias_level == SND_SOC_BIAS_OFF)
1657			twl4030_codec_enable(codec, 1);
1658		break;
1659	case SND_SOC_BIAS_OFF:
1660		twl4030_codec_enable(codec, 0);
1661		break;
1662	}
1663	codec->dapm.bias_level = level;
1664
1665	return 0;
1666}
1667
1668static void twl4030_constraints(struct twl4030_priv *twl4030,
1669				struct snd_pcm_substream *mst_substream)
1670{
1671	struct snd_pcm_substream *slv_substream;
1672
1673	/* Pick the stream, which need to be constrained */
1674	if (mst_substream == twl4030->master_substream)
1675		slv_substream = twl4030->slave_substream;
1676	else if (mst_substream == twl4030->slave_substream)
1677		slv_substream = twl4030->master_substream;
1678	else /* This should not happen.. */
1679		return;
1680
1681	/* Set the constraints according to the already configured stream */
1682	snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1683				SNDRV_PCM_HW_PARAM_RATE,
1684				twl4030->rate,
1685				twl4030->rate);
1686
1687	snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1688				SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1689				twl4030->sample_bits,
1690				twl4030->sample_bits);
1691
1692	snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1693				SNDRV_PCM_HW_PARAM_CHANNELS,
1694				twl4030->channels,
1695				twl4030->channels);
1696}
1697
1698/* In case of 4 channel mode, the RX1 L/R for playback and the TX2 L/R for
1699 * capture has to be enabled/disabled. */
1700static void twl4030_tdm_enable(struct snd_soc_codec *codec, int direction,
1701				int enable)
1702{
1703	u8 reg, mask;
1704
1705	reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1706
1707	if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1708		mask = TWL4030_ARXL1_VRX_EN | TWL4030_ARXR1_EN;
1709	else
1710		mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1711
1712	if (enable)
1713		reg |= mask;
1714	else
1715		reg &= ~mask;
1716
1717	twl4030_write(codec, TWL4030_REG_OPTION, reg);
1718}
1719
1720static int twl4030_startup(struct snd_pcm_substream *substream,
1721			   struct snd_soc_dai *dai)
1722{
1723	struct snd_soc_pcm_runtime *rtd = substream->private_data;
1724	struct snd_soc_codec *codec = rtd->codec;
1725	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1726
1727	snd_pcm_hw_constraint_msbits(substream->runtime, 0, 32, 24);
1728	if (twl4030->master_substream) {
1729		twl4030->slave_substream = substream;
1730		/* The DAI has one configuration for playback and capture, so
1731		 * if the DAI has been already configured then constrain this
1732		 * substream to match it. */
1733		if (twl4030->configured)
1734			twl4030_constraints(twl4030, twl4030->master_substream);
1735	} else {
1736		if (!(twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE) &
1737			TWL4030_OPTION_1)) {
1738			/* In option2 4 channel is not supported, set the
1739			 * constraint for the first stream for channels, the
1740			 * second stream will 'inherit' this cosntraint */
1741			snd_pcm_hw_constraint_minmax(substream->runtime,
1742						SNDRV_PCM_HW_PARAM_CHANNELS,
1743						2, 2);
1744		}
1745		twl4030->master_substream = substream;
1746	}
1747
1748	return 0;
1749}
1750
1751static void twl4030_shutdown(struct snd_pcm_substream *substream,
1752			     struct snd_soc_dai *dai)
1753{
1754	struct snd_soc_pcm_runtime *rtd = substream->private_data;
1755	struct snd_soc_codec *codec = rtd->codec;
1756	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1757
1758	if (twl4030->master_substream == substream)
1759		twl4030->master_substream = twl4030->slave_substream;
1760
1761	twl4030->slave_substream = NULL;
1762
1763	/* If all streams are closed, or the remaining stream has not yet
1764	 * been configured than set the DAI as not configured. */
1765	if (!twl4030->master_substream)
1766		twl4030->configured = 0;
1767	 else if (!twl4030->master_substream->runtime->channels)
1768		twl4030->configured = 0;
1769
1770	 /* If the closing substream had 4 channel, do the necessary cleanup */
1771	if (substream->runtime->channels == 4)
1772		twl4030_tdm_enable(codec, substream->stream, 0);
1773}
1774
1775static int twl4030_hw_params(struct snd_pcm_substream *substream,
1776			   struct snd_pcm_hw_params *params,
1777			   struct snd_soc_dai *dai)
1778{
1779	struct snd_soc_pcm_runtime *rtd = substream->private_data;
1780	struct snd_soc_codec *codec = rtd->codec;
1781	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1782	u8 mode, old_mode, format, old_format;
1783
1784	 /* If the substream has 4 channel, do the necessary setup */
1785	if (params_channels(params) == 4) {
1786		format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1787		mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE);
1788
1789		/* Safety check: are we in the correct operating mode and
1790		 * the interface is in TDM mode? */
1791		if ((mode & TWL4030_OPTION_1) &&
1792		    ((format & TWL4030_AIF_FORMAT) == TWL4030_AIF_FORMAT_TDM))
1793			twl4030_tdm_enable(codec, substream->stream, 1);
1794		else
1795			return -EINVAL;
1796	}
1797
1798	if (twl4030->configured)
1799		/* Ignoring hw_params for already configured DAI */
1800		return 0;
1801
1802	/* bit rate */
1803	old_mode = twl4030_read_reg_cache(codec,
1804			TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1805	mode = old_mode & ~TWL4030_APLL_RATE;
1806
1807	switch (params_rate(params)) {
1808	case 8000:
1809		mode |= TWL4030_APLL_RATE_8000;
1810		break;
1811	case 11025:
1812		mode |= TWL4030_APLL_RATE_11025;
1813		break;
1814	case 12000:
1815		mode |= TWL4030_APLL_RATE_12000;
1816		break;
1817	case 16000:
1818		mode |= TWL4030_APLL_RATE_16000;
1819		break;
1820	case 22050:
1821		mode |= TWL4030_APLL_RATE_22050;
1822		break;
1823	case 24000:
1824		mode |= TWL4030_APLL_RATE_24000;
1825		break;
1826	case 32000:
1827		mode |= TWL4030_APLL_RATE_32000;
1828		break;
1829	case 44100:
1830		mode |= TWL4030_APLL_RATE_44100;
1831		break;
1832	case 48000:
1833		mode |= TWL4030_APLL_RATE_48000;
1834		break;
1835	case 96000:
1836		mode |= TWL4030_APLL_RATE_96000;
1837		break;
1838	default:
1839		printk(KERN_ERR "TWL4030 hw params: unknown rate %d\n",
1840			params_rate(params));
1841		return -EINVAL;
1842	}
1843
1844	/* sample size */
1845	old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1846	format = old_format;
1847	format &= ~TWL4030_DATA_WIDTH;
1848	switch (params_format(params)) {
1849	case SNDRV_PCM_FORMAT_S16_LE:
1850		format |= TWL4030_DATA_WIDTH_16S_16W;
1851		break;
1852	case SNDRV_PCM_FORMAT_S32_LE:
1853		format |= TWL4030_DATA_WIDTH_32S_24W;
1854		break;
1855	default:
1856		printk(KERN_ERR "TWL4030 hw params: unknown format %d\n",
1857			params_format(params));
1858		return -EINVAL;
1859	}
1860
1861	if (format != old_format || mode != old_mode) {
1862		if (twl4030->codec_powered) {
1863			/*
1864			 * If the codec is powered, than we need to toggle the
1865			 * codec power.
1866			 */
1867			twl4030_codec_enable(codec, 0);
1868			twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1869			twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1870			twl4030_codec_enable(codec, 1);
1871		} else {
1872			twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1873			twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1874		}
1875	}
1876
1877	/* Store the important parameters for the DAI configuration and set
1878	 * the DAI as configured */
1879	twl4030->configured = 1;
1880	twl4030->rate = params_rate(params);
1881	twl4030->sample_bits = hw_param_interval(params,
1882					SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
1883	twl4030->channels = params_channels(params);
1884
1885	/* If both playback and capture streams are open, and one of them
1886	 * is setting the hw parameters right now (since we are here), set
1887	 * constraints to the other stream to match the current one. */
1888	if (twl4030->slave_substream)
1889		twl4030_constraints(twl4030, substream);
1890
1891	return 0;
1892}
1893
1894static int twl4030_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1895		int clk_id, unsigned int freq, int dir)
1896{
1897	struct snd_soc_codec *codec = codec_dai->codec;
1898	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1899
1900	switch (freq) {
1901	case 19200000:
1902	case 26000000:
1903	case 38400000:
1904		break;
1905	default:
1906		dev_err(codec->dev, "Unsupported APLL mclk: %u\n", freq);
1907		return -EINVAL;
1908	}
1909
1910	if ((freq / 1000) != twl4030->sysclk) {
1911		dev_err(codec->dev,
1912			"Mismatch in APLL mclk: %u (configured: %u)\n",
1913			freq, twl4030->sysclk * 1000);
1914		return -EINVAL;
1915	}
1916
1917	return 0;
1918}
1919
1920static int twl4030_set_dai_fmt(struct snd_soc_dai *codec_dai,
1921			     unsigned int fmt)
1922{
1923	struct snd_soc_codec *codec = codec_dai->codec;
1924	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
1925	u8 old_format, format;
1926
1927	/* get format */
1928	old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1929	format = old_format;
1930
1931	/* set master/slave audio interface */
1932	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1933	case SND_SOC_DAIFMT_CBM_CFM:
1934		format &= ~(TWL4030_AIF_SLAVE_EN);
1935		format &= ~(TWL4030_CLK256FS_EN);
1936		break;
1937	case SND_SOC_DAIFMT_CBS_CFS:
1938		format |= TWL4030_AIF_SLAVE_EN;
1939		format |= TWL4030_CLK256FS_EN;
1940		break;
1941	default:
1942		return -EINVAL;
1943	}
1944
1945	/* interface format */
1946	format &= ~TWL4030_AIF_FORMAT;
1947	switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1948	case SND_SOC_DAIFMT_I2S:
1949		format |= TWL4030_AIF_FORMAT_CODEC;
1950		break;
1951	case SND_SOC_DAIFMT_DSP_A:
1952		format |= TWL4030_AIF_FORMAT_TDM;
1953		break;
1954	default:
1955		return -EINVAL;
1956	}
1957
1958	if (format != old_format) {
1959		if (twl4030->codec_powered) {
1960			/*
1961			 * If the codec is powered, than we need to toggle the
1962			 * codec power.
1963			 */
1964			twl4030_codec_enable(codec, 0);
1965			twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1966			twl4030_codec_enable(codec, 1);
1967		} else {
1968			twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1969		}
1970	}
1971
1972	return 0;
1973}
1974
1975static int twl4030_set_tristate(struct snd_soc_dai *dai, int tristate)
1976{
1977	struct snd_soc_codec *codec = dai->codec;
1978	u8 reg = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1979
1980	if (tristate)
1981		reg |= TWL4030_AIF_TRI_EN;
1982	else
1983		reg &= ~TWL4030_AIF_TRI_EN;
1984
1985	return twl4030_write(codec, TWL4030_REG_AUDIO_IF, reg);
1986}
1987
1988/* In case of voice mode, the RX1 L(VRX) for downlink and the TX2 L/R
1989 * (VTXL, VTXR) for uplink has to be enabled/disabled. */
1990static void twl4030_voice_enable(struct snd_soc_codec *codec, int direction,
1991				int enable)
1992{
1993	u8 reg, mask;
1994
1995	reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1996
1997	if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1998		mask = TWL4030_ARXL1_VRX_EN;
1999	else
2000		mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
2001
2002	if (enable)
2003		reg |= mask;
2004	else
2005		reg &= ~mask;
2006
2007	twl4030_write(codec, TWL4030_REG_OPTION, reg);
2008}
2009
2010static int twl4030_voice_startup(struct snd_pcm_substream *substream,
2011		struct snd_soc_dai *dai)
2012{
2013	struct snd_soc_pcm_runtime *rtd = substream->private_data;
2014	struct snd_soc_codec *codec = rtd->codec;
2015	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
2016	u8 mode;
2017
2018	/* If the system master clock is not 26MHz, the voice PCM interface is
2019	 * not available.
2020	 */
2021	if (twl4030->sysclk != 26000) {
2022		dev_err(codec->dev, "The board is configured for %u Hz, while"
2023			"the Voice interface needs 26MHz APLL mclk\n",
2024			twl4030->sysclk * 1000);
2025		return -EINVAL;
2026	}
2027
2028	/* If the codec mode is not option2, the voice PCM interface is not
2029	 * available.
2030	 */
2031	mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
2032		& TWL4030_OPT_MODE;
2033
2034	if (mode != TWL4030_OPTION_2) {
2035		printk(KERN_ERR "TWL4030 voice startup: "
2036			"the codec mode is not option2\n");
2037		return -EINVAL;
2038	}
2039
2040	return 0;
2041}
2042
2043static void twl4030_voice_shutdown(struct snd_pcm_substream *substream,
2044				struct snd_soc_dai *dai)
2045{
2046	struct snd_soc_pcm_runtime *rtd = substream->private_data;
2047	struct snd_soc_codec *codec = rtd->codec;
2048
2049	/* Enable voice digital filters */
2050	twl4030_voice_enable(codec, substream->stream, 0);
2051}
2052
2053static int twl4030_voice_hw_params(struct snd_pcm_substream *substream,
2054		struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
 
2055{
2056	struct snd_soc_pcm_runtime *rtd = substream->private_data;
2057	struct snd_soc_codec *codec = rtd->codec;
2058	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
2059	u8 old_mode, mode;
2060
2061	/* Enable voice digital filters */
2062	twl4030_voice_enable(codec, substream->stream, 1);
2063
2064	/* bit rate */
2065	old_mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
2066		& ~(TWL4030_CODECPDZ);
2067	mode = old_mode;
2068
2069	switch (params_rate(params)) {
2070	case 8000:
2071		mode &= ~(TWL4030_SEL_16K);
2072		break;
2073	case 16000:
2074		mode |= TWL4030_SEL_16K;
2075		break;
2076	default:
2077		printk(KERN_ERR "TWL4030 voice hw params: unknown rate %d\n",
2078			params_rate(params));
2079		return -EINVAL;
2080	}
2081
2082	if (mode != old_mode) {
2083		if (twl4030->codec_powered) {
2084			/*
2085			 * If the codec is powered, than we need to toggle the
2086			 * codec power.
2087			 */
2088			twl4030_codec_enable(codec, 0);
2089			twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
2090			twl4030_codec_enable(codec, 1);
2091		} else {
2092			twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
2093		}
2094	}
2095
2096	return 0;
2097}
2098
2099static int twl4030_voice_set_dai_sysclk(struct snd_soc_dai *codec_dai,
2100		int clk_id, unsigned int freq, int dir)
2101{
2102	struct snd_soc_codec *codec = codec_dai->codec;
2103	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
2104
2105	if (freq != 26000000) {
2106		dev_err(codec->dev, "Unsupported APLL mclk: %u, the Voice"
2107			"interface needs 26MHz APLL mclk\n", freq);
 
2108		return -EINVAL;
2109	}
2110	if ((freq / 1000) != twl4030->sysclk) {
2111		dev_err(codec->dev,
2112			"Mismatch in APLL mclk: %u (configured: %u)\n",
2113			freq, twl4030->sysclk * 1000);
2114		return -EINVAL;
2115	}
2116	return 0;
2117}
2118
2119static int twl4030_voice_set_dai_fmt(struct snd_soc_dai *codec_dai,
2120		unsigned int fmt)
2121{
2122	struct snd_soc_codec *codec = codec_dai->codec;
2123	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
2124	u8 old_format, format;
2125
2126	/* get format */
2127	old_format = twl4030_read_reg_cache(codec, TWL4030_REG_VOICE_IF);
2128	format = old_format;
2129
2130	/* set master/slave audio interface */
2131	switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
2132	case SND_SOC_DAIFMT_CBM_CFM:
2133		format &= ~(TWL4030_VIF_SLAVE_EN);
2134		break;
2135	case SND_SOC_DAIFMT_CBS_CFS:
2136		format |= TWL4030_VIF_SLAVE_EN;
2137		break;
2138	default:
2139		return -EINVAL;
2140	}
2141
2142	/* clock inversion */
2143	switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
2144	case SND_SOC_DAIFMT_IB_NF:
2145		format &= ~(TWL4030_VIF_FORMAT);
2146		break;
2147	case SND_SOC_DAIFMT_NB_IF:
2148		format |= TWL4030_VIF_FORMAT;
2149		break;
2150	default:
2151		return -EINVAL;
2152	}
2153
2154	if (format != old_format) {
2155		if (twl4030->codec_powered) {
2156			/*
2157			 * If the codec is powered, than we need to toggle the
2158			 * codec power.
2159			 */
2160			twl4030_codec_enable(codec, 0);
2161			twl4030_write(codec, TWL4030_REG_VOICE_IF, format);
2162			twl4030_codec_enable(codec, 1);
2163		} else {
2164			twl4030_write(codec, TWL4030_REG_VOICE_IF, format);
2165		}
2166	}
2167
2168	return 0;
2169}
2170
2171static int twl4030_voice_set_tristate(struct snd_soc_dai *dai, int tristate)
2172{
2173	struct snd_soc_codec *codec = dai->codec;
2174	u8 reg = twl4030_read_reg_cache(codec, TWL4030_REG_VOICE_IF);
2175
2176	if (tristate)
2177		reg |= TWL4030_VIF_TRI_EN;
2178	else
2179		reg &= ~TWL4030_VIF_TRI_EN;
2180
2181	return twl4030_write(codec, TWL4030_REG_VOICE_IF, reg);
2182}
2183
2184#define TWL4030_RATES	 (SNDRV_PCM_RATE_8000_48000)
2185#define TWL4030_FORMATS	 (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S32_LE)
2186
2187static struct snd_soc_dai_ops twl4030_dai_hifi_ops = {
2188	.startup	= twl4030_startup,
2189	.shutdown	= twl4030_shutdown,
2190	.hw_params	= twl4030_hw_params,
2191	.set_sysclk	= twl4030_set_dai_sysclk,
2192	.set_fmt	= twl4030_set_dai_fmt,
2193	.set_tristate	= twl4030_set_tristate,
2194};
2195
2196static struct snd_soc_dai_ops twl4030_dai_voice_ops = {
2197	.startup	= twl4030_voice_startup,
2198	.shutdown	= twl4030_voice_shutdown,
2199	.hw_params	= twl4030_voice_hw_params,
2200	.set_sysclk	= twl4030_voice_set_dai_sysclk,
2201	.set_fmt	= twl4030_voice_set_dai_fmt,
2202	.set_tristate	= twl4030_voice_set_tristate,
2203};
2204
2205static struct snd_soc_dai_driver twl4030_dai[] = {
2206{
2207	.name = "twl4030-hifi",
2208	.playback = {
2209		.stream_name = "HiFi Playback",
2210		.channels_min = 2,
2211		.channels_max = 4,
2212		.rates = TWL4030_RATES | SNDRV_PCM_RATE_96000,
2213		.formats = TWL4030_FORMATS,},
 
2214	.capture = {
2215		.stream_name = "Capture",
2216		.channels_min = 2,
2217		.channels_max = 4,
2218		.rates = TWL4030_RATES,
2219		.formats = TWL4030_FORMATS,},
 
2220	.ops = &twl4030_dai_hifi_ops,
2221},
2222{
2223	.name = "twl4030-voice",
2224	.playback = {
2225		.stream_name = "Voice Playback",
2226		.channels_min = 1,
2227		.channels_max = 1,
2228		.rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2229		.formats = SNDRV_PCM_FMTBIT_S16_LE,},
2230	.capture = {
2231		.stream_name = "Capture",
2232		.channels_min = 1,
2233		.channels_max = 2,
2234		.rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2235		.formats = SNDRV_PCM_FMTBIT_S16_LE,},
2236	.ops = &twl4030_dai_voice_ops,
2237},
2238};
2239
2240static int twl4030_soc_suspend(struct snd_soc_codec *codec, pm_message_t state)
2241{
2242	twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
2243	return 0;
2244}
2245
2246static int twl4030_soc_resume(struct snd_soc_codec *codec)
2247{
2248	twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2249	return 0;
2250}
2251
2252static int twl4030_soc_probe(struct snd_soc_codec *codec)
2253{
2254	struct twl4030_priv *twl4030;
2255
2256	twl4030 = kzalloc(sizeof(struct twl4030_priv), GFP_KERNEL);
2257	if (twl4030 == NULL) {
2258		printk("Can not allocate memroy\n");
2259		return -ENOMEM;
2260	}
2261	snd_soc_codec_set_drvdata(codec, twl4030);
2262	/* Set the defaults, and power up the codec */
2263	twl4030->sysclk = twl4030_audio_get_mclk() / 1000;
2264	codec->dapm.idle_bias_off = 1;
2265
2266	twl4030_init_chip(codec);
2267
2268	snd_soc_add_controls(codec, twl4030_snd_controls,
2269				ARRAY_SIZE(twl4030_snd_controls));
2270	twl4030_add_widgets(codec);
2271	return 0;
2272}
2273
2274static int twl4030_soc_remove(struct snd_soc_codec *codec)
2275{
2276	struct twl4030_priv *twl4030 = snd_soc_codec_get_drvdata(codec);
 
2277
2278	/* Reset registers to their chip default before leaving */
2279	twl4030_reset_registers(codec);
2280	twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
2281	kfree(twl4030);
2282	return 0;
2283}
2284
2285static struct snd_soc_codec_driver soc_codec_dev_twl4030 = {
2286	.probe = twl4030_soc_probe,
2287	.remove = twl4030_soc_remove,
2288	.suspend = twl4030_soc_suspend,
2289	.resume = twl4030_soc_resume,
2290	.read = twl4030_read_reg_cache,
2291	.write = twl4030_write,
2292	.set_bias_level = twl4030_set_bias_level,
2293	.reg_cache_size = sizeof(twl4030_reg),
2294	.reg_word_size = sizeof(u8),
2295	.reg_cache_default = twl4030_reg,
 
 
 
2296};
2297
2298static int __devinit twl4030_codec_probe(struct platform_device *pdev)
2299{
2300	struct twl4030_codec_data *pdata = pdev->dev.platform_data;
2301
2302	if (!pdata) {
2303		dev_err(&pdev->dev, "platform_data is missing\n");
2304		return -EINVAL;
2305	}
2306
2307	return snd_soc_register_codec(&pdev->dev, &soc_codec_dev_twl4030,
2308			twl4030_dai, ARRAY_SIZE(twl4030_dai));
2309}
2310
2311static int __devexit twl4030_codec_remove(struct platform_device *pdev)
2312{
2313	snd_soc_unregister_codec(&pdev->dev);
2314	return 0;
2315}
2316
2317MODULE_ALIAS("platform:twl4030-codec");
2318
2319static struct platform_driver twl4030_codec_driver = {
2320	.probe		= twl4030_codec_probe,
2321	.remove		= __devexit_p(twl4030_codec_remove),
2322	.driver		= {
2323		.name	= "twl4030-codec",
2324		.owner	= THIS_MODULE,
2325	},
2326};
2327
2328static int __init twl4030_modinit(void)
2329{
2330	return platform_driver_register(&twl4030_codec_driver);
2331}
2332module_init(twl4030_modinit);
2333
2334static void __exit twl4030_exit(void)
2335{
2336	platform_driver_unregister(&twl4030_codec_driver);
2337}
2338module_exit(twl4030_exit);
2339
2340MODULE_DESCRIPTION("ASoC TWL4030 codec driver");
2341MODULE_AUTHOR("Steve Sakoman");
2342MODULE_LICENSE("GPL");