powerpc/pmac: Fix issues with sleep on some powerbooks
[linux-2.6/verdex.git] / sound / soc / codecs / twl4030.c
blob4dbb853eef5ad056fec1e6cca89f0becbe579251
1 /*
2 * ALSA SoC TWL4030 codec driver
4 * Author: Steve Sakoman, <steve@sakoman.com>
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.
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.
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
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/twl4030.h>
30 #include <sound/core.h>
31 #include <sound/pcm.h>
32 #include <sound/pcm_params.h>
33 #include <sound/soc.h>
34 #include <sound/soc-dapm.h>
35 #include <sound/initval.h>
36 #include <sound/tlv.h>
38 #include "twl4030.h"
41 * twl4030 register cache & default register settings
43 static const u8 twl4030_reg[TWL4030_CACHEREGNUM] = {
44 0x00, /* this register not used */
45 0x91, /* REG_CODEC_MODE (0x1) */
46 0xc3, /* REG_OPTION (0x2) */
47 0x00, /* REG_UNKNOWN (0x3) */
48 0x00, /* REG_MICBIAS_CTL (0x4) */
49 0x20, /* REG_ANAMICL (0x5) */
50 0x00, /* REG_ANAMICR (0x6) */
51 0x00, /* REG_AVADC_CTL (0x7) */
52 0x00, /* REG_ADCMICSEL (0x8) */
53 0x00, /* REG_DIGMIXING (0x9) */
54 0x0c, /* REG_ATXL1PGA (0xA) */
55 0x0c, /* REG_ATXR1PGA (0xB) */
56 0x00, /* REG_AVTXL2PGA (0xC) */
57 0x00, /* REG_AVTXR2PGA (0xD) */
58 0x01, /* REG_AUDIO_IF (0xE) */
59 0x00, /* REG_VOICE_IF (0xF) */
60 0x00, /* REG_ARXR1PGA (0x10) */
61 0x00, /* REG_ARXL1PGA (0x11) */
62 0x6c, /* REG_ARXR2PGA (0x12) */
63 0x6c, /* REG_ARXL2PGA (0x13) */
64 0x00, /* REG_VRXPGA (0x14) */
65 0x00, /* REG_VSTPGA (0x15) */
66 0x00, /* REG_VRX2ARXPGA (0x16) */
67 0x0c, /* REG_AVDAC_CTL (0x17) */
68 0x00, /* REG_ARX2VTXPGA (0x18) */
69 0x00, /* REG_ARXL1_APGA_CTL (0x19) */
70 0x00, /* REG_ARXR1_APGA_CTL (0x1A) */
71 0x4b, /* REG_ARXL2_APGA_CTL (0x1B) */
72 0x4b, /* REG_ARXR2_APGA_CTL (0x1C) */
73 0x00, /* REG_ATX2ARXPGA (0x1D) */
74 0x00, /* REG_BT_IF (0x1E) */
75 0x00, /* REG_BTPGA (0x1F) */
76 0x00, /* REG_BTSTPGA (0x20) */
77 0x00, /* REG_EAR_CTL (0x21) */
78 0x24, /* REG_HS_SEL (0x22) */
79 0x0a, /* REG_HS_GAIN_SET (0x23) */
80 0x00, /* REG_HS_POPN_SET (0x24) */
81 0x00, /* REG_PREDL_CTL (0x25) */
82 0x00, /* REG_PREDR_CTL (0x26) */
83 0x00, /* REG_PRECKL_CTL (0x27) */
84 0x00, /* REG_PRECKR_CTL (0x28) */
85 0x00, /* REG_HFL_CTL (0x29) */
86 0x00, /* REG_HFR_CTL (0x2A) */
87 0x00, /* REG_ALC_CTL (0x2B) */
88 0x00, /* REG_ALC_SET1 (0x2C) */
89 0x00, /* REG_ALC_SET2 (0x2D) */
90 0x00, /* REG_BOOST_CTL (0x2E) */
91 0x00, /* REG_SOFTVOL_CTL (0x2F) */
92 0x00, /* REG_DTMF_FREQSEL (0x30) */
93 0x00, /* REG_DTMF_TONEXT1H (0x31) */
94 0x00, /* REG_DTMF_TONEXT1L (0x32) */
95 0x00, /* REG_DTMF_TONEXT2H (0x33) */
96 0x00, /* REG_DTMF_TONEXT2L (0x34) */
97 0x00, /* REG_DTMF_TONOFF (0x35) */
98 0x00, /* REG_DTMF_WANONOFF (0x36) */
99 0x00, /* REG_I2S_RX_SCRAMBLE_H (0x37) */
100 0x00, /* REG_I2S_RX_SCRAMBLE_M (0x38) */
101 0x00, /* REG_I2S_RX_SCRAMBLE_L (0x39) */
102 0x16, /* REG_APLL_CTL (0x3A) */
103 0x00, /* REG_DTMF_CTL (0x3B) */
104 0x00, /* REG_DTMF_PGA_CTL2 (0x3C) */
105 0x00, /* REG_DTMF_PGA_CTL1 (0x3D) */
106 0x00, /* REG_MISC_SET_1 (0x3E) */
107 0x00, /* REG_PCMBTMUX (0x3F) */
108 0x00, /* not used (0x40) */
109 0x00, /* not used (0x41) */
110 0x00, /* not used (0x42) */
111 0x00, /* REG_RX_PATH_SEL (0x43) */
112 0x00, /* REG_VDL_APGA_CTL (0x44) */
113 0x00, /* REG_VIBRA_CTL (0x45) */
114 0x00, /* REG_VIBRA_SET (0x46) */
115 0x00, /* REG_VIBRA_PWM_SET (0x47) */
116 0x00, /* REG_ANAMIC_GAIN (0x48) */
117 0x00, /* REG_MISC_SET_2 (0x49) */
118 0x00, /* REG_SW_SHADOW (0x4A) - Shadow, non HW register */
121 /* codec private data */
122 struct twl4030_priv {
123 unsigned int bypass_state;
124 unsigned int codec_powered;
125 unsigned int codec_muted;
127 struct snd_pcm_substream *master_substream;
128 struct snd_pcm_substream *slave_substream;
130 unsigned int configured;
131 unsigned int rate;
132 unsigned int sample_bits;
133 unsigned int channels;
135 unsigned int sysclk;
137 /* Headset output state handling */
138 unsigned int hsl_enabled;
139 unsigned int hsr_enabled;
143 * read twl4030 register cache
145 static inline unsigned int twl4030_read_reg_cache(struct snd_soc_codec *codec,
146 unsigned int reg)
148 u8 *cache = codec->reg_cache;
150 if (reg >= TWL4030_CACHEREGNUM)
151 return -EIO;
153 return cache[reg];
157 * write twl4030 register cache
159 static inline void twl4030_write_reg_cache(struct snd_soc_codec *codec,
160 u8 reg, u8 value)
162 u8 *cache = codec->reg_cache;
164 if (reg >= TWL4030_CACHEREGNUM)
165 return;
166 cache[reg] = value;
170 * write to the twl4030 register space
172 static int twl4030_write(struct snd_soc_codec *codec,
173 unsigned int reg, unsigned int value)
175 twl4030_write_reg_cache(codec, reg, value);
176 if (likely(reg < TWL4030_REG_SW_SHADOW))
177 return twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, value,
178 reg);
179 else
180 return 0;
183 static void twl4030_codec_enable(struct snd_soc_codec *codec, int enable)
185 struct twl4030_priv *twl4030 = codec->private_data;
186 u8 mode;
188 if (enable == twl4030->codec_powered)
189 return;
191 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE);
192 if (enable)
193 mode |= TWL4030_CODECPDZ;
194 else
195 mode &= ~TWL4030_CODECPDZ;
197 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
198 twl4030->codec_powered = enable;
200 /* REVISIT: this delay is present in TI sample drivers */
201 /* but there seems to be no TRM requirement for it */
202 udelay(10);
205 static void twl4030_init_chip(struct snd_soc_codec *codec)
207 u8 *cache = codec->reg_cache;
208 int i;
210 /* clear CODECPDZ prior to setting register defaults */
211 twl4030_codec_enable(codec, 0);
213 /* set all audio section registers to reasonable defaults */
214 for (i = TWL4030_REG_OPTION; i <= TWL4030_REG_MISC_SET_2; i++)
215 twl4030_write(codec, i, cache[i]);
219 static void twl4030_codec_mute(struct snd_soc_codec *codec, int mute)
221 struct twl4030_priv *twl4030 = codec->private_data;
222 u8 reg_val;
224 if (mute == twl4030->codec_muted)
225 return;
227 if (mute) {
228 /* Bypass the reg_cache and mute the volumes
229 * Headset mute is done in it's own event handler
230 * Things to mute: Earpiece, PreDrivL/R, CarkitL/R
232 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL);
233 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
234 reg_val & (~TWL4030_EAR_GAIN),
235 TWL4030_REG_EAR_CTL);
237 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL);
238 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
239 reg_val & (~TWL4030_PREDL_GAIN),
240 TWL4030_REG_PREDL_CTL);
241 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL);
242 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
243 reg_val & (~TWL4030_PREDR_GAIN),
244 TWL4030_REG_PREDL_CTL);
246 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL);
247 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
248 reg_val & (~TWL4030_PRECKL_GAIN),
249 TWL4030_REG_PRECKL_CTL);
250 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL);
251 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
252 reg_val & (~TWL4030_PRECKR_GAIN),
253 TWL4030_REG_PRECKR_CTL);
255 /* Disable PLL */
256 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
257 reg_val &= ~TWL4030_APLL_EN;
258 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
259 } else {
260 /* Restore the volumes
261 * Headset mute is done in it's own event handler
262 * Things to restore: Earpiece, PreDrivL/R, CarkitL/R
264 twl4030_write(codec, TWL4030_REG_EAR_CTL,
265 twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL));
267 twl4030_write(codec, TWL4030_REG_PREDL_CTL,
268 twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL));
269 twl4030_write(codec, TWL4030_REG_PREDR_CTL,
270 twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL));
272 twl4030_write(codec, TWL4030_REG_PRECKL_CTL,
273 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL));
274 twl4030_write(codec, TWL4030_REG_PRECKR_CTL,
275 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL));
277 /* Enable PLL */
278 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
279 reg_val |= TWL4030_APLL_EN;
280 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
283 twl4030->codec_muted = mute;
286 static void twl4030_power_up(struct snd_soc_codec *codec)
288 struct twl4030_priv *twl4030 = codec->private_data;
289 u8 anamicl, regmisc1, byte;
290 int i = 0;
292 if (twl4030->codec_powered)
293 return;
295 /* set CODECPDZ to turn on codec */
296 twl4030_codec_enable(codec, 1);
298 /* initiate offset cancellation */
299 anamicl = twl4030_read_reg_cache(codec, TWL4030_REG_ANAMICL);
300 twl4030_write(codec, TWL4030_REG_ANAMICL,
301 anamicl | TWL4030_CNCL_OFFSET_START);
303 /* wait for offset cancellation to complete */
304 do {
305 /* this takes a little while, so don't slam i2c */
306 udelay(2000);
307 twl4030_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
308 TWL4030_REG_ANAMICL);
309 } while ((i++ < 100) &&
310 ((byte & TWL4030_CNCL_OFFSET_START) ==
311 TWL4030_CNCL_OFFSET_START));
313 /* Make sure that the reg_cache has the same value as the HW */
314 twl4030_write_reg_cache(codec, TWL4030_REG_ANAMICL, byte);
316 /* anti-pop when changing analog gain */
317 regmisc1 = twl4030_read_reg_cache(codec, TWL4030_REG_MISC_SET_1);
318 twl4030_write(codec, TWL4030_REG_MISC_SET_1,
319 regmisc1 | TWL4030_SMOOTH_ANAVOL_EN);
321 /* toggle CODECPDZ as per TRM */
322 twl4030_codec_enable(codec, 0);
323 twl4030_codec_enable(codec, 1);
327 * Unconditional power down
329 static void twl4030_power_down(struct snd_soc_codec *codec)
331 /* power down */
332 twl4030_codec_enable(codec, 0);
335 /* Earpiece */
336 static const struct snd_kcontrol_new twl4030_dapm_earpiece_controls[] = {
337 SOC_DAPM_SINGLE("Voice", TWL4030_REG_EAR_CTL, 0, 1, 0),
338 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_EAR_CTL, 1, 1, 0),
339 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_EAR_CTL, 2, 1, 0),
340 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_EAR_CTL, 3, 1, 0),
343 /* PreDrive Left */
344 static const struct snd_kcontrol_new twl4030_dapm_predrivel_controls[] = {
345 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDL_CTL, 0, 1, 0),
346 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PREDL_CTL, 1, 1, 0),
347 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDL_CTL, 2, 1, 0),
348 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDL_CTL, 3, 1, 0),
351 /* PreDrive Right */
352 static const struct snd_kcontrol_new twl4030_dapm_predriver_controls[] = {
353 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDR_CTL, 0, 1, 0),
354 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PREDR_CTL, 1, 1, 0),
355 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDR_CTL, 2, 1, 0),
356 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDR_CTL, 3, 1, 0),
359 /* Headset Left */
360 static const struct snd_kcontrol_new twl4030_dapm_hsol_controls[] = {
361 SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 0, 1, 0),
362 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_HS_SEL, 1, 1, 0),
363 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_HS_SEL, 2, 1, 0),
366 /* Headset Right */
367 static const struct snd_kcontrol_new twl4030_dapm_hsor_controls[] = {
368 SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 3, 1, 0),
369 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_HS_SEL, 4, 1, 0),
370 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_HS_SEL, 5, 1, 0),
373 /* Carkit Left */
374 static const struct snd_kcontrol_new twl4030_dapm_carkitl_controls[] = {
375 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKL_CTL, 0, 1, 0),
376 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PRECKL_CTL, 1, 1, 0),
377 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PRECKL_CTL, 2, 1, 0),
380 /* Carkit Right */
381 static const struct snd_kcontrol_new twl4030_dapm_carkitr_controls[] = {
382 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKR_CTL, 0, 1, 0),
383 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PRECKR_CTL, 1, 1, 0),
384 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PRECKR_CTL, 2, 1, 0),
387 /* Handsfree Left */
388 static const char *twl4030_handsfreel_texts[] =
389 {"Voice", "AudioL1", "AudioL2", "AudioR2"};
391 static const struct soc_enum twl4030_handsfreel_enum =
392 SOC_ENUM_SINGLE(TWL4030_REG_HFL_CTL, 0,
393 ARRAY_SIZE(twl4030_handsfreel_texts),
394 twl4030_handsfreel_texts);
396 static const struct snd_kcontrol_new twl4030_dapm_handsfreel_control =
397 SOC_DAPM_ENUM("Route", twl4030_handsfreel_enum);
399 /* Handsfree Left virtual mute */
400 static const struct snd_kcontrol_new twl4030_dapm_handsfreelmute_control =
401 SOC_DAPM_SINGLE("Switch", TWL4030_REG_SW_SHADOW, 0, 1, 0);
403 /* Handsfree Right */
404 static const char *twl4030_handsfreer_texts[] =
405 {"Voice", "AudioR1", "AudioR2", "AudioL2"};
407 static const struct soc_enum twl4030_handsfreer_enum =
408 SOC_ENUM_SINGLE(TWL4030_REG_HFR_CTL, 0,
409 ARRAY_SIZE(twl4030_handsfreer_texts),
410 twl4030_handsfreer_texts);
412 static const struct snd_kcontrol_new twl4030_dapm_handsfreer_control =
413 SOC_DAPM_ENUM("Route", twl4030_handsfreer_enum);
415 /* Handsfree Right virtual mute */
416 static const struct snd_kcontrol_new twl4030_dapm_handsfreermute_control =
417 SOC_DAPM_SINGLE("Switch", TWL4030_REG_SW_SHADOW, 1, 1, 0);
419 /* Vibra */
420 /* Vibra audio path selection */
421 static const char *twl4030_vibra_texts[] =
422 {"AudioL1", "AudioR1", "AudioL2", "AudioR2"};
424 static const struct soc_enum twl4030_vibra_enum =
425 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 2,
426 ARRAY_SIZE(twl4030_vibra_texts),
427 twl4030_vibra_texts);
429 static const struct snd_kcontrol_new twl4030_dapm_vibra_control =
430 SOC_DAPM_ENUM("Route", twl4030_vibra_enum);
432 /* Vibra path selection: local vibrator (PWM) or audio driven */
433 static const char *twl4030_vibrapath_texts[] =
434 {"Local vibrator", "Audio"};
436 static const struct soc_enum twl4030_vibrapath_enum =
437 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 4,
438 ARRAY_SIZE(twl4030_vibrapath_texts),
439 twl4030_vibrapath_texts);
441 static const struct snd_kcontrol_new twl4030_dapm_vibrapath_control =
442 SOC_DAPM_ENUM("Route", twl4030_vibrapath_enum);
444 /* Left analog microphone selection */
445 static const struct snd_kcontrol_new twl4030_dapm_analoglmic_controls[] = {
446 SOC_DAPM_SINGLE("Main mic", TWL4030_REG_ANAMICL, 0, 1, 0),
447 SOC_DAPM_SINGLE("Headset mic", TWL4030_REG_ANAMICL, 1, 1, 0),
448 SOC_DAPM_SINGLE("AUXL", TWL4030_REG_ANAMICL, 2, 1, 0),
449 SOC_DAPM_SINGLE("Carkit mic", TWL4030_REG_ANAMICL, 3, 1, 0),
452 /* Right analog microphone selection */
453 static const struct snd_kcontrol_new twl4030_dapm_analogrmic_controls[] = {
454 SOC_DAPM_SINGLE("Sub mic", TWL4030_REG_ANAMICR, 0, 1, 0),
455 SOC_DAPM_SINGLE("AUXR", TWL4030_REG_ANAMICR, 2, 1, 0),
458 /* TX1 L/R Analog/Digital microphone selection */
459 static const char *twl4030_micpathtx1_texts[] =
460 {"Analog", "Digimic0"};
462 static const struct soc_enum twl4030_micpathtx1_enum =
463 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 0,
464 ARRAY_SIZE(twl4030_micpathtx1_texts),
465 twl4030_micpathtx1_texts);
467 static const struct snd_kcontrol_new twl4030_dapm_micpathtx1_control =
468 SOC_DAPM_ENUM("Route", twl4030_micpathtx1_enum);
470 /* TX2 L/R Analog/Digital microphone selection */
471 static const char *twl4030_micpathtx2_texts[] =
472 {"Analog", "Digimic1"};
474 static const struct soc_enum twl4030_micpathtx2_enum =
475 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 2,
476 ARRAY_SIZE(twl4030_micpathtx2_texts),
477 twl4030_micpathtx2_texts);
479 static const struct snd_kcontrol_new twl4030_dapm_micpathtx2_control =
480 SOC_DAPM_ENUM("Route", twl4030_micpathtx2_enum);
482 /* Analog bypass for AudioR1 */
483 static const struct snd_kcontrol_new twl4030_dapm_abypassr1_control =
484 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR1_APGA_CTL, 2, 1, 0);
486 /* Analog bypass for AudioL1 */
487 static const struct snd_kcontrol_new twl4030_dapm_abypassl1_control =
488 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL1_APGA_CTL, 2, 1, 0);
490 /* Analog bypass for AudioR2 */
491 static const struct snd_kcontrol_new twl4030_dapm_abypassr2_control =
492 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR2_APGA_CTL, 2, 1, 0);
494 /* Analog bypass for AudioL2 */
495 static const struct snd_kcontrol_new twl4030_dapm_abypassl2_control =
496 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL2_APGA_CTL, 2, 1, 0);
498 /* Analog bypass for Voice */
499 static const struct snd_kcontrol_new twl4030_dapm_abypassv_control =
500 SOC_DAPM_SINGLE("Switch", TWL4030_REG_VDL_APGA_CTL, 2, 1, 0);
502 /* Digital bypass gain, 0 mutes the bypass */
503 static const unsigned int twl4030_dapm_dbypass_tlv[] = {
504 TLV_DB_RANGE_HEAD(2),
505 0, 3, TLV_DB_SCALE_ITEM(-2400, 0, 1),
506 4, 7, TLV_DB_SCALE_ITEM(-1800, 600, 0),
509 /* Digital bypass left (TX1L -> RX2L) */
510 static const struct snd_kcontrol_new twl4030_dapm_dbypassl_control =
511 SOC_DAPM_SINGLE_TLV("Volume",
512 TWL4030_REG_ATX2ARXPGA, 3, 7, 0,
513 twl4030_dapm_dbypass_tlv);
515 /* Digital bypass right (TX1R -> RX2R) */
516 static const struct snd_kcontrol_new twl4030_dapm_dbypassr_control =
517 SOC_DAPM_SINGLE_TLV("Volume",
518 TWL4030_REG_ATX2ARXPGA, 0, 7, 0,
519 twl4030_dapm_dbypass_tlv);
522 * Voice Sidetone GAIN volume control:
523 * from -51 to -10 dB in 1 dB steps (mute instead of -51 dB)
525 static DECLARE_TLV_DB_SCALE(twl4030_dapm_dbypassv_tlv, -5100, 100, 1);
527 /* Digital bypass voice: sidetone (VUL -> VDL)*/
528 static const struct snd_kcontrol_new twl4030_dapm_dbypassv_control =
529 SOC_DAPM_SINGLE_TLV("Volume",
530 TWL4030_REG_VSTPGA, 0, 0x29, 0,
531 twl4030_dapm_dbypassv_tlv);
533 static int micpath_event(struct snd_soc_dapm_widget *w,
534 struct snd_kcontrol *kcontrol, int event)
536 struct soc_enum *e = (struct soc_enum *)w->kcontrols->private_value;
537 unsigned char adcmicsel, micbias_ctl;
539 adcmicsel = twl4030_read_reg_cache(w->codec, TWL4030_REG_ADCMICSEL);
540 micbias_ctl = twl4030_read_reg_cache(w->codec, TWL4030_REG_MICBIAS_CTL);
541 /* Prepare the bits for the given TX path:
542 * shift_l == 0: TX1 microphone path
543 * shift_l == 2: TX2 microphone path */
544 if (e->shift_l) {
545 /* TX2 microphone path */
546 if (adcmicsel & TWL4030_TX2IN_SEL)
547 micbias_ctl |= TWL4030_MICBIAS2_CTL; /* digimic */
548 else
549 micbias_ctl &= ~TWL4030_MICBIAS2_CTL;
550 } else {
551 /* TX1 microphone path */
552 if (adcmicsel & TWL4030_TX1IN_SEL)
553 micbias_ctl |= TWL4030_MICBIAS1_CTL; /* digimic */
554 else
555 micbias_ctl &= ~TWL4030_MICBIAS1_CTL;
558 twl4030_write(w->codec, TWL4030_REG_MICBIAS_CTL, micbias_ctl);
560 return 0;
563 static void handsfree_ramp(struct snd_soc_codec *codec, int reg, int ramp)
565 unsigned char hs_ctl;
567 hs_ctl = twl4030_read_reg_cache(codec, reg);
569 if (ramp) {
570 /* HF ramp-up */
571 hs_ctl |= TWL4030_HF_CTL_REF_EN;
572 twl4030_write(codec, reg, hs_ctl);
573 udelay(10);
574 hs_ctl |= TWL4030_HF_CTL_RAMP_EN;
575 twl4030_write(codec, reg, hs_ctl);
576 udelay(40);
577 hs_ctl |= TWL4030_HF_CTL_LOOP_EN;
578 hs_ctl |= TWL4030_HF_CTL_HB_EN;
579 twl4030_write(codec, reg, hs_ctl);
580 } else {
581 /* HF ramp-down */
582 hs_ctl &= ~TWL4030_HF_CTL_LOOP_EN;
583 hs_ctl &= ~TWL4030_HF_CTL_HB_EN;
584 twl4030_write(codec, reg, hs_ctl);
585 hs_ctl &= ~TWL4030_HF_CTL_RAMP_EN;
586 twl4030_write(codec, reg, hs_ctl);
587 udelay(40);
588 hs_ctl &= ~TWL4030_HF_CTL_REF_EN;
589 twl4030_write(codec, reg, hs_ctl);
593 static int handsfreelpga_event(struct snd_soc_dapm_widget *w,
594 struct snd_kcontrol *kcontrol, int event)
596 switch (event) {
597 case SND_SOC_DAPM_POST_PMU:
598 handsfree_ramp(w->codec, TWL4030_REG_HFL_CTL, 1);
599 break;
600 case SND_SOC_DAPM_POST_PMD:
601 handsfree_ramp(w->codec, TWL4030_REG_HFL_CTL, 0);
602 break;
604 return 0;
607 static int handsfreerpga_event(struct snd_soc_dapm_widget *w,
608 struct snd_kcontrol *kcontrol, int event)
610 switch (event) {
611 case SND_SOC_DAPM_POST_PMU:
612 handsfree_ramp(w->codec, TWL4030_REG_HFR_CTL, 1);
613 break;
614 case SND_SOC_DAPM_POST_PMD:
615 handsfree_ramp(w->codec, TWL4030_REG_HFR_CTL, 0);
616 break;
618 return 0;
621 static void headset_ramp(struct snd_soc_codec *codec, int ramp)
623 unsigned char hs_gain, hs_pop;
624 struct twl4030_priv *twl4030 = codec->private_data;
625 /* Base values for ramp delay calculation: 2^19 - 2^26 */
626 unsigned int ramp_base[] = {524288, 1048576, 2097152, 4194304,
627 8388608, 16777216, 33554432, 67108864};
629 hs_gain = twl4030_read_reg_cache(codec, TWL4030_REG_HS_GAIN_SET);
630 hs_pop = twl4030_read_reg_cache(codec, TWL4030_REG_HS_POPN_SET);
632 if (ramp) {
633 /* Headset ramp-up according to the TRM */
634 hs_pop |= TWL4030_VMID_EN;
635 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
636 twl4030_write(codec, TWL4030_REG_HS_GAIN_SET, hs_gain);
637 hs_pop |= TWL4030_RAMP_EN;
638 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
639 } else {
640 /* Headset ramp-down _not_ according to
641 * the TRM, but in a way that it is working */
642 hs_pop &= ~TWL4030_RAMP_EN;
643 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
644 /* Wait ramp delay time + 1, so the VMID can settle */
645 mdelay((ramp_base[(hs_pop & TWL4030_RAMP_DELAY) >> 2] /
646 twl4030->sysclk) + 1);
647 /* Bypass the reg_cache to mute the headset */
648 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
649 hs_gain & (~0x0f),
650 TWL4030_REG_HS_GAIN_SET);
652 hs_pop &= ~TWL4030_VMID_EN;
653 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
657 static int headsetlpga_event(struct snd_soc_dapm_widget *w,
658 struct snd_kcontrol *kcontrol, int event)
660 struct twl4030_priv *twl4030 = w->codec->private_data;
662 switch (event) {
663 case SND_SOC_DAPM_POST_PMU:
664 /* Do the ramp-up only once */
665 if (!twl4030->hsr_enabled)
666 headset_ramp(w->codec, 1);
668 twl4030->hsl_enabled = 1;
669 break;
670 case SND_SOC_DAPM_POST_PMD:
671 /* Do the ramp-down only if both headsetL/R is disabled */
672 if (!twl4030->hsr_enabled)
673 headset_ramp(w->codec, 0);
675 twl4030->hsl_enabled = 0;
676 break;
678 return 0;
681 static int headsetrpga_event(struct snd_soc_dapm_widget *w,
682 struct snd_kcontrol *kcontrol, int event)
684 struct twl4030_priv *twl4030 = w->codec->private_data;
686 switch (event) {
687 case SND_SOC_DAPM_POST_PMU:
688 /* Do the ramp-up only once */
689 if (!twl4030->hsl_enabled)
690 headset_ramp(w->codec, 1);
692 twl4030->hsr_enabled = 1;
693 break;
694 case SND_SOC_DAPM_POST_PMD:
695 /* Do the ramp-down only if both headsetL/R is disabled */
696 if (!twl4030->hsl_enabled)
697 headset_ramp(w->codec, 0);
699 twl4030->hsr_enabled = 0;
700 break;
702 return 0;
705 static int bypass_event(struct snd_soc_dapm_widget *w,
706 struct snd_kcontrol *kcontrol, int event)
708 struct soc_mixer_control *m =
709 (struct soc_mixer_control *)w->kcontrols->private_value;
710 struct twl4030_priv *twl4030 = w->codec->private_data;
711 unsigned char reg, misc;
713 reg = twl4030_read_reg_cache(w->codec, m->reg);
715 if (m->reg <= TWL4030_REG_ARXR2_APGA_CTL) {
716 /* Analog bypass */
717 if (reg & (1 << m->shift))
718 twl4030->bypass_state |=
719 (1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
720 else
721 twl4030->bypass_state &=
722 ~(1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
723 } else if (m->reg == TWL4030_REG_VDL_APGA_CTL) {
724 /* Analog voice bypass */
725 if (reg & (1 << m->shift))
726 twl4030->bypass_state |= (1 << 4);
727 else
728 twl4030->bypass_state &= ~(1 << 4);
729 } else if (m->reg == TWL4030_REG_VSTPGA) {
730 /* Voice digital bypass */
731 if (reg)
732 twl4030->bypass_state |= (1 << 5);
733 else
734 twl4030->bypass_state &= ~(1 << 5);
735 } else {
736 /* Digital bypass */
737 if (reg & (0x7 << m->shift))
738 twl4030->bypass_state |= (1 << (m->shift ? 7 : 6));
739 else
740 twl4030->bypass_state &= ~(1 << (m->shift ? 7 : 6));
743 /* Enable master analog loopback mode if any analog switch is enabled*/
744 misc = twl4030_read_reg_cache(w->codec, TWL4030_REG_MISC_SET_1);
745 if (twl4030->bypass_state & 0x1F)
746 misc |= TWL4030_FMLOOP_EN;
747 else
748 misc &= ~TWL4030_FMLOOP_EN;
749 twl4030_write(w->codec, TWL4030_REG_MISC_SET_1, misc);
751 if (w->codec->bias_level == SND_SOC_BIAS_STANDBY) {
752 if (twl4030->bypass_state)
753 twl4030_codec_mute(w->codec, 0);
754 else
755 twl4030_codec_mute(w->codec, 1);
757 return 0;
761 * Some of the gain controls in TWL (mostly those which are associated with
762 * the outputs) are implemented in an interesting way:
763 * 0x0 : Power down (mute)
764 * 0x1 : 6dB
765 * 0x2 : 0 dB
766 * 0x3 : -6 dB
767 * Inverting not going to help with these.
768 * Custom volsw and volsw_2r get/put functions to handle these gain bits.
770 #define SOC_DOUBLE_TLV_TWL4030(xname, xreg, shift_left, shift_right, xmax,\
771 xinvert, tlv_array) \
772 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
773 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
774 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
775 .tlv.p = (tlv_array), \
776 .info = snd_soc_info_volsw, \
777 .get = snd_soc_get_volsw_twl4030, \
778 .put = snd_soc_put_volsw_twl4030, \
779 .private_value = (unsigned long)&(struct soc_mixer_control) \
780 {.reg = xreg, .shift = shift_left, .rshift = shift_right,\
781 .max = xmax, .invert = xinvert} }
782 #define SOC_DOUBLE_R_TLV_TWL4030(xname, reg_left, reg_right, xshift, xmax,\
783 xinvert, tlv_array) \
784 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
785 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
786 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
787 .tlv.p = (tlv_array), \
788 .info = snd_soc_info_volsw_2r, \
789 .get = snd_soc_get_volsw_r2_twl4030,\
790 .put = snd_soc_put_volsw_r2_twl4030, \
791 .private_value = (unsigned long)&(struct soc_mixer_control) \
792 {.reg = reg_left, .rreg = reg_right, .shift = xshift, \
793 .rshift = xshift, .max = xmax, .invert = xinvert} }
794 #define SOC_SINGLE_TLV_TWL4030(xname, xreg, xshift, xmax, xinvert, tlv_array) \
795 SOC_DOUBLE_TLV_TWL4030(xname, xreg, xshift, xshift, xmax, \
796 xinvert, tlv_array)
798 static int snd_soc_get_volsw_twl4030(struct snd_kcontrol *kcontrol,
799 struct snd_ctl_elem_value *ucontrol)
801 struct soc_mixer_control *mc =
802 (struct soc_mixer_control *)kcontrol->private_value;
803 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
804 unsigned int reg = mc->reg;
805 unsigned int shift = mc->shift;
806 unsigned int rshift = mc->rshift;
807 int max = mc->max;
808 int mask = (1 << fls(max)) - 1;
810 ucontrol->value.integer.value[0] =
811 (snd_soc_read(codec, reg) >> shift) & mask;
812 if (ucontrol->value.integer.value[0])
813 ucontrol->value.integer.value[0] =
814 max + 1 - ucontrol->value.integer.value[0];
816 if (shift != rshift) {
817 ucontrol->value.integer.value[1] =
818 (snd_soc_read(codec, reg) >> rshift) & mask;
819 if (ucontrol->value.integer.value[1])
820 ucontrol->value.integer.value[1] =
821 max + 1 - ucontrol->value.integer.value[1];
824 return 0;
827 static int snd_soc_put_volsw_twl4030(struct snd_kcontrol *kcontrol,
828 struct snd_ctl_elem_value *ucontrol)
830 struct soc_mixer_control *mc =
831 (struct soc_mixer_control *)kcontrol->private_value;
832 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
833 unsigned int reg = mc->reg;
834 unsigned int shift = mc->shift;
835 unsigned int rshift = mc->rshift;
836 int max = mc->max;
837 int mask = (1 << fls(max)) - 1;
838 unsigned short val, val2, val_mask;
840 val = (ucontrol->value.integer.value[0] & mask);
842 val_mask = mask << shift;
843 if (val)
844 val = max + 1 - val;
845 val = val << shift;
846 if (shift != rshift) {
847 val2 = (ucontrol->value.integer.value[1] & mask);
848 val_mask |= mask << rshift;
849 if (val2)
850 val2 = max + 1 - val2;
851 val |= val2 << rshift;
853 return snd_soc_update_bits(codec, reg, val_mask, val);
856 static int snd_soc_get_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
857 struct snd_ctl_elem_value *ucontrol)
859 struct soc_mixer_control *mc =
860 (struct soc_mixer_control *)kcontrol->private_value;
861 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
862 unsigned int reg = mc->reg;
863 unsigned int reg2 = mc->rreg;
864 unsigned int shift = mc->shift;
865 int max = mc->max;
866 int mask = (1<<fls(max))-1;
868 ucontrol->value.integer.value[0] =
869 (snd_soc_read(codec, reg) >> shift) & mask;
870 ucontrol->value.integer.value[1] =
871 (snd_soc_read(codec, reg2) >> shift) & mask;
873 if (ucontrol->value.integer.value[0])
874 ucontrol->value.integer.value[0] =
875 max + 1 - ucontrol->value.integer.value[0];
876 if (ucontrol->value.integer.value[1])
877 ucontrol->value.integer.value[1] =
878 max + 1 - ucontrol->value.integer.value[1];
880 return 0;
883 static int snd_soc_put_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
884 struct snd_ctl_elem_value *ucontrol)
886 struct soc_mixer_control *mc =
887 (struct soc_mixer_control *)kcontrol->private_value;
888 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
889 unsigned int reg = mc->reg;
890 unsigned int reg2 = mc->rreg;
891 unsigned int shift = mc->shift;
892 int max = mc->max;
893 int mask = (1 << fls(max)) - 1;
894 int err;
895 unsigned short val, val2, val_mask;
897 val_mask = mask << shift;
898 val = (ucontrol->value.integer.value[0] & mask);
899 val2 = (ucontrol->value.integer.value[1] & mask);
901 if (val)
902 val = max + 1 - val;
903 if (val2)
904 val2 = max + 1 - val2;
906 val = val << shift;
907 val2 = val2 << shift;
909 err = snd_soc_update_bits(codec, reg, val_mask, val);
910 if (err < 0)
911 return err;
913 err = snd_soc_update_bits(codec, reg2, val_mask, val2);
914 return err;
917 /* Codec operation modes */
918 static const char *twl4030_op_modes_texts[] = {
919 "Option 2 (voice/audio)", "Option 1 (audio)"
922 static const struct soc_enum twl4030_op_modes_enum =
923 SOC_ENUM_SINGLE(TWL4030_REG_CODEC_MODE, 0,
924 ARRAY_SIZE(twl4030_op_modes_texts),
925 twl4030_op_modes_texts);
927 int snd_soc_put_twl4030_opmode_enum_double(struct snd_kcontrol *kcontrol,
928 struct snd_ctl_elem_value *ucontrol)
930 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
931 struct twl4030_priv *twl4030 = codec->private_data;
932 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
933 unsigned short val;
934 unsigned short mask, bitmask;
936 if (twl4030->configured) {
937 printk(KERN_ERR "twl4030 operation mode cannot be "
938 "changed on-the-fly\n");
939 return -EBUSY;
942 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
944 if (ucontrol->value.enumerated.item[0] > e->max - 1)
945 return -EINVAL;
947 val = ucontrol->value.enumerated.item[0] << e->shift_l;
948 mask = (bitmask - 1) << e->shift_l;
949 if (e->shift_l != e->shift_r) {
950 if (ucontrol->value.enumerated.item[1] > e->max - 1)
951 return -EINVAL;
952 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
953 mask |= (bitmask - 1) << e->shift_r;
956 return snd_soc_update_bits(codec, e->reg, mask, val);
960 * FGAIN volume control:
961 * from -62 to 0 dB in 1 dB steps (mute instead of -63 dB)
963 static DECLARE_TLV_DB_SCALE(digital_fine_tlv, -6300, 100, 1);
966 * CGAIN volume control:
967 * 0 dB to 12 dB in 6 dB steps
968 * value 2 and 3 means 12 dB
970 static DECLARE_TLV_DB_SCALE(digital_coarse_tlv, 0, 600, 0);
973 * Voice Downlink GAIN volume control:
974 * from -37 to 12 dB in 1 dB steps (mute instead of -37 dB)
976 static DECLARE_TLV_DB_SCALE(digital_voice_downlink_tlv, -3700, 100, 1);
979 * Analog playback gain
980 * -24 dB to 12 dB in 2 dB steps
982 static DECLARE_TLV_DB_SCALE(analog_tlv, -2400, 200, 0);
985 * Gain controls tied to outputs
986 * -6 dB to 6 dB in 6 dB steps (mute instead of -12)
988 static DECLARE_TLV_DB_SCALE(output_tvl, -1200, 600, 1);
991 * Gain control for earpiece amplifier
992 * 0 dB to 12 dB in 6 dB steps (mute instead of -6)
994 static DECLARE_TLV_DB_SCALE(output_ear_tvl, -600, 600, 1);
997 * Capture gain after the ADCs
998 * from 0 dB to 31 dB in 1 dB steps
1000 static DECLARE_TLV_DB_SCALE(digital_capture_tlv, 0, 100, 0);
1003 * Gain control for input amplifiers
1004 * 0 dB to 30 dB in 6 dB steps
1006 static DECLARE_TLV_DB_SCALE(input_gain_tlv, 0, 600, 0);
1008 static const char *twl4030_rampdelay_texts[] = {
1009 "27/20/14 ms", "55/40/27 ms", "109/81/55 ms", "218/161/109 ms",
1010 "437/323/218 ms", "874/645/437 ms", "1748/1291/874 ms",
1011 "3495/2581/1748 ms"
1014 static const struct soc_enum twl4030_rampdelay_enum =
1015 SOC_ENUM_SINGLE(TWL4030_REG_HS_POPN_SET, 2,
1016 ARRAY_SIZE(twl4030_rampdelay_texts),
1017 twl4030_rampdelay_texts);
1019 /* Vibra H-bridge direction mode */
1020 static const char *twl4030_vibradirmode_texts[] = {
1021 "Vibra H-bridge direction", "Audio data MSB",
1024 static const struct soc_enum twl4030_vibradirmode_enum =
1025 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 5,
1026 ARRAY_SIZE(twl4030_vibradirmode_texts),
1027 twl4030_vibradirmode_texts);
1029 /* Vibra H-bridge direction */
1030 static const char *twl4030_vibradir_texts[] = {
1031 "Positive polarity", "Negative polarity",
1034 static const struct soc_enum twl4030_vibradir_enum =
1035 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 1,
1036 ARRAY_SIZE(twl4030_vibradir_texts),
1037 twl4030_vibradir_texts);
1039 static const struct snd_kcontrol_new twl4030_snd_controls[] = {
1040 /* Codec operation mode control */
1041 SOC_ENUM_EXT("Codec Operation Mode", twl4030_op_modes_enum,
1042 snd_soc_get_enum_double,
1043 snd_soc_put_twl4030_opmode_enum_double),
1045 /* Common playback gain controls */
1046 SOC_DOUBLE_R_TLV("DAC1 Digital Fine Playback Volume",
1047 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1048 0, 0x3f, 0, digital_fine_tlv),
1049 SOC_DOUBLE_R_TLV("DAC2 Digital Fine Playback Volume",
1050 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1051 0, 0x3f, 0, digital_fine_tlv),
1053 SOC_DOUBLE_R_TLV("DAC1 Digital Coarse Playback Volume",
1054 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1055 6, 0x2, 0, digital_coarse_tlv),
1056 SOC_DOUBLE_R_TLV("DAC2 Digital Coarse Playback Volume",
1057 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1058 6, 0x2, 0, digital_coarse_tlv),
1060 SOC_DOUBLE_R_TLV("DAC1 Analog Playback Volume",
1061 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1062 3, 0x12, 1, analog_tlv),
1063 SOC_DOUBLE_R_TLV("DAC2 Analog Playback Volume",
1064 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1065 3, 0x12, 1, analog_tlv),
1066 SOC_DOUBLE_R("DAC1 Analog Playback Switch",
1067 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1068 1, 1, 0),
1069 SOC_DOUBLE_R("DAC2 Analog Playback Switch",
1070 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1071 1, 1, 0),
1073 /* Common voice downlink gain controls */
1074 SOC_SINGLE_TLV("DAC Voice Digital Downlink Volume",
1075 TWL4030_REG_VRXPGA, 0, 0x31, 0, digital_voice_downlink_tlv),
1077 SOC_SINGLE_TLV("DAC Voice Analog Downlink Volume",
1078 TWL4030_REG_VDL_APGA_CTL, 3, 0x12, 1, analog_tlv),
1080 SOC_SINGLE("DAC Voice Analog Downlink Switch",
1081 TWL4030_REG_VDL_APGA_CTL, 1, 1, 0),
1083 /* Separate output gain controls */
1084 SOC_DOUBLE_R_TLV_TWL4030("PreDriv Playback Volume",
1085 TWL4030_REG_PREDL_CTL, TWL4030_REG_PREDR_CTL,
1086 4, 3, 0, output_tvl),
1088 SOC_DOUBLE_TLV_TWL4030("Headset Playback Volume",
1089 TWL4030_REG_HS_GAIN_SET, 0, 2, 3, 0, output_tvl),
1091 SOC_DOUBLE_R_TLV_TWL4030("Carkit Playback Volume",
1092 TWL4030_REG_PRECKL_CTL, TWL4030_REG_PRECKR_CTL,
1093 4, 3, 0, output_tvl),
1095 SOC_SINGLE_TLV_TWL4030("Earpiece Playback Volume",
1096 TWL4030_REG_EAR_CTL, 4, 3, 0, output_ear_tvl),
1098 /* Common capture gain controls */
1099 SOC_DOUBLE_R_TLV("TX1 Digital Capture Volume",
1100 TWL4030_REG_ATXL1PGA, TWL4030_REG_ATXR1PGA,
1101 0, 0x1f, 0, digital_capture_tlv),
1102 SOC_DOUBLE_R_TLV("TX2 Digital Capture Volume",
1103 TWL4030_REG_AVTXL2PGA, TWL4030_REG_AVTXR2PGA,
1104 0, 0x1f, 0, digital_capture_tlv),
1106 SOC_DOUBLE_TLV("Analog Capture Volume", TWL4030_REG_ANAMIC_GAIN,
1107 0, 3, 5, 0, input_gain_tlv),
1109 SOC_ENUM("HS ramp delay", twl4030_rampdelay_enum),
1111 SOC_ENUM("Vibra H-bridge mode", twl4030_vibradirmode_enum),
1112 SOC_ENUM("Vibra H-bridge direction", twl4030_vibradir_enum),
1115 static const struct snd_soc_dapm_widget twl4030_dapm_widgets[] = {
1116 /* Left channel inputs */
1117 SND_SOC_DAPM_INPUT("MAINMIC"),
1118 SND_SOC_DAPM_INPUT("HSMIC"),
1119 SND_SOC_DAPM_INPUT("AUXL"),
1120 SND_SOC_DAPM_INPUT("CARKITMIC"),
1121 /* Right channel inputs */
1122 SND_SOC_DAPM_INPUT("SUBMIC"),
1123 SND_SOC_DAPM_INPUT("AUXR"),
1124 /* Digital microphones (Stereo) */
1125 SND_SOC_DAPM_INPUT("DIGIMIC0"),
1126 SND_SOC_DAPM_INPUT("DIGIMIC1"),
1128 /* Outputs */
1129 SND_SOC_DAPM_OUTPUT("OUTL"),
1130 SND_SOC_DAPM_OUTPUT("OUTR"),
1131 SND_SOC_DAPM_OUTPUT("EARPIECE"),
1132 SND_SOC_DAPM_OUTPUT("PREDRIVEL"),
1133 SND_SOC_DAPM_OUTPUT("PREDRIVER"),
1134 SND_SOC_DAPM_OUTPUT("HSOL"),
1135 SND_SOC_DAPM_OUTPUT("HSOR"),
1136 SND_SOC_DAPM_OUTPUT("CARKITL"),
1137 SND_SOC_DAPM_OUTPUT("CARKITR"),
1138 SND_SOC_DAPM_OUTPUT("HFL"),
1139 SND_SOC_DAPM_OUTPUT("HFR"),
1140 SND_SOC_DAPM_OUTPUT("VIBRA"),
1142 /* DACs */
1143 SND_SOC_DAPM_DAC("DAC Right1", "Right Front HiFi Playback",
1144 SND_SOC_NOPM, 0, 0),
1145 SND_SOC_DAPM_DAC("DAC Left1", "Left Front HiFi Playback",
1146 SND_SOC_NOPM, 0, 0),
1147 SND_SOC_DAPM_DAC("DAC Right2", "Right Rear HiFi Playback",
1148 SND_SOC_NOPM, 0, 0),
1149 SND_SOC_DAPM_DAC("DAC Left2", "Left Rear HiFi Playback",
1150 SND_SOC_NOPM, 0, 0),
1151 SND_SOC_DAPM_DAC("DAC Voice", "Voice Playback",
1152 SND_SOC_NOPM, 0, 0),
1154 /* Analog bypasses */
1155 SND_SOC_DAPM_SWITCH_E("Right1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1156 &twl4030_dapm_abypassr1_control, bypass_event,
1157 SND_SOC_DAPM_POST_REG),
1158 SND_SOC_DAPM_SWITCH_E("Left1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1159 &twl4030_dapm_abypassl1_control,
1160 bypass_event, SND_SOC_DAPM_POST_REG),
1161 SND_SOC_DAPM_SWITCH_E("Right2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1162 &twl4030_dapm_abypassr2_control,
1163 bypass_event, SND_SOC_DAPM_POST_REG),
1164 SND_SOC_DAPM_SWITCH_E("Left2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1165 &twl4030_dapm_abypassl2_control,
1166 bypass_event, SND_SOC_DAPM_POST_REG),
1167 SND_SOC_DAPM_SWITCH_E("Voice Analog Loopback", SND_SOC_NOPM, 0, 0,
1168 &twl4030_dapm_abypassv_control,
1169 bypass_event, SND_SOC_DAPM_POST_REG),
1171 /* Digital bypasses */
1172 SND_SOC_DAPM_SWITCH_E("Left Digital Loopback", SND_SOC_NOPM, 0, 0,
1173 &twl4030_dapm_dbypassl_control, bypass_event,
1174 SND_SOC_DAPM_POST_REG),
1175 SND_SOC_DAPM_SWITCH_E("Right Digital Loopback", SND_SOC_NOPM, 0, 0,
1176 &twl4030_dapm_dbypassr_control, bypass_event,
1177 SND_SOC_DAPM_POST_REG),
1178 SND_SOC_DAPM_SWITCH_E("Voice Digital Loopback", SND_SOC_NOPM, 0, 0,
1179 &twl4030_dapm_dbypassv_control, bypass_event,
1180 SND_SOC_DAPM_POST_REG),
1182 /* Digital mixers, power control for the physical DACs */
1183 SND_SOC_DAPM_MIXER("Digital R1 Playback Mixer",
1184 TWL4030_REG_AVDAC_CTL, 0, 0, NULL, 0),
1185 SND_SOC_DAPM_MIXER("Digital L1 Playback Mixer",
1186 TWL4030_REG_AVDAC_CTL, 1, 0, NULL, 0),
1187 SND_SOC_DAPM_MIXER("Digital R2 Playback Mixer",
1188 TWL4030_REG_AVDAC_CTL, 2, 0, NULL, 0),
1189 SND_SOC_DAPM_MIXER("Digital L2 Playback Mixer",
1190 TWL4030_REG_AVDAC_CTL, 3, 0, NULL, 0),
1191 SND_SOC_DAPM_MIXER("Digital Voice Playback Mixer",
1192 TWL4030_REG_AVDAC_CTL, 4, 0, NULL, 0),
1194 /* Analog mixers, power control for the physical PGAs */
1195 SND_SOC_DAPM_MIXER("Analog R1 Playback Mixer",
1196 TWL4030_REG_ARXR1_APGA_CTL, 0, 0, NULL, 0),
1197 SND_SOC_DAPM_MIXER("Analog L1 Playback Mixer",
1198 TWL4030_REG_ARXL1_APGA_CTL, 0, 0, NULL, 0),
1199 SND_SOC_DAPM_MIXER("Analog R2 Playback Mixer",
1200 TWL4030_REG_ARXR2_APGA_CTL, 0, 0, NULL, 0),
1201 SND_SOC_DAPM_MIXER("Analog L2 Playback Mixer",
1202 TWL4030_REG_ARXL2_APGA_CTL, 0, 0, NULL, 0),
1203 SND_SOC_DAPM_MIXER("Analog Voice Playback Mixer",
1204 TWL4030_REG_VDL_APGA_CTL, 0, 0, NULL, 0),
1206 /* Output MIXER controls */
1207 /* Earpiece */
1208 SND_SOC_DAPM_MIXER("Earpiece Mixer", SND_SOC_NOPM, 0, 0,
1209 &twl4030_dapm_earpiece_controls[0],
1210 ARRAY_SIZE(twl4030_dapm_earpiece_controls)),
1211 /* PreDrivL/R */
1212 SND_SOC_DAPM_MIXER("PredriveL Mixer", SND_SOC_NOPM, 0, 0,
1213 &twl4030_dapm_predrivel_controls[0],
1214 ARRAY_SIZE(twl4030_dapm_predrivel_controls)),
1215 SND_SOC_DAPM_MIXER("PredriveR Mixer", SND_SOC_NOPM, 0, 0,
1216 &twl4030_dapm_predriver_controls[0],
1217 ARRAY_SIZE(twl4030_dapm_predriver_controls)),
1218 /* HeadsetL/R */
1219 SND_SOC_DAPM_MIXER("HeadsetL Mixer", SND_SOC_NOPM, 0, 0,
1220 &twl4030_dapm_hsol_controls[0],
1221 ARRAY_SIZE(twl4030_dapm_hsol_controls)),
1222 SND_SOC_DAPM_PGA_E("HeadsetL PGA", SND_SOC_NOPM,
1223 0, 0, NULL, 0, headsetlpga_event,
1224 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1225 SND_SOC_DAPM_MIXER("HeadsetR Mixer", SND_SOC_NOPM, 0, 0,
1226 &twl4030_dapm_hsor_controls[0],
1227 ARRAY_SIZE(twl4030_dapm_hsor_controls)),
1228 SND_SOC_DAPM_PGA_E("HeadsetR PGA", SND_SOC_NOPM,
1229 0, 0, NULL, 0, headsetrpga_event,
1230 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1231 /* CarkitL/R */
1232 SND_SOC_DAPM_MIXER("CarkitL Mixer", SND_SOC_NOPM, 0, 0,
1233 &twl4030_dapm_carkitl_controls[0],
1234 ARRAY_SIZE(twl4030_dapm_carkitl_controls)),
1235 SND_SOC_DAPM_MIXER("CarkitR Mixer", SND_SOC_NOPM, 0, 0,
1236 &twl4030_dapm_carkitr_controls[0],
1237 ARRAY_SIZE(twl4030_dapm_carkitr_controls)),
1239 /* Output MUX controls */
1240 /* HandsfreeL/R */
1241 SND_SOC_DAPM_MUX("HandsfreeL Mux", SND_SOC_NOPM, 0, 0,
1242 &twl4030_dapm_handsfreel_control),
1243 SND_SOC_DAPM_SWITCH("HandsfreeL Switch", SND_SOC_NOPM, 0, 0,
1244 &twl4030_dapm_handsfreelmute_control),
1245 SND_SOC_DAPM_PGA_E("HandsfreeL PGA", SND_SOC_NOPM,
1246 0, 0, NULL, 0, handsfreelpga_event,
1247 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1248 SND_SOC_DAPM_MUX("HandsfreeR Mux", SND_SOC_NOPM, 5, 0,
1249 &twl4030_dapm_handsfreer_control),
1250 SND_SOC_DAPM_SWITCH("HandsfreeR Switch", SND_SOC_NOPM, 0, 0,
1251 &twl4030_dapm_handsfreermute_control),
1252 SND_SOC_DAPM_PGA_E("HandsfreeR PGA", SND_SOC_NOPM,
1253 0, 0, NULL, 0, handsfreerpga_event,
1254 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1255 /* Vibra */
1256 SND_SOC_DAPM_MUX("Vibra Mux", TWL4030_REG_VIBRA_CTL, 0, 0,
1257 &twl4030_dapm_vibra_control),
1258 SND_SOC_DAPM_MUX("Vibra Route", SND_SOC_NOPM, 0, 0,
1259 &twl4030_dapm_vibrapath_control),
1261 /* Introducing four virtual ADC, since TWL4030 have four channel for
1262 capture */
1263 SND_SOC_DAPM_ADC("ADC Virtual Left1", "Left Front Capture",
1264 SND_SOC_NOPM, 0, 0),
1265 SND_SOC_DAPM_ADC("ADC Virtual Right1", "Right Front Capture",
1266 SND_SOC_NOPM, 0, 0),
1267 SND_SOC_DAPM_ADC("ADC Virtual Left2", "Left Rear Capture",
1268 SND_SOC_NOPM, 0, 0),
1269 SND_SOC_DAPM_ADC("ADC Virtual Right2", "Right Rear Capture",
1270 SND_SOC_NOPM, 0, 0),
1272 /* Analog/Digital mic path selection.
1273 TX1 Left/Right: either analog Left/Right or Digimic0
1274 TX2 Left/Right: either analog Left/Right or Digimic1 */
1275 SND_SOC_DAPM_MUX_E("TX1 Capture Route", SND_SOC_NOPM, 0, 0,
1276 &twl4030_dapm_micpathtx1_control, micpath_event,
1277 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1278 SND_SOC_DAPM_POST_REG),
1279 SND_SOC_DAPM_MUX_E("TX2 Capture Route", SND_SOC_NOPM, 0, 0,
1280 &twl4030_dapm_micpathtx2_control, micpath_event,
1281 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1282 SND_SOC_DAPM_POST_REG),
1284 /* Analog input mixers for the capture amplifiers */
1285 SND_SOC_DAPM_MIXER("Analog Left Capture Route",
1286 TWL4030_REG_ANAMICL, 4, 0,
1287 &twl4030_dapm_analoglmic_controls[0],
1288 ARRAY_SIZE(twl4030_dapm_analoglmic_controls)),
1289 SND_SOC_DAPM_MIXER("Analog Right Capture Route",
1290 TWL4030_REG_ANAMICR, 4, 0,
1291 &twl4030_dapm_analogrmic_controls[0],
1292 ARRAY_SIZE(twl4030_dapm_analogrmic_controls)),
1294 SND_SOC_DAPM_PGA("ADC Physical Left",
1295 TWL4030_REG_AVADC_CTL, 3, 0, NULL, 0),
1296 SND_SOC_DAPM_PGA("ADC Physical Right",
1297 TWL4030_REG_AVADC_CTL, 1, 0, NULL, 0),
1299 SND_SOC_DAPM_PGA("Digimic0 Enable",
1300 TWL4030_REG_ADCMICSEL, 1, 0, NULL, 0),
1301 SND_SOC_DAPM_PGA("Digimic1 Enable",
1302 TWL4030_REG_ADCMICSEL, 3, 0, NULL, 0),
1304 SND_SOC_DAPM_MICBIAS("Mic Bias 1", TWL4030_REG_MICBIAS_CTL, 0, 0),
1305 SND_SOC_DAPM_MICBIAS("Mic Bias 2", TWL4030_REG_MICBIAS_CTL, 1, 0),
1306 SND_SOC_DAPM_MICBIAS("Headset Mic Bias", TWL4030_REG_MICBIAS_CTL, 2, 0),
1310 static const struct snd_soc_dapm_route intercon[] = {
1311 {"Digital L1 Playback Mixer", NULL, "DAC Left1"},
1312 {"Digital R1 Playback Mixer", NULL, "DAC Right1"},
1313 {"Digital L2 Playback Mixer", NULL, "DAC Left2"},
1314 {"Digital R2 Playback Mixer", NULL, "DAC Right2"},
1315 {"Digital Voice Playback Mixer", NULL, "DAC Voice"},
1317 {"Analog L1 Playback Mixer", NULL, "Digital L1 Playback Mixer"},
1318 {"Analog R1 Playback Mixer", NULL, "Digital R1 Playback Mixer"},
1319 {"Analog L2 Playback Mixer", NULL, "Digital L2 Playback Mixer"},
1320 {"Analog R2 Playback Mixer", NULL, "Digital R2 Playback Mixer"},
1321 {"Analog Voice Playback Mixer", NULL, "Digital Voice Playback Mixer"},
1323 /* Internal playback routings */
1324 /* Earpiece */
1325 {"Earpiece Mixer", "Voice", "Analog Voice Playback Mixer"},
1326 {"Earpiece Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1327 {"Earpiece Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1328 {"Earpiece Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1329 /* PreDrivL */
1330 {"PredriveL Mixer", "Voice", "Analog Voice Playback Mixer"},
1331 {"PredriveL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1332 {"PredriveL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1333 {"PredriveL Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1334 /* PreDrivR */
1335 {"PredriveR Mixer", "Voice", "Analog Voice Playback Mixer"},
1336 {"PredriveR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1337 {"PredriveR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1338 {"PredriveR Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1339 /* HeadsetL */
1340 {"HeadsetL Mixer", "Voice", "Analog Voice Playback Mixer"},
1341 {"HeadsetL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1342 {"HeadsetL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1343 {"HeadsetL PGA", NULL, "HeadsetL Mixer"},
1344 /* HeadsetR */
1345 {"HeadsetR Mixer", "Voice", "Analog Voice Playback Mixer"},
1346 {"HeadsetR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1347 {"HeadsetR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1348 {"HeadsetR PGA", NULL, "HeadsetR Mixer"},
1349 /* CarkitL */
1350 {"CarkitL Mixer", "Voice", "Analog Voice Playback Mixer"},
1351 {"CarkitL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1352 {"CarkitL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1353 /* CarkitR */
1354 {"CarkitR Mixer", "Voice", "Analog Voice Playback Mixer"},
1355 {"CarkitR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1356 {"CarkitR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1357 /* HandsfreeL */
1358 {"HandsfreeL Mux", "Voice", "Analog Voice Playback Mixer"},
1359 {"HandsfreeL Mux", "AudioL1", "Analog L1 Playback Mixer"},
1360 {"HandsfreeL Mux", "AudioL2", "Analog L2 Playback Mixer"},
1361 {"HandsfreeL Mux", "AudioR2", "Analog R2 Playback Mixer"},
1362 {"HandsfreeL Switch", "Switch", "HandsfreeL Mux"},
1363 {"HandsfreeL PGA", NULL, "HandsfreeL Switch"},
1364 /* HandsfreeR */
1365 {"HandsfreeR Mux", "Voice", "Analog Voice Playback Mixer"},
1366 {"HandsfreeR Mux", "AudioR1", "Analog R1 Playback Mixer"},
1367 {"HandsfreeR Mux", "AudioR2", "Analog R2 Playback Mixer"},
1368 {"HandsfreeR Mux", "AudioL2", "Analog L2 Playback Mixer"},
1369 {"HandsfreeR Switch", "Switch", "HandsfreeR Mux"},
1370 {"HandsfreeR PGA", NULL, "HandsfreeR Switch"},
1371 /* Vibra */
1372 {"Vibra Mux", "AudioL1", "DAC Left1"},
1373 {"Vibra Mux", "AudioR1", "DAC Right1"},
1374 {"Vibra Mux", "AudioL2", "DAC Left2"},
1375 {"Vibra Mux", "AudioR2", "DAC Right2"},
1377 /* outputs */
1378 {"OUTL", NULL, "Analog L2 Playback Mixer"},
1379 {"OUTR", NULL, "Analog R2 Playback Mixer"},
1380 {"EARPIECE", NULL, "Earpiece Mixer"},
1381 {"PREDRIVEL", NULL, "PredriveL Mixer"},
1382 {"PREDRIVER", NULL, "PredriveR Mixer"},
1383 {"HSOL", NULL, "HeadsetL PGA"},
1384 {"HSOR", NULL, "HeadsetR PGA"},
1385 {"CARKITL", NULL, "CarkitL Mixer"},
1386 {"CARKITR", NULL, "CarkitR Mixer"},
1387 {"HFL", NULL, "HandsfreeL PGA"},
1388 {"HFR", NULL, "HandsfreeR PGA"},
1389 {"Vibra Route", "Audio", "Vibra Mux"},
1390 {"VIBRA", NULL, "Vibra Route"},
1392 /* Capture path */
1393 {"Analog Left Capture Route", "Main mic", "MAINMIC"},
1394 {"Analog Left Capture Route", "Headset mic", "HSMIC"},
1395 {"Analog Left Capture Route", "AUXL", "AUXL"},
1396 {"Analog Left Capture Route", "Carkit mic", "CARKITMIC"},
1398 {"Analog Right Capture Route", "Sub mic", "SUBMIC"},
1399 {"Analog Right Capture Route", "AUXR", "AUXR"},
1401 {"ADC Physical Left", NULL, "Analog Left Capture Route"},
1402 {"ADC Physical Right", NULL, "Analog Right Capture Route"},
1404 {"Digimic0 Enable", NULL, "DIGIMIC0"},
1405 {"Digimic1 Enable", NULL, "DIGIMIC1"},
1407 /* TX1 Left capture path */
1408 {"TX1 Capture Route", "Analog", "ADC Physical Left"},
1409 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1410 /* TX1 Right capture path */
1411 {"TX1 Capture Route", "Analog", "ADC Physical Right"},
1412 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1413 /* TX2 Left capture path */
1414 {"TX2 Capture Route", "Analog", "ADC Physical Left"},
1415 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1416 /* TX2 Right capture path */
1417 {"TX2 Capture Route", "Analog", "ADC Physical Right"},
1418 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1420 {"ADC Virtual Left1", NULL, "TX1 Capture Route"},
1421 {"ADC Virtual Right1", NULL, "TX1 Capture Route"},
1422 {"ADC Virtual Left2", NULL, "TX2 Capture Route"},
1423 {"ADC Virtual Right2", NULL, "TX2 Capture Route"},
1425 /* Analog bypass routes */
1426 {"Right1 Analog Loopback", "Switch", "Analog Right Capture Route"},
1427 {"Left1 Analog Loopback", "Switch", "Analog Left Capture Route"},
1428 {"Right2 Analog Loopback", "Switch", "Analog Right Capture Route"},
1429 {"Left2 Analog Loopback", "Switch", "Analog Left Capture Route"},
1430 {"Voice Analog Loopback", "Switch", "Analog Left Capture Route"},
1432 {"Analog R1 Playback Mixer", NULL, "Right1 Analog Loopback"},
1433 {"Analog L1 Playback Mixer", NULL, "Left1 Analog Loopback"},
1434 {"Analog R2 Playback Mixer", NULL, "Right2 Analog Loopback"},
1435 {"Analog L2 Playback Mixer", NULL, "Left2 Analog Loopback"},
1436 {"Analog Voice Playback Mixer", NULL, "Voice Analog Loopback"},
1438 /* Digital bypass routes */
1439 {"Right Digital Loopback", "Volume", "TX1 Capture Route"},
1440 {"Left Digital Loopback", "Volume", "TX1 Capture Route"},
1441 {"Voice Digital Loopback", "Volume", "TX2 Capture Route"},
1443 {"Digital R2 Playback Mixer", NULL, "Right Digital Loopback"},
1444 {"Digital L2 Playback Mixer", NULL, "Left Digital Loopback"},
1445 {"Digital Voice Playback Mixer", NULL, "Voice Digital Loopback"},
1449 static int twl4030_add_widgets(struct snd_soc_codec *codec)
1451 snd_soc_dapm_new_controls(codec, twl4030_dapm_widgets,
1452 ARRAY_SIZE(twl4030_dapm_widgets));
1454 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
1456 snd_soc_dapm_new_widgets(codec);
1457 return 0;
1460 static int twl4030_set_bias_level(struct snd_soc_codec *codec,
1461 enum snd_soc_bias_level level)
1463 struct twl4030_priv *twl4030 = codec->private_data;
1465 switch (level) {
1466 case SND_SOC_BIAS_ON:
1467 twl4030_codec_mute(codec, 0);
1468 break;
1469 case SND_SOC_BIAS_PREPARE:
1470 twl4030_power_up(codec);
1471 if (twl4030->bypass_state)
1472 twl4030_codec_mute(codec, 0);
1473 else
1474 twl4030_codec_mute(codec, 1);
1475 break;
1476 case SND_SOC_BIAS_STANDBY:
1477 twl4030_power_up(codec);
1478 if (twl4030->bypass_state)
1479 twl4030_codec_mute(codec, 0);
1480 else
1481 twl4030_codec_mute(codec, 1);
1482 break;
1483 case SND_SOC_BIAS_OFF:
1484 twl4030_power_down(codec);
1485 break;
1487 codec->bias_level = level;
1489 return 0;
1492 static void twl4030_constraints(struct twl4030_priv *twl4030,
1493 struct snd_pcm_substream *mst_substream)
1495 struct snd_pcm_substream *slv_substream;
1497 /* Pick the stream, which need to be constrained */
1498 if (mst_substream == twl4030->master_substream)
1499 slv_substream = twl4030->slave_substream;
1500 else if (mst_substream == twl4030->slave_substream)
1501 slv_substream = twl4030->master_substream;
1502 else /* This should not happen.. */
1503 return;
1505 /* Set the constraints according to the already configured stream */
1506 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1507 SNDRV_PCM_HW_PARAM_RATE,
1508 twl4030->rate,
1509 twl4030->rate);
1511 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1512 SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1513 twl4030->sample_bits,
1514 twl4030->sample_bits);
1516 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1517 SNDRV_PCM_HW_PARAM_CHANNELS,
1518 twl4030->channels,
1519 twl4030->channels);
1522 /* In case of 4 channel mode, the RX1 L/R for playback and the TX2 L/R for
1523 * capture has to be enabled/disabled. */
1524 static void twl4030_tdm_enable(struct snd_soc_codec *codec, int direction,
1525 int enable)
1527 u8 reg, mask;
1529 reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1531 if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1532 mask = TWL4030_ARXL1_VRX_EN | TWL4030_ARXR1_EN;
1533 else
1534 mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1536 if (enable)
1537 reg |= mask;
1538 else
1539 reg &= ~mask;
1541 twl4030_write(codec, TWL4030_REG_OPTION, reg);
1544 static int twl4030_startup(struct snd_pcm_substream *substream,
1545 struct snd_soc_dai *dai)
1547 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1548 struct snd_soc_device *socdev = rtd->socdev;
1549 struct snd_soc_codec *codec = socdev->card->codec;
1550 struct twl4030_priv *twl4030 = codec->private_data;
1552 if (twl4030->master_substream) {
1553 twl4030->slave_substream = substream;
1554 /* The DAI has one configuration for playback and capture, so
1555 * if the DAI has been already configured then constrain this
1556 * substream to match it. */
1557 if (twl4030->configured)
1558 twl4030_constraints(twl4030, twl4030->master_substream);
1559 } else {
1560 if (!(twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE) &
1561 TWL4030_OPTION_1)) {
1562 /* In option2 4 channel is not supported, set the
1563 * constraint for the first stream for channels, the
1564 * second stream will 'inherit' this cosntraint */
1565 snd_pcm_hw_constraint_minmax(substream->runtime,
1566 SNDRV_PCM_HW_PARAM_CHANNELS,
1567 2, 2);
1569 twl4030->master_substream = substream;
1572 return 0;
1575 static void twl4030_shutdown(struct snd_pcm_substream *substream,
1576 struct snd_soc_dai *dai)
1578 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1579 struct snd_soc_device *socdev = rtd->socdev;
1580 struct snd_soc_codec *codec = socdev->card->codec;
1581 struct twl4030_priv *twl4030 = codec->private_data;
1583 if (twl4030->master_substream == substream)
1584 twl4030->master_substream = twl4030->slave_substream;
1586 twl4030->slave_substream = NULL;
1588 /* If all streams are closed, or the remaining stream has not yet
1589 * been configured than set the DAI as not configured. */
1590 if (!twl4030->master_substream)
1591 twl4030->configured = 0;
1592 else if (!twl4030->master_substream->runtime->channels)
1593 twl4030->configured = 0;
1595 /* If the closing substream had 4 channel, do the necessary cleanup */
1596 if (substream->runtime->channels == 4)
1597 twl4030_tdm_enable(codec, substream->stream, 0);
1600 static int twl4030_hw_params(struct snd_pcm_substream *substream,
1601 struct snd_pcm_hw_params *params,
1602 struct snd_soc_dai *dai)
1604 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1605 struct snd_soc_device *socdev = rtd->socdev;
1606 struct snd_soc_codec *codec = socdev->card->codec;
1607 struct twl4030_priv *twl4030 = codec->private_data;
1608 u8 mode, old_mode, format, old_format;
1610 /* If the substream has 4 channel, do the necessary setup */
1611 if (params_channels(params) == 4) {
1612 u8 format, mode;
1614 format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1615 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE);
1617 /* Safety check: are we in the correct operating mode and
1618 * the interface is in TDM mode? */
1619 if ((mode & TWL4030_OPTION_1) &&
1620 ((format & TWL4030_AIF_FORMAT) == TWL4030_AIF_FORMAT_TDM))
1621 twl4030_tdm_enable(codec, substream->stream, 1);
1622 else
1623 return -EINVAL;
1626 if (twl4030->configured)
1627 /* Ignoring hw_params for already configured DAI */
1628 return 0;
1630 /* bit rate */
1631 old_mode = twl4030_read_reg_cache(codec,
1632 TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1633 mode = old_mode & ~TWL4030_APLL_RATE;
1635 switch (params_rate(params)) {
1636 case 8000:
1637 mode |= TWL4030_APLL_RATE_8000;
1638 break;
1639 case 11025:
1640 mode |= TWL4030_APLL_RATE_11025;
1641 break;
1642 case 12000:
1643 mode |= TWL4030_APLL_RATE_12000;
1644 break;
1645 case 16000:
1646 mode |= TWL4030_APLL_RATE_16000;
1647 break;
1648 case 22050:
1649 mode |= TWL4030_APLL_RATE_22050;
1650 break;
1651 case 24000:
1652 mode |= TWL4030_APLL_RATE_24000;
1653 break;
1654 case 32000:
1655 mode |= TWL4030_APLL_RATE_32000;
1656 break;
1657 case 44100:
1658 mode |= TWL4030_APLL_RATE_44100;
1659 break;
1660 case 48000:
1661 mode |= TWL4030_APLL_RATE_48000;
1662 break;
1663 case 96000:
1664 mode |= TWL4030_APLL_RATE_96000;
1665 break;
1666 default:
1667 printk(KERN_ERR "TWL4030 hw params: unknown rate %d\n",
1668 params_rate(params));
1669 return -EINVAL;
1672 if (mode != old_mode) {
1673 /* change rate and set CODECPDZ */
1674 twl4030_codec_enable(codec, 0);
1675 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1676 twl4030_codec_enable(codec, 1);
1679 /* sample size */
1680 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1681 format = old_format;
1682 format &= ~TWL4030_DATA_WIDTH;
1683 switch (params_format(params)) {
1684 case SNDRV_PCM_FORMAT_S16_LE:
1685 format |= TWL4030_DATA_WIDTH_16S_16W;
1686 break;
1687 case SNDRV_PCM_FORMAT_S24_LE:
1688 format |= TWL4030_DATA_WIDTH_32S_24W;
1689 break;
1690 default:
1691 printk(KERN_ERR "TWL4030 hw params: unknown format %d\n",
1692 params_format(params));
1693 return -EINVAL;
1696 if (format != old_format) {
1698 /* clear CODECPDZ before changing format (codec requirement) */
1699 twl4030_codec_enable(codec, 0);
1701 /* change format */
1702 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1704 /* set CODECPDZ afterwards */
1705 twl4030_codec_enable(codec, 1);
1708 /* Store the important parameters for the DAI configuration and set
1709 * the DAI as configured */
1710 twl4030->configured = 1;
1711 twl4030->rate = params_rate(params);
1712 twl4030->sample_bits = hw_param_interval(params,
1713 SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
1714 twl4030->channels = params_channels(params);
1716 /* If both playback and capture streams are open, and one of them
1717 * is setting the hw parameters right now (since we are here), set
1718 * constraints to the other stream to match the current one. */
1719 if (twl4030->slave_substream)
1720 twl4030_constraints(twl4030, substream);
1722 return 0;
1725 static int twl4030_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1726 int clk_id, unsigned int freq, int dir)
1728 struct snd_soc_codec *codec = codec_dai->codec;
1729 struct twl4030_priv *twl4030 = codec->private_data;
1730 u8 infreq;
1732 switch (freq) {
1733 case 19200000:
1734 infreq = TWL4030_APLL_INFREQ_19200KHZ;
1735 twl4030->sysclk = 19200;
1736 break;
1737 case 26000000:
1738 infreq = TWL4030_APLL_INFREQ_26000KHZ;
1739 twl4030->sysclk = 26000;
1740 break;
1741 case 38400000:
1742 infreq = TWL4030_APLL_INFREQ_38400KHZ;
1743 twl4030->sysclk = 38400;
1744 break;
1745 default:
1746 printk(KERN_ERR "TWL4030 set sysclk: unknown rate %d\n",
1747 freq);
1748 return -EINVAL;
1751 infreq |= TWL4030_APLL_EN;
1752 twl4030_write(codec, TWL4030_REG_APLL_CTL, infreq);
1754 return 0;
1757 static int twl4030_set_dai_fmt(struct snd_soc_dai *codec_dai,
1758 unsigned int fmt)
1760 struct snd_soc_codec *codec = codec_dai->codec;
1761 u8 old_format, format;
1763 /* get format */
1764 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1765 format = old_format;
1767 /* set master/slave audio interface */
1768 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1769 case SND_SOC_DAIFMT_CBM_CFM:
1770 format &= ~(TWL4030_AIF_SLAVE_EN);
1771 format &= ~(TWL4030_CLK256FS_EN);
1772 break;
1773 case SND_SOC_DAIFMT_CBS_CFS:
1774 format |= TWL4030_AIF_SLAVE_EN;
1775 format |= TWL4030_CLK256FS_EN;
1776 break;
1777 default:
1778 return -EINVAL;
1781 /* interface format */
1782 format &= ~TWL4030_AIF_FORMAT;
1783 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1784 case SND_SOC_DAIFMT_I2S:
1785 format |= TWL4030_AIF_FORMAT_CODEC;
1786 break;
1787 case SND_SOC_DAIFMT_DSP_A:
1788 format |= TWL4030_AIF_FORMAT_TDM;
1789 break;
1790 default:
1791 return -EINVAL;
1794 if (format != old_format) {
1796 /* clear CODECPDZ before changing format (codec requirement) */
1797 twl4030_codec_enable(codec, 0);
1799 /* change format */
1800 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1802 /* set CODECPDZ afterwards */
1803 twl4030_codec_enable(codec, 1);
1806 return 0;
1809 /* In case of voice mode, the RX1 L(VRX) for downlink and the TX2 L/R
1810 * (VTXL, VTXR) for uplink has to be enabled/disabled. */
1811 static void twl4030_voice_enable(struct snd_soc_codec *codec, int direction,
1812 int enable)
1814 u8 reg, mask;
1816 reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1818 if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1819 mask = TWL4030_ARXL1_VRX_EN;
1820 else
1821 mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1823 if (enable)
1824 reg |= mask;
1825 else
1826 reg &= ~mask;
1828 twl4030_write(codec, TWL4030_REG_OPTION, reg);
1831 static int twl4030_voice_startup(struct snd_pcm_substream *substream,
1832 struct snd_soc_dai *dai)
1834 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1835 struct snd_soc_device *socdev = rtd->socdev;
1836 struct snd_soc_codec *codec = socdev->card->codec;
1837 u8 infreq;
1838 u8 mode;
1840 /* If the system master clock is not 26MHz, the voice PCM interface is
1841 * not avilable.
1843 infreq = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL)
1844 & TWL4030_APLL_INFREQ;
1846 if (infreq != TWL4030_APLL_INFREQ_26000KHZ) {
1847 printk(KERN_ERR "TWL4030 voice startup: "
1848 "MCLK is not 26MHz, call set_sysclk() on init\n");
1849 return -EINVAL;
1852 /* If the codec mode is not option2, the voice PCM interface is not
1853 * avilable.
1855 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
1856 & TWL4030_OPT_MODE;
1858 if (mode != TWL4030_OPTION_2) {
1859 printk(KERN_ERR "TWL4030 voice startup: "
1860 "the codec mode is not option2\n");
1861 return -EINVAL;
1864 return 0;
1867 static void twl4030_voice_shutdown(struct snd_pcm_substream *substream,
1868 struct snd_soc_dai *dai)
1870 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1871 struct snd_soc_device *socdev = rtd->socdev;
1872 struct snd_soc_codec *codec = socdev->card->codec;
1874 /* Enable voice digital filters */
1875 twl4030_voice_enable(codec, substream->stream, 0);
1878 static int twl4030_voice_hw_params(struct snd_pcm_substream *substream,
1879 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
1881 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1882 struct snd_soc_device *socdev = rtd->socdev;
1883 struct snd_soc_codec *codec = socdev->card->codec;
1884 u8 old_mode, mode;
1886 /* Enable voice digital filters */
1887 twl4030_voice_enable(codec, substream->stream, 1);
1889 /* bit rate */
1890 old_mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
1891 & ~(TWL4030_CODECPDZ);
1892 mode = old_mode;
1894 switch (params_rate(params)) {
1895 case 8000:
1896 mode &= ~(TWL4030_SEL_16K);
1897 break;
1898 case 16000:
1899 mode |= TWL4030_SEL_16K;
1900 break;
1901 default:
1902 printk(KERN_ERR "TWL4030 voice hw params: unknown rate %d\n",
1903 params_rate(params));
1904 return -EINVAL;
1907 if (mode != old_mode) {
1908 /* change rate and set CODECPDZ */
1909 twl4030_codec_enable(codec, 0);
1910 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1911 twl4030_codec_enable(codec, 1);
1914 return 0;
1917 static int twl4030_voice_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1918 int clk_id, unsigned int freq, int dir)
1920 struct snd_soc_codec *codec = codec_dai->codec;
1921 u8 infreq;
1923 switch (freq) {
1924 case 26000000:
1925 infreq = TWL4030_APLL_INFREQ_26000KHZ;
1926 break;
1927 default:
1928 printk(KERN_ERR "TWL4030 voice set sysclk: unknown rate %d\n",
1929 freq);
1930 return -EINVAL;
1933 infreq |= TWL4030_APLL_EN;
1934 twl4030_write(codec, TWL4030_REG_APLL_CTL, infreq);
1936 return 0;
1939 static int twl4030_voice_set_dai_fmt(struct snd_soc_dai *codec_dai,
1940 unsigned int fmt)
1942 struct snd_soc_codec *codec = codec_dai->codec;
1943 u8 old_format, format;
1945 /* get format */
1946 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_VOICE_IF);
1947 format = old_format;
1949 /* set master/slave audio interface */
1950 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1951 case SND_SOC_DAIFMT_CBS_CFM:
1952 format &= ~(TWL4030_VIF_SLAVE_EN);
1953 break;
1954 case SND_SOC_DAIFMT_CBS_CFS:
1955 format |= TWL4030_VIF_SLAVE_EN;
1956 break;
1957 default:
1958 return -EINVAL;
1961 /* clock inversion */
1962 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1963 case SND_SOC_DAIFMT_IB_NF:
1964 format &= ~(TWL4030_VIF_FORMAT);
1965 break;
1966 case SND_SOC_DAIFMT_NB_IF:
1967 format |= TWL4030_VIF_FORMAT;
1968 break;
1969 default:
1970 return -EINVAL;
1973 if (format != old_format) {
1974 /* change format and set CODECPDZ */
1975 twl4030_codec_enable(codec, 0);
1976 twl4030_write(codec, TWL4030_REG_VOICE_IF, format);
1977 twl4030_codec_enable(codec, 1);
1980 return 0;
1983 #define TWL4030_RATES (SNDRV_PCM_RATE_8000_48000)
1984 #define TWL4030_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FORMAT_S24_LE)
1986 static struct snd_soc_dai_ops twl4030_dai_ops = {
1987 .startup = twl4030_startup,
1988 .shutdown = twl4030_shutdown,
1989 .hw_params = twl4030_hw_params,
1990 .set_sysclk = twl4030_set_dai_sysclk,
1991 .set_fmt = twl4030_set_dai_fmt,
1994 static struct snd_soc_dai_ops twl4030_dai_voice_ops = {
1995 .startup = twl4030_voice_startup,
1996 .shutdown = twl4030_voice_shutdown,
1997 .hw_params = twl4030_voice_hw_params,
1998 .set_sysclk = twl4030_voice_set_dai_sysclk,
1999 .set_fmt = twl4030_voice_set_dai_fmt,
2002 struct snd_soc_dai twl4030_dai[] = {
2004 .name = "twl4030",
2005 .playback = {
2006 .stream_name = "HiFi Playback",
2007 .channels_min = 2,
2008 .channels_max = 4,
2009 .rates = TWL4030_RATES | SNDRV_PCM_RATE_96000,
2010 .formats = TWL4030_FORMATS,},
2011 .capture = {
2012 .stream_name = "Capture",
2013 .channels_min = 2,
2014 .channels_max = 4,
2015 .rates = TWL4030_RATES,
2016 .formats = TWL4030_FORMATS,},
2017 .ops = &twl4030_dai_ops,
2020 .name = "twl4030 Voice",
2021 .playback = {
2022 .stream_name = "Voice Playback",
2023 .channels_min = 1,
2024 .channels_max = 1,
2025 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2026 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
2027 .capture = {
2028 .stream_name = "Capture",
2029 .channels_min = 1,
2030 .channels_max = 2,
2031 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
2032 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
2033 .ops = &twl4030_dai_voice_ops,
2036 EXPORT_SYMBOL_GPL(twl4030_dai);
2038 static int twl4030_suspend(struct platform_device *pdev, pm_message_t state)
2040 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2041 struct snd_soc_codec *codec = socdev->card->codec;
2043 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
2045 return 0;
2048 static int twl4030_resume(struct platform_device *pdev)
2050 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2051 struct snd_soc_codec *codec = socdev->card->codec;
2053 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2054 twl4030_set_bias_level(codec, codec->suspend_bias_level);
2055 return 0;
2059 * initialize the driver
2060 * register the mixer and dsp interfaces with the kernel
2063 static int twl4030_init(struct snd_soc_device *socdev)
2065 struct snd_soc_codec *codec = socdev->card->codec;
2066 struct twl4030_setup_data *setup = socdev->codec_data;
2067 struct twl4030_priv *twl4030 = codec->private_data;
2068 int ret = 0;
2070 printk(KERN_INFO "TWL4030 Audio Codec init \n");
2072 codec->name = "twl4030";
2073 codec->owner = THIS_MODULE;
2074 codec->read = twl4030_read_reg_cache;
2075 codec->write = twl4030_write;
2076 codec->set_bias_level = twl4030_set_bias_level;
2077 codec->dai = twl4030_dai;
2078 codec->num_dai = ARRAY_SIZE(twl4030_dai),
2079 codec->reg_cache_size = sizeof(twl4030_reg);
2080 codec->reg_cache = kmemdup(twl4030_reg, sizeof(twl4030_reg),
2081 GFP_KERNEL);
2082 if (codec->reg_cache == NULL)
2083 return -ENOMEM;
2085 /* Configuration for headset ramp delay from setup data */
2086 if (setup) {
2087 unsigned char hs_pop;
2089 if (setup->sysclk)
2090 twl4030->sysclk = setup->sysclk;
2091 else
2092 twl4030->sysclk = 26000;
2094 hs_pop = twl4030_read_reg_cache(codec, TWL4030_REG_HS_POPN_SET);
2095 hs_pop &= ~TWL4030_RAMP_DELAY;
2096 hs_pop |= (setup->ramp_delay_value << 2);
2097 twl4030_write_reg_cache(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
2098 } else {
2099 twl4030->sysclk = 26000;
2102 /* register pcms */
2103 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
2104 if (ret < 0) {
2105 printk(KERN_ERR "twl4030: failed to create pcms\n");
2106 goto pcm_err;
2109 twl4030_init_chip(codec);
2111 /* power on device */
2112 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2114 snd_soc_add_controls(codec, twl4030_snd_controls,
2115 ARRAY_SIZE(twl4030_snd_controls));
2116 twl4030_add_widgets(codec);
2118 ret = snd_soc_init_card(socdev);
2119 if (ret < 0) {
2120 printk(KERN_ERR "twl4030: failed to register card\n");
2121 goto card_err;
2124 return ret;
2126 card_err:
2127 snd_soc_free_pcms(socdev);
2128 snd_soc_dapm_free(socdev);
2129 pcm_err:
2130 kfree(codec->reg_cache);
2131 return ret;
2134 static struct snd_soc_device *twl4030_socdev;
2136 static int twl4030_probe(struct platform_device *pdev)
2138 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2139 struct snd_soc_codec *codec;
2140 struct twl4030_priv *twl4030;
2142 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
2143 if (codec == NULL)
2144 return -ENOMEM;
2146 twl4030 = kzalloc(sizeof(struct twl4030_priv), GFP_KERNEL);
2147 if (twl4030 == NULL) {
2148 kfree(codec);
2149 return -ENOMEM;
2152 codec->private_data = twl4030;
2153 socdev->card->codec = codec;
2154 mutex_init(&codec->mutex);
2155 INIT_LIST_HEAD(&codec->dapm_widgets);
2156 INIT_LIST_HEAD(&codec->dapm_paths);
2158 twl4030_socdev = socdev;
2159 twl4030_init(socdev);
2161 return 0;
2164 static int twl4030_remove(struct platform_device *pdev)
2166 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2167 struct snd_soc_codec *codec = socdev->card->codec;
2169 printk(KERN_INFO "TWL4030 Audio Codec remove\n");
2170 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
2171 snd_soc_free_pcms(socdev);
2172 snd_soc_dapm_free(socdev);
2173 kfree(codec->private_data);
2174 kfree(codec);
2176 return 0;
2179 struct snd_soc_codec_device soc_codec_dev_twl4030 = {
2180 .probe = twl4030_probe,
2181 .remove = twl4030_remove,
2182 .suspend = twl4030_suspend,
2183 .resume = twl4030_resume,
2185 EXPORT_SYMBOL_GPL(soc_codec_dev_twl4030);
2187 static int __init twl4030_modinit(void)
2189 return snd_soc_register_dais(&twl4030_dai[0], ARRAY_SIZE(twl4030_dai));
2191 module_init(twl4030_modinit);
2193 static void __exit twl4030_exit(void)
2195 snd_soc_unregister_dais(&twl4030_dai[0], ARRAY_SIZE(twl4030_dai));
2197 module_exit(twl4030_exit);
2199 MODULE_DESCRIPTION("ASoC TWL4030 codec driver");
2200 MODULE_AUTHOR("Steve Sakoman");
2201 MODULE_LICENSE("GPL");