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
22 #include <linux/module.h>
23 #include <linux/moduleparam.h>
24 #include <linux/init.h>
25 #include <linux/delay.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>
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) */
120 /* codec private data */
121 struct twl4030_priv {
122 unsigned int bypass_state;
123 unsigned int codec_powered;
124 unsigned int codec_muted;
126 struct snd_pcm_substream *master_substream;
127 struct snd_pcm_substream *slave_substream;
129 unsigned int configured;
131 unsigned int sample_bits;
132 unsigned int channels;
136 /* Headset output state handling */
137 unsigned int hsl_enabled;
138 unsigned int hsr_enabled;
142 * read twl4030 register cache
144 static inline unsigned int twl4030_read_reg_cache(struct snd_soc_codec *codec,
147 u8 *cache = codec->reg_cache;
149 if (reg >= TWL4030_CACHEREGNUM)
156 * write twl4030 register cache
158 static inline void twl4030_write_reg_cache(struct snd_soc_codec *codec,
161 u8 *cache = codec->reg_cache;
163 if (reg >= TWL4030_CACHEREGNUM)
169 * write to the twl4030 register space
171 static int twl4030_write(struct snd_soc_codec *codec,
172 unsigned int reg, unsigned int value)
174 twl4030_write_reg_cache(codec, reg, value);
175 return twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, value, reg);
178 static void twl4030_codec_enable(struct snd_soc_codec *codec, int enable)
180 struct twl4030_priv *twl4030 = codec->private_data;
183 if (enable == twl4030->codec_powered)
186 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE);
188 mode |= TWL4030_CODECPDZ;
190 mode &= ~TWL4030_CODECPDZ;
192 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
193 twl4030->codec_powered = enable;
195 /* REVISIT: this delay is present in TI sample drivers */
196 /* but there seems to be no TRM requirement for it */
200 static void twl4030_init_chip(struct snd_soc_codec *codec)
204 /* clear CODECPDZ prior to setting register defaults */
205 twl4030_codec_enable(codec, 0);
207 /* set all audio section registers to reasonable defaults */
208 for (i = TWL4030_REG_OPTION; i <= TWL4030_REG_MISC_SET_2; i++)
209 twl4030_write(codec, i, twl4030_reg[i]);
213 static void twl4030_codec_mute(struct snd_soc_codec *codec, int mute)
215 struct twl4030_priv *twl4030 = codec->private_data;
218 if (mute == twl4030->codec_muted)
222 /* Bypass the reg_cache and mute the volumes
223 * Headset mute is done in it's own event handler
224 * Things to mute: Earpiece, PreDrivL/R, CarkitL/R
226 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL);
227 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
228 reg_val & (~TWL4030_EAR_GAIN),
229 TWL4030_REG_EAR_CTL);
231 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL);
232 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
233 reg_val & (~TWL4030_PREDL_GAIN),
234 TWL4030_REG_PREDL_CTL);
235 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL);
236 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
237 reg_val & (~TWL4030_PREDR_GAIN),
238 TWL4030_REG_PREDL_CTL);
240 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL);
241 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
242 reg_val & (~TWL4030_PRECKL_GAIN),
243 TWL4030_REG_PRECKL_CTL);
244 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL);
245 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
246 reg_val & (~TWL4030_PRECKR_GAIN),
247 TWL4030_REG_PRECKR_CTL);
250 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
251 reg_val &= ~TWL4030_APLL_EN;
252 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
254 /* Restore the volumes
255 * Headset mute is done in it's own event handler
256 * Things to restore: Earpiece, PreDrivL/R, CarkitL/R
258 twl4030_write(codec, TWL4030_REG_EAR_CTL,
259 twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL));
261 twl4030_write(codec, TWL4030_REG_PREDL_CTL,
262 twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL));
263 twl4030_write(codec, TWL4030_REG_PREDR_CTL,
264 twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL));
266 twl4030_write(codec, TWL4030_REG_PRECKL_CTL,
267 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL));
268 twl4030_write(codec, TWL4030_REG_PRECKR_CTL,
269 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL));
272 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
273 reg_val |= TWL4030_APLL_EN;
274 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
277 twl4030->codec_muted = mute;
280 static void twl4030_power_up(struct snd_soc_codec *codec)
282 struct twl4030_priv *twl4030 = codec->private_data;
283 u8 anamicl, regmisc1, byte;
286 if (twl4030->codec_powered)
289 /* set CODECPDZ to turn on codec */
290 twl4030_codec_enable(codec, 1);
292 /* initiate offset cancellation */
293 anamicl = twl4030_read_reg_cache(codec, TWL4030_REG_ANAMICL);
294 twl4030_write(codec, TWL4030_REG_ANAMICL,
295 anamicl | TWL4030_CNCL_OFFSET_START);
297 /* wait for offset cancellation to complete */
299 /* this takes a little while, so don't slam i2c */
301 twl4030_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
302 TWL4030_REG_ANAMICL);
303 } while ((i++ < 100) &&
304 ((byte & TWL4030_CNCL_OFFSET_START) ==
305 TWL4030_CNCL_OFFSET_START));
307 /* Make sure that the reg_cache has the same value as the HW */
308 twl4030_write_reg_cache(codec, TWL4030_REG_ANAMICL, byte);
310 /* anti-pop when changing analog gain */
311 regmisc1 = twl4030_read_reg_cache(codec, TWL4030_REG_MISC_SET_1);
312 twl4030_write(codec, TWL4030_REG_MISC_SET_1,
313 regmisc1 | TWL4030_SMOOTH_ANAVOL_EN);
315 /* toggle CODECPDZ as per TRM */
316 twl4030_codec_enable(codec, 0);
317 twl4030_codec_enable(codec, 1);
321 * Unconditional power down
323 static void twl4030_power_down(struct snd_soc_codec *codec)
326 twl4030_codec_enable(codec, 0);
330 static const struct snd_kcontrol_new twl4030_dapm_earpiece_controls[] = {
331 SOC_DAPM_SINGLE("Voice", TWL4030_REG_EAR_CTL, 0, 1, 0),
332 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_EAR_CTL, 1, 1, 0),
333 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_EAR_CTL, 2, 1, 0),
334 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_EAR_CTL, 3, 1, 0),
338 static const struct snd_kcontrol_new twl4030_dapm_predrivel_controls[] = {
339 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDL_CTL, 0, 1, 0),
340 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PREDL_CTL, 1, 1, 0),
341 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDL_CTL, 2, 1, 0),
342 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDL_CTL, 3, 1, 0),
346 static const struct snd_kcontrol_new twl4030_dapm_predriver_controls[] = {
347 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PREDR_CTL, 0, 1, 0),
348 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PREDR_CTL, 1, 1, 0),
349 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PREDR_CTL, 2, 1, 0),
350 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PREDR_CTL, 3, 1, 0),
354 static const struct snd_kcontrol_new twl4030_dapm_hsol_controls[] = {
355 SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 0, 1, 0),
356 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_HS_SEL, 1, 1, 0),
357 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_HS_SEL, 2, 1, 0),
361 static const struct snd_kcontrol_new twl4030_dapm_hsor_controls[] = {
362 SOC_DAPM_SINGLE("Voice", TWL4030_REG_HS_SEL, 3, 1, 0),
363 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_HS_SEL, 4, 1, 0),
364 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_HS_SEL, 5, 1, 0),
368 static const struct snd_kcontrol_new twl4030_dapm_carkitl_controls[] = {
369 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKL_CTL, 0, 1, 0),
370 SOC_DAPM_SINGLE("AudioL1", TWL4030_REG_PRECKL_CTL, 1, 1, 0),
371 SOC_DAPM_SINGLE("AudioL2", TWL4030_REG_PRECKL_CTL, 2, 1, 0),
375 static const struct snd_kcontrol_new twl4030_dapm_carkitr_controls[] = {
376 SOC_DAPM_SINGLE("Voice", TWL4030_REG_PRECKR_CTL, 0, 1, 0),
377 SOC_DAPM_SINGLE("AudioR1", TWL4030_REG_PRECKR_CTL, 1, 1, 0),
378 SOC_DAPM_SINGLE("AudioR2", TWL4030_REG_PRECKR_CTL, 2, 1, 0),
382 static const char *twl4030_handsfreel_texts[] =
383 {"Voice", "AudioL1", "AudioL2", "AudioR2"};
385 static const struct soc_enum twl4030_handsfreel_enum =
386 SOC_ENUM_SINGLE(TWL4030_REG_HFL_CTL, 0,
387 ARRAY_SIZE(twl4030_handsfreel_texts),
388 twl4030_handsfreel_texts);
390 static const struct snd_kcontrol_new twl4030_dapm_handsfreel_control =
391 SOC_DAPM_ENUM("Route", twl4030_handsfreel_enum);
393 /* Handsfree Right */
394 static const char *twl4030_handsfreer_texts[] =
395 {"Voice", "AudioR1", "AudioR2", "AudioL2"};
397 static const struct soc_enum twl4030_handsfreer_enum =
398 SOC_ENUM_SINGLE(TWL4030_REG_HFR_CTL, 0,
399 ARRAY_SIZE(twl4030_handsfreer_texts),
400 twl4030_handsfreer_texts);
402 static const struct snd_kcontrol_new twl4030_dapm_handsfreer_control =
403 SOC_DAPM_ENUM("Route", twl4030_handsfreer_enum);
406 /* Vibra audio path selection */
407 static const char *twl4030_vibra_texts[] =
408 {"AudioL1", "AudioR1", "AudioL2", "AudioR2"};
410 static const struct soc_enum twl4030_vibra_enum =
411 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 2,
412 ARRAY_SIZE(twl4030_vibra_texts),
413 twl4030_vibra_texts);
415 static const struct snd_kcontrol_new twl4030_dapm_vibra_control =
416 SOC_DAPM_ENUM("Route", twl4030_vibra_enum);
418 /* Vibra path selection: local vibrator (PWM) or audio driven */
419 static const char *twl4030_vibrapath_texts[] =
420 {"Local vibrator", "Audio"};
422 static const struct soc_enum twl4030_vibrapath_enum =
423 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 4,
424 ARRAY_SIZE(twl4030_vibrapath_texts),
425 twl4030_vibrapath_texts);
427 static const struct snd_kcontrol_new twl4030_dapm_vibrapath_control =
428 SOC_DAPM_ENUM("Route", twl4030_vibrapath_enum);
430 /* Left analog microphone selection */
431 static const struct snd_kcontrol_new twl4030_dapm_analoglmic_controls[] = {
432 SOC_DAPM_SINGLE("Main mic", TWL4030_REG_ANAMICL, 0, 1, 0),
433 SOC_DAPM_SINGLE("Headset mic", TWL4030_REG_ANAMICL, 1, 1, 0),
434 SOC_DAPM_SINGLE("AUXL", TWL4030_REG_ANAMICL, 2, 1, 0),
435 SOC_DAPM_SINGLE("Carkit mic", TWL4030_REG_ANAMICL, 3, 1, 0),
438 /* Right analog microphone selection */
439 static const struct snd_kcontrol_new twl4030_dapm_analogrmic_controls[] = {
440 SOC_DAPM_SINGLE("Sub mic", TWL4030_REG_ANAMICR, 0, 1, 0),
441 SOC_DAPM_SINGLE("AUXR", TWL4030_REG_ANAMICR, 2, 1, 0),
444 /* TX1 L/R Analog/Digital microphone selection */
445 static const char *twl4030_micpathtx1_texts[] =
446 {"Analog", "Digimic0"};
448 static const struct soc_enum twl4030_micpathtx1_enum =
449 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 0,
450 ARRAY_SIZE(twl4030_micpathtx1_texts),
451 twl4030_micpathtx1_texts);
453 static const struct snd_kcontrol_new twl4030_dapm_micpathtx1_control =
454 SOC_DAPM_ENUM("Route", twl4030_micpathtx1_enum);
456 /* TX2 L/R Analog/Digital microphone selection */
457 static const char *twl4030_micpathtx2_texts[] =
458 {"Analog", "Digimic1"};
460 static const struct soc_enum twl4030_micpathtx2_enum =
461 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 2,
462 ARRAY_SIZE(twl4030_micpathtx2_texts),
463 twl4030_micpathtx2_texts);
465 static const struct snd_kcontrol_new twl4030_dapm_micpathtx2_control =
466 SOC_DAPM_ENUM("Route", twl4030_micpathtx2_enum);
468 /* Analog bypass for AudioR1 */
469 static const struct snd_kcontrol_new twl4030_dapm_abypassr1_control =
470 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR1_APGA_CTL, 2, 1, 0);
472 /* Analog bypass for AudioL1 */
473 static const struct snd_kcontrol_new twl4030_dapm_abypassl1_control =
474 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL1_APGA_CTL, 2, 1, 0);
476 /* Analog bypass for AudioR2 */
477 static const struct snd_kcontrol_new twl4030_dapm_abypassr2_control =
478 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR2_APGA_CTL, 2, 1, 0);
480 /* Analog bypass for AudioL2 */
481 static const struct snd_kcontrol_new twl4030_dapm_abypassl2_control =
482 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL2_APGA_CTL, 2, 1, 0);
484 /* Analog bypass for Voice */
485 static const struct snd_kcontrol_new twl4030_dapm_abypassv_control =
486 SOC_DAPM_SINGLE("Switch", TWL4030_REG_VDL_APGA_CTL, 2, 1, 0);
488 /* Digital bypass gain, 0 mutes the bypass */
489 static const unsigned int twl4030_dapm_dbypass_tlv[] = {
490 TLV_DB_RANGE_HEAD(2),
491 0, 3, TLV_DB_SCALE_ITEM(-2400, 0, 1),
492 4, 7, TLV_DB_SCALE_ITEM(-1800, 600, 0),
495 /* Digital bypass left (TX1L -> RX2L) */
496 static const struct snd_kcontrol_new twl4030_dapm_dbypassl_control =
497 SOC_DAPM_SINGLE_TLV("Volume",
498 TWL4030_REG_ATX2ARXPGA, 3, 7, 0,
499 twl4030_dapm_dbypass_tlv);
501 /* Digital bypass right (TX1R -> RX2R) */
502 static const struct snd_kcontrol_new twl4030_dapm_dbypassr_control =
503 SOC_DAPM_SINGLE_TLV("Volume",
504 TWL4030_REG_ATX2ARXPGA, 0, 7, 0,
505 twl4030_dapm_dbypass_tlv);
508 * Voice Sidetone GAIN volume control:
509 * from -51 to -10 dB in 1 dB steps (mute instead of -51 dB)
511 static DECLARE_TLV_DB_SCALE(twl4030_dapm_dbypassv_tlv, -5100, 100, 1);
513 /* Digital bypass voice: sidetone (VUL -> VDL)*/
514 static const struct snd_kcontrol_new twl4030_dapm_dbypassv_control =
515 SOC_DAPM_SINGLE_TLV("Volume",
516 TWL4030_REG_VSTPGA, 0, 0x29, 0,
517 twl4030_dapm_dbypassv_tlv);
519 static int micpath_event(struct snd_soc_dapm_widget *w,
520 struct snd_kcontrol *kcontrol, int event)
522 struct soc_enum *e = (struct soc_enum *)w->kcontrols->private_value;
523 unsigned char adcmicsel, micbias_ctl;
525 adcmicsel = twl4030_read_reg_cache(w->codec, TWL4030_REG_ADCMICSEL);
526 micbias_ctl = twl4030_read_reg_cache(w->codec, TWL4030_REG_MICBIAS_CTL);
527 /* Prepare the bits for the given TX path:
528 * shift_l == 0: TX1 microphone path
529 * shift_l == 2: TX2 microphone path */
531 /* TX2 microphone path */
532 if (adcmicsel & TWL4030_TX2IN_SEL)
533 micbias_ctl |= TWL4030_MICBIAS2_CTL; /* digimic */
535 micbias_ctl &= ~TWL4030_MICBIAS2_CTL;
537 /* TX1 microphone path */
538 if (adcmicsel & TWL4030_TX1IN_SEL)
539 micbias_ctl |= TWL4030_MICBIAS1_CTL; /* digimic */
541 micbias_ctl &= ~TWL4030_MICBIAS1_CTL;
544 twl4030_write(w->codec, TWL4030_REG_MICBIAS_CTL, micbias_ctl);
549 static int handsfree_event(struct snd_soc_dapm_widget *w,
550 struct snd_kcontrol *kcontrol, int event)
552 struct soc_enum *e = (struct soc_enum *)w->kcontrols->private_value;
553 unsigned char hs_ctl;
555 hs_ctl = twl4030_read_reg_cache(w->codec, e->reg);
557 if (hs_ctl & TWL4030_HF_CTL_REF_EN) {
558 hs_ctl |= TWL4030_HF_CTL_RAMP_EN;
559 twl4030_write(w->codec, e->reg, hs_ctl);
560 hs_ctl |= TWL4030_HF_CTL_LOOP_EN;
561 twl4030_write(w->codec, e->reg, hs_ctl);
562 hs_ctl |= TWL4030_HF_CTL_HB_EN;
563 twl4030_write(w->codec, e->reg, hs_ctl);
565 hs_ctl &= ~(TWL4030_HF_CTL_RAMP_EN | TWL4030_HF_CTL_LOOP_EN
566 | TWL4030_HF_CTL_HB_EN);
567 twl4030_write(w->codec, e->reg, hs_ctl);
573 static void headset_ramp(struct snd_soc_codec *codec, int ramp)
575 unsigned char hs_gain, hs_pop;
576 struct twl4030_priv *twl4030 = codec->private_data;
577 /* Base values for ramp delay calculation: 2^19 - 2^26 */
578 unsigned int ramp_base[] = {524288, 1048576, 2097152, 4194304,
579 8388608, 16777216, 33554432, 67108864};
581 hs_gain = twl4030_read_reg_cache(codec, TWL4030_REG_HS_GAIN_SET);
582 hs_pop = twl4030_read_reg_cache(codec, TWL4030_REG_HS_POPN_SET);
585 /* Headset ramp-up according to the TRM */
586 hs_pop |= TWL4030_VMID_EN;
587 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
588 twl4030_write(codec, TWL4030_REG_HS_GAIN_SET, hs_gain);
589 hs_pop |= TWL4030_RAMP_EN;
590 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
592 /* Headset ramp-down _not_ according to
593 * the TRM, but in a way that it is working */
594 hs_pop &= ~TWL4030_RAMP_EN;
595 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
596 /* Wait ramp delay time + 1, so the VMID can settle */
597 mdelay((ramp_base[(hs_pop & TWL4030_RAMP_DELAY) >> 2] /
598 twl4030->sysclk) + 1);
599 /* Bypass the reg_cache to mute the headset */
600 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
602 TWL4030_REG_HS_GAIN_SET);
604 hs_pop &= ~TWL4030_VMID_EN;
605 twl4030_write(codec, TWL4030_REG_HS_POPN_SET, hs_pop);
609 static int headsetlpga_event(struct snd_soc_dapm_widget *w,
610 struct snd_kcontrol *kcontrol, int event)
612 struct twl4030_priv *twl4030 = w->codec->private_data;
615 case SND_SOC_DAPM_POST_PMU:
616 /* Do the ramp-up only once */
617 if (!twl4030->hsr_enabled)
618 headset_ramp(w->codec, 1);
620 twl4030->hsl_enabled = 1;
622 case SND_SOC_DAPM_POST_PMD:
623 /* Do the ramp-down only if both headsetL/R is disabled */
624 if (!twl4030->hsr_enabled)
625 headset_ramp(w->codec, 0);
627 twl4030->hsl_enabled = 0;
633 static int headsetrpga_event(struct snd_soc_dapm_widget *w,
634 struct snd_kcontrol *kcontrol, int event)
636 struct twl4030_priv *twl4030 = w->codec->private_data;
639 case SND_SOC_DAPM_POST_PMU:
640 /* Do the ramp-up only once */
641 if (!twl4030->hsl_enabled)
642 headset_ramp(w->codec, 1);
644 twl4030->hsr_enabled = 1;
646 case SND_SOC_DAPM_POST_PMD:
647 /* Do the ramp-down only if both headsetL/R is disabled */
648 if (!twl4030->hsl_enabled)
649 headset_ramp(w->codec, 0);
651 twl4030->hsr_enabled = 0;
657 static int bypass_event(struct snd_soc_dapm_widget *w,
658 struct snd_kcontrol *kcontrol, int event)
660 struct soc_mixer_control *m =
661 (struct soc_mixer_control *)w->kcontrols->private_value;
662 struct twl4030_priv *twl4030 = w->codec->private_data;
663 unsigned char reg, misc;
665 reg = twl4030_read_reg_cache(w->codec, m->reg);
667 if (m->reg <= TWL4030_REG_ARXR2_APGA_CTL) {
669 if (reg & (1 << m->shift))
670 twl4030->bypass_state |=
671 (1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
673 twl4030->bypass_state &=
674 ~(1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
675 } else if (m->reg == TWL4030_REG_VDL_APGA_CTL) {
676 /* Analog voice bypass */
677 if (reg & (1 << m->shift))
678 twl4030->bypass_state |= (1 << 4);
680 twl4030->bypass_state &= ~(1 << 4);
681 } else if (m->reg == TWL4030_REG_VSTPGA) {
682 /* Voice digital bypass */
684 twl4030->bypass_state |= (1 << 5);
686 twl4030->bypass_state &= ~(1 << 5);
689 if (reg & (0x7 << m->shift))
690 twl4030->bypass_state |= (1 << (m->shift ? 7 : 6));
692 twl4030->bypass_state &= ~(1 << (m->shift ? 7 : 6));
695 /* Enable master analog loopback mode if any analog switch is enabled*/
696 misc = twl4030_read_reg_cache(w->codec, TWL4030_REG_MISC_SET_1);
697 if (twl4030->bypass_state & 0x1F)
698 misc |= TWL4030_FMLOOP_EN;
700 misc &= ~TWL4030_FMLOOP_EN;
701 twl4030_write(w->codec, TWL4030_REG_MISC_SET_1, misc);
703 if (w->codec->bias_level == SND_SOC_BIAS_STANDBY) {
704 if (twl4030->bypass_state)
705 twl4030_codec_mute(w->codec, 0);
707 twl4030_codec_mute(w->codec, 1);
713 * Some of the gain controls in TWL (mostly those which are associated with
714 * the outputs) are implemented in an interesting way:
715 * 0x0 : Power down (mute)
719 * Inverting not going to help with these.
720 * Custom volsw and volsw_2r get/put functions to handle these gain bits.
722 #define SOC_DOUBLE_TLV_TWL4030(xname, xreg, shift_left, shift_right, xmax,\
723 xinvert, tlv_array) \
724 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
725 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
726 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
727 .tlv.p = (tlv_array), \
728 .info = snd_soc_info_volsw, \
729 .get = snd_soc_get_volsw_twl4030, \
730 .put = snd_soc_put_volsw_twl4030, \
731 .private_value = (unsigned long)&(struct soc_mixer_control) \
732 {.reg = xreg, .shift = shift_left, .rshift = shift_right,\
733 .max = xmax, .invert = xinvert} }
734 #define SOC_DOUBLE_R_TLV_TWL4030(xname, reg_left, reg_right, xshift, xmax,\
735 xinvert, tlv_array) \
736 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
737 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
738 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
739 .tlv.p = (tlv_array), \
740 .info = snd_soc_info_volsw_2r, \
741 .get = snd_soc_get_volsw_r2_twl4030,\
742 .put = snd_soc_put_volsw_r2_twl4030, \
743 .private_value = (unsigned long)&(struct soc_mixer_control) \
744 {.reg = reg_left, .rreg = reg_right, .shift = xshift, \
745 .rshift = xshift, .max = xmax, .invert = xinvert} }
746 #define SOC_SINGLE_TLV_TWL4030(xname, xreg, xshift, xmax, xinvert, tlv_array) \
747 SOC_DOUBLE_TLV_TWL4030(xname, xreg, xshift, xshift, xmax, \
750 static int snd_soc_get_volsw_twl4030(struct snd_kcontrol *kcontrol,
751 struct snd_ctl_elem_value *ucontrol)
753 struct soc_mixer_control *mc =
754 (struct soc_mixer_control *)kcontrol->private_value;
755 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
756 unsigned int reg = mc->reg;
757 unsigned int shift = mc->shift;
758 unsigned int rshift = mc->rshift;
760 int mask = (1 << fls(max)) - 1;
762 ucontrol->value.integer.value[0] =
763 (snd_soc_read(codec, reg) >> shift) & mask;
764 if (ucontrol->value.integer.value[0])
765 ucontrol->value.integer.value[0] =
766 max + 1 - ucontrol->value.integer.value[0];
768 if (shift != rshift) {
769 ucontrol->value.integer.value[1] =
770 (snd_soc_read(codec, reg) >> rshift) & mask;
771 if (ucontrol->value.integer.value[1])
772 ucontrol->value.integer.value[1] =
773 max + 1 - ucontrol->value.integer.value[1];
779 static int snd_soc_put_volsw_twl4030(struct snd_kcontrol *kcontrol,
780 struct snd_ctl_elem_value *ucontrol)
782 struct soc_mixer_control *mc =
783 (struct soc_mixer_control *)kcontrol->private_value;
784 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
785 unsigned int reg = mc->reg;
786 unsigned int shift = mc->shift;
787 unsigned int rshift = mc->rshift;
789 int mask = (1 << fls(max)) - 1;
790 unsigned short val, val2, val_mask;
792 val = (ucontrol->value.integer.value[0] & mask);
794 val_mask = mask << shift;
798 if (shift != rshift) {
799 val2 = (ucontrol->value.integer.value[1] & mask);
800 val_mask |= mask << rshift;
802 val2 = max + 1 - val2;
803 val |= val2 << rshift;
805 return snd_soc_update_bits(codec, reg, val_mask, val);
808 static int snd_soc_get_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
809 struct snd_ctl_elem_value *ucontrol)
811 struct soc_mixer_control *mc =
812 (struct soc_mixer_control *)kcontrol->private_value;
813 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
814 unsigned int reg = mc->reg;
815 unsigned int reg2 = mc->rreg;
816 unsigned int shift = mc->shift;
818 int mask = (1<<fls(max))-1;
820 ucontrol->value.integer.value[0] =
821 (snd_soc_read(codec, reg) >> shift) & mask;
822 ucontrol->value.integer.value[1] =
823 (snd_soc_read(codec, reg2) >> shift) & mask;
825 if (ucontrol->value.integer.value[0])
826 ucontrol->value.integer.value[0] =
827 max + 1 - ucontrol->value.integer.value[0];
828 if (ucontrol->value.integer.value[1])
829 ucontrol->value.integer.value[1] =
830 max + 1 - ucontrol->value.integer.value[1];
835 static int snd_soc_put_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
836 struct snd_ctl_elem_value *ucontrol)
838 struct soc_mixer_control *mc =
839 (struct soc_mixer_control *)kcontrol->private_value;
840 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
841 unsigned int reg = mc->reg;
842 unsigned int reg2 = mc->rreg;
843 unsigned int shift = mc->shift;
845 int mask = (1 << fls(max)) - 1;
847 unsigned short val, val2, val_mask;
849 val_mask = mask << shift;
850 val = (ucontrol->value.integer.value[0] & mask);
851 val2 = (ucontrol->value.integer.value[1] & mask);
856 val2 = max + 1 - val2;
859 val2 = val2 << shift;
861 err = snd_soc_update_bits(codec, reg, val_mask, val);
865 err = snd_soc_update_bits(codec, reg2, val_mask, val2);
869 /* Codec operation modes */
870 static const char *twl4030_op_modes_texts[] = {
871 "Option 2 (voice/audio)", "Option 1 (audio)"
874 static const struct soc_enum twl4030_op_modes_enum =
875 SOC_ENUM_SINGLE(TWL4030_REG_CODEC_MODE, 0,
876 ARRAY_SIZE(twl4030_op_modes_texts),
877 twl4030_op_modes_texts);
879 int snd_soc_put_twl4030_opmode_enum_double(struct snd_kcontrol *kcontrol,
880 struct snd_ctl_elem_value *ucontrol)
882 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
883 struct twl4030_priv *twl4030 = codec->private_data;
884 struct soc_enum *e = (struct soc_enum *)kcontrol->private_value;
886 unsigned short mask, bitmask;
888 if (twl4030->configured) {
889 printk(KERN_ERR "twl4030 operation mode cannot be "
890 "changed on-the-fly\n");
894 for (bitmask = 1; bitmask < e->max; bitmask <<= 1)
896 if (ucontrol->value.enumerated.item[0] > e->max - 1)
899 val = ucontrol->value.enumerated.item[0] << e->shift_l;
900 mask = (bitmask - 1) << e->shift_l;
901 if (e->shift_l != e->shift_r) {
902 if (ucontrol->value.enumerated.item[1] > e->max - 1)
904 val |= ucontrol->value.enumerated.item[1] << e->shift_r;
905 mask |= (bitmask - 1) << e->shift_r;
908 return snd_soc_update_bits(codec, e->reg, mask, val);
912 * FGAIN volume control:
913 * from -62 to 0 dB in 1 dB steps (mute instead of -63 dB)
915 static DECLARE_TLV_DB_SCALE(digital_fine_tlv, -6300, 100, 1);
918 * CGAIN volume control:
919 * 0 dB to 12 dB in 6 dB steps
920 * value 2 and 3 means 12 dB
922 static DECLARE_TLV_DB_SCALE(digital_coarse_tlv, 0, 600, 0);
925 * Voice Downlink GAIN volume control:
926 * from -37 to 12 dB in 1 dB steps (mute instead of -37 dB)
928 static DECLARE_TLV_DB_SCALE(digital_voice_downlink_tlv, -3700, 100, 1);
931 * Analog playback gain
932 * -24 dB to 12 dB in 2 dB steps
934 static DECLARE_TLV_DB_SCALE(analog_tlv, -2400, 200, 0);
937 * Gain controls tied to outputs
938 * -6 dB to 6 dB in 6 dB steps (mute instead of -12)
940 static DECLARE_TLV_DB_SCALE(output_tvl, -1200, 600, 1);
943 * Gain control for earpiece amplifier
944 * 0 dB to 12 dB in 6 dB steps (mute instead of -6)
946 static DECLARE_TLV_DB_SCALE(output_ear_tvl, -600, 600, 1);
949 * Capture gain after the ADCs
950 * from 0 dB to 31 dB in 1 dB steps
952 static DECLARE_TLV_DB_SCALE(digital_capture_tlv, 0, 100, 0);
955 * Gain control for input amplifiers
956 * 0 dB to 30 dB in 6 dB steps
958 static DECLARE_TLV_DB_SCALE(input_gain_tlv, 0, 600, 0);
960 static const char *twl4030_rampdelay_texts[] = {
961 "27/20/14 ms", "55/40/27 ms", "109/81/55 ms", "218/161/109 ms",
962 "437/323/218 ms", "874/645/437 ms", "1748/1291/874 ms",
966 static const struct soc_enum twl4030_rampdelay_enum =
967 SOC_ENUM_SINGLE(TWL4030_REG_HS_POPN_SET, 2,
968 ARRAY_SIZE(twl4030_rampdelay_texts),
969 twl4030_rampdelay_texts);
971 /* Vibra H-bridge direction mode */
972 static const char *twl4030_vibradirmode_texts[] = {
973 "Vibra H-bridge direction", "Audio data MSB",
976 static const struct soc_enum twl4030_vibradirmode_enum =
977 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 5,
978 ARRAY_SIZE(twl4030_vibradirmode_texts),
979 twl4030_vibradirmode_texts);
981 /* Vibra H-bridge direction */
982 static const char *twl4030_vibradir_texts[] = {
983 "Positive polarity", "Negative polarity",
986 static const struct soc_enum twl4030_vibradir_enum =
987 SOC_ENUM_SINGLE(TWL4030_REG_VIBRA_CTL, 1,
988 ARRAY_SIZE(twl4030_vibradir_texts),
989 twl4030_vibradir_texts);
991 static const struct snd_kcontrol_new twl4030_snd_controls[] = {
992 /* Codec operation mode control */
993 SOC_ENUM_EXT("Codec Operation Mode", twl4030_op_modes_enum,
994 snd_soc_get_enum_double,
995 snd_soc_put_twl4030_opmode_enum_double),
997 /* Common playback gain controls */
998 SOC_DOUBLE_R_TLV("DAC1 Digital Fine Playback Volume",
999 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1000 0, 0x3f, 0, digital_fine_tlv),
1001 SOC_DOUBLE_R_TLV("DAC2 Digital Fine Playback Volume",
1002 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1003 0, 0x3f, 0, digital_fine_tlv),
1005 SOC_DOUBLE_R_TLV("DAC1 Digital Coarse Playback Volume",
1006 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
1007 6, 0x2, 0, digital_coarse_tlv),
1008 SOC_DOUBLE_R_TLV("DAC2 Digital Coarse Playback Volume",
1009 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
1010 6, 0x2, 0, digital_coarse_tlv),
1012 SOC_DOUBLE_R_TLV("DAC1 Analog Playback Volume",
1013 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1014 3, 0x12, 1, analog_tlv),
1015 SOC_DOUBLE_R_TLV("DAC2 Analog Playback Volume",
1016 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1017 3, 0x12, 1, analog_tlv),
1018 SOC_DOUBLE_R("DAC1 Analog Playback Switch",
1019 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
1021 SOC_DOUBLE_R("DAC2 Analog Playback Switch",
1022 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
1025 /* Common voice downlink gain controls */
1026 SOC_SINGLE_TLV("DAC Voice Digital Downlink Volume",
1027 TWL4030_REG_VRXPGA, 0, 0x31, 0, digital_voice_downlink_tlv),
1029 SOC_SINGLE_TLV("DAC Voice Analog Downlink Volume",
1030 TWL4030_REG_VDL_APGA_CTL, 3, 0x12, 1, analog_tlv),
1032 SOC_SINGLE("DAC Voice Analog Downlink Switch",
1033 TWL4030_REG_VDL_APGA_CTL, 1, 1, 0),
1035 /* Separate output gain controls */
1036 SOC_DOUBLE_R_TLV_TWL4030("PreDriv Playback Volume",
1037 TWL4030_REG_PREDL_CTL, TWL4030_REG_PREDR_CTL,
1038 4, 3, 0, output_tvl),
1040 SOC_DOUBLE_TLV_TWL4030("Headset Playback Volume",
1041 TWL4030_REG_HS_GAIN_SET, 0, 2, 3, 0, output_tvl),
1043 SOC_DOUBLE_R_TLV_TWL4030("Carkit Playback Volume",
1044 TWL4030_REG_PRECKL_CTL, TWL4030_REG_PRECKR_CTL,
1045 4, 3, 0, output_tvl),
1047 SOC_SINGLE_TLV_TWL4030("Earpiece Playback Volume",
1048 TWL4030_REG_EAR_CTL, 4, 3, 0, output_ear_tvl),
1050 /* Common capture gain controls */
1051 SOC_DOUBLE_R_TLV("TX1 Digital Capture Volume",
1052 TWL4030_REG_ATXL1PGA, TWL4030_REG_ATXR1PGA,
1053 0, 0x1f, 0, digital_capture_tlv),
1054 SOC_DOUBLE_R_TLV("TX2 Digital Capture Volume",
1055 TWL4030_REG_AVTXL2PGA, TWL4030_REG_AVTXR2PGA,
1056 0, 0x1f, 0, digital_capture_tlv),
1058 SOC_DOUBLE_TLV("Analog Capture Volume", TWL4030_REG_ANAMIC_GAIN,
1059 0, 3, 5, 0, input_gain_tlv),
1061 SOC_ENUM("HS ramp delay", twl4030_rampdelay_enum),
1063 SOC_ENUM("Vibra H-bridge mode", twl4030_vibradirmode_enum),
1064 SOC_ENUM("Vibra H-bridge direction", twl4030_vibradir_enum),
1067 static const struct snd_soc_dapm_widget twl4030_dapm_widgets[] = {
1068 /* Left channel inputs */
1069 SND_SOC_DAPM_INPUT("MAINMIC"),
1070 SND_SOC_DAPM_INPUT("HSMIC"),
1071 SND_SOC_DAPM_INPUT("AUXL"),
1072 SND_SOC_DAPM_INPUT("CARKITMIC"),
1073 /* Right channel inputs */
1074 SND_SOC_DAPM_INPUT("SUBMIC"),
1075 SND_SOC_DAPM_INPUT("AUXR"),
1076 /* Digital microphones (Stereo) */
1077 SND_SOC_DAPM_INPUT("DIGIMIC0"),
1078 SND_SOC_DAPM_INPUT("DIGIMIC1"),
1081 SND_SOC_DAPM_OUTPUT("OUTL"),
1082 SND_SOC_DAPM_OUTPUT("OUTR"),
1083 SND_SOC_DAPM_OUTPUT("EARPIECE"),
1084 SND_SOC_DAPM_OUTPUT("PREDRIVEL"),
1085 SND_SOC_DAPM_OUTPUT("PREDRIVER"),
1086 SND_SOC_DAPM_OUTPUT("HSOL"),
1087 SND_SOC_DAPM_OUTPUT("HSOR"),
1088 SND_SOC_DAPM_OUTPUT("CARKITL"),
1089 SND_SOC_DAPM_OUTPUT("CARKITR"),
1090 SND_SOC_DAPM_OUTPUT("HFL"),
1091 SND_SOC_DAPM_OUTPUT("HFR"),
1092 SND_SOC_DAPM_OUTPUT("VIBRA"),
1095 SND_SOC_DAPM_DAC("DAC Right1", "Right Front Playback",
1096 SND_SOC_NOPM, 0, 0),
1097 SND_SOC_DAPM_DAC("DAC Left1", "Left Front Playback",
1098 SND_SOC_NOPM, 0, 0),
1099 SND_SOC_DAPM_DAC("DAC Right2", "Right Rear Playback",
1100 SND_SOC_NOPM, 0, 0),
1101 SND_SOC_DAPM_DAC("DAC Left2", "Left Rear Playback",
1102 SND_SOC_NOPM, 0, 0),
1103 SND_SOC_DAPM_DAC("DAC Voice", "Voice Playback",
1104 SND_SOC_NOPM, 0, 0),
1106 /* Analog bypasses */
1107 SND_SOC_DAPM_SWITCH_E("Right1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1108 &twl4030_dapm_abypassr1_control, bypass_event,
1109 SND_SOC_DAPM_POST_REG),
1110 SND_SOC_DAPM_SWITCH_E("Left1 Analog Loopback", SND_SOC_NOPM, 0, 0,
1111 &twl4030_dapm_abypassl1_control,
1112 bypass_event, SND_SOC_DAPM_POST_REG),
1113 SND_SOC_DAPM_SWITCH_E("Right2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1114 &twl4030_dapm_abypassr2_control,
1115 bypass_event, SND_SOC_DAPM_POST_REG),
1116 SND_SOC_DAPM_SWITCH_E("Left2 Analog Loopback", SND_SOC_NOPM, 0, 0,
1117 &twl4030_dapm_abypassl2_control,
1118 bypass_event, SND_SOC_DAPM_POST_REG),
1119 SND_SOC_DAPM_SWITCH_E("Voice Analog Loopback", SND_SOC_NOPM, 0, 0,
1120 &twl4030_dapm_abypassv_control,
1121 bypass_event, SND_SOC_DAPM_POST_REG),
1123 /* Digital bypasses */
1124 SND_SOC_DAPM_SWITCH_E("Left Digital Loopback", SND_SOC_NOPM, 0, 0,
1125 &twl4030_dapm_dbypassl_control, bypass_event,
1126 SND_SOC_DAPM_POST_REG),
1127 SND_SOC_DAPM_SWITCH_E("Right Digital Loopback", SND_SOC_NOPM, 0, 0,
1128 &twl4030_dapm_dbypassr_control, bypass_event,
1129 SND_SOC_DAPM_POST_REG),
1130 SND_SOC_DAPM_SWITCH_E("Voice Digital Loopback", SND_SOC_NOPM, 0, 0,
1131 &twl4030_dapm_dbypassv_control, bypass_event,
1132 SND_SOC_DAPM_POST_REG),
1134 /* Digital mixers, power control for the physical DACs */
1135 SND_SOC_DAPM_MIXER("Digital R1 Playback Mixer",
1136 TWL4030_REG_AVDAC_CTL, 0, 0, NULL, 0),
1137 SND_SOC_DAPM_MIXER("Digital L1 Playback Mixer",
1138 TWL4030_REG_AVDAC_CTL, 1, 0, NULL, 0),
1139 SND_SOC_DAPM_MIXER("Digital R2 Playback Mixer",
1140 TWL4030_REG_AVDAC_CTL, 2, 0, NULL, 0),
1141 SND_SOC_DAPM_MIXER("Digital L2 Playback Mixer",
1142 TWL4030_REG_AVDAC_CTL, 3, 0, NULL, 0),
1143 SND_SOC_DAPM_MIXER("Digital Voice Playback Mixer",
1144 TWL4030_REG_AVDAC_CTL, 4, 0, NULL, 0),
1146 /* Analog mixers, power control for the physical PGAs */
1147 SND_SOC_DAPM_MIXER("Analog R1 Playback Mixer",
1148 TWL4030_REG_ARXR1_APGA_CTL, 0, 0, NULL, 0),
1149 SND_SOC_DAPM_MIXER("Analog L1 Playback Mixer",
1150 TWL4030_REG_ARXL1_APGA_CTL, 0, 0, NULL, 0),
1151 SND_SOC_DAPM_MIXER("Analog R2 Playback Mixer",
1152 TWL4030_REG_ARXR2_APGA_CTL, 0, 0, NULL, 0),
1153 SND_SOC_DAPM_MIXER("Analog L2 Playback Mixer",
1154 TWL4030_REG_ARXL2_APGA_CTL, 0, 0, NULL, 0),
1155 SND_SOC_DAPM_MIXER("Analog Voice Playback Mixer",
1156 TWL4030_REG_VDL_APGA_CTL, 0, 0, NULL, 0),
1158 /* Output MIXER controls */
1160 SND_SOC_DAPM_MIXER("Earpiece Mixer", SND_SOC_NOPM, 0, 0,
1161 &twl4030_dapm_earpiece_controls[0],
1162 ARRAY_SIZE(twl4030_dapm_earpiece_controls)),
1164 SND_SOC_DAPM_MIXER("PredriveL Mixer", SND_SOC_NOPM, 0, 0,
1165 &twl4030_dapm_predrivel_controls[0],
1166 ARRAY_SIZE(twl4030_dapm_predrivel_controls)),
1167 SND_SOC_DAPM_MIXER("PredriveR Mixer", SND_SOC_NOPM, 0, 0,
1168 &twl4030_dapm_predriver_controls[0],
1169 ARRAY_SIZE(twl4030_dapm_predriver_controls)),
1171 SND_SOC_DAPM_MIXER("HeadsetL Mixer", SND_SOC_NOPM, 0, 0,
1172 &twl4030_dapm_hsol_controls[0],
1173 ARRAY_SIZE(twl4030_dapm_hsol_controls)),
1174 SND_SOC_DAPM_PGA_E("HeadsetL PGA", SND_SOC_NOPM,
1175 0, 0, NULL, 0, headsetlpga_event,
1176 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1177 SND_SOC_DAPM_MIXER("HeadsetR Mixer", SND_SOC_NOPM, 0, 0,
1178 &twl4030_dapm_hsor_controls[0],
1179 ARRAY_SIZE(twl4030_dapm_hsor_controls)),
1180 SND_SOC_DAPM_PGA_E("HeadsetR PGA", SND_SOC_NOPM,
1181 0, 0, NULL, 0, headsetrpga_event,
1182 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1184 SND_SOC_DAPM_MIXER("CarkitL Mixer", SND_SOC_NOPM, 0, 0,
1185 &twl4030_dapm_carkitl_controls[0],
1186 ARRAY_SIZE(twl4030_dapm_carkitl_controls)),
1187 SND_SOC_DAPM_MIXER("CarkitR Mixer", SND_SOC_NOPM, 0, 0,
1188 &twl4030_dapm_carkitr_controls[0],
1189 ARRAY_SIZE(twl4030_dapm_carkitr_controls)),
1191 /* Output MUX controls */
1193 SND_SOC_DAPM_MUX_E("HandsfreeL Mux", TWL4030_REG_HFL_CTL, 5, 0,
1194 &twl4030_dapm_handsfreel_control, handsfree_event,
1195 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1196 SND_SOC_DAPM_MUX_E("HandsfreeR Mux", TWL4030_REG_HFR_CTL, 5, 0,
1197 &twl4030_dapm_handsfreer_control, handsfree_event,
1198 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1200 SND_SOC_DAPM_MUX("Vibra Mux", TWL4030_REG_VIBRA_CTL, 0, 0,
1201 &twl4030_dapm_vibra_control),
1202 SND_SOC_DAPM_MUX("Vibra Route", SND_SOC_NOPM, 0, 0,
1203 &twl4030_dapm_vibrapath_control),
1205 /* Introducing four virtual ADC, since TWL4030 have four channel for
1207 SND_SOC_DAPM_ADC("ADC Virtual Left1", "Left Front Capture",
1208 SND_SOC_NOPM, 0, 0),
1209 SND_SOC_DAPM_ADC("ADC Virtual Right1", "Right Front Capture",
1210 SND_SOC_NOPM, 0, 0),
1211 SND_SOC_DAPM_ADC("ADC Virtual Left2", "Left Rear Capture",
1212 SND_SOC_NOPM, 0, 0),
1213 SND_SOC_DAPM_ADC("ADC Virtual Right2", "Right Rear Capture",
1214 SND_SOC_NOPM, 0, 0),
1216 /* Analog/Digital mic path selection.
1217 TX1 Left/Right: either analog Left/Right or Digimic0
1218 TX2 Left/Right: either analog Left/Right or Digimic1 */
1219 SND_SOC_DAPM_MUX_E("TX1 Capture Route", SND_SOC_NOPM, 0, 0,
1220 &twl4030_dapm_micpathtx1_control, micpath_event,
1221 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1222 SND_SOC_DAPM_POST_REG),
1223 SND_SOC_DAPM_MUX_E("TX2 Capture Route", SND_SOC_NOPM, 0, 0,
1224 &twl4030_dapm_micpathtx2_control, micpath_event,
1225 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1226 SND_SOC_DAPM_POST_REG),
1228 /* Analog input mixers for the capture amplifiers */
1229 SND_SOC_DAPM_MIXER("Analog Left Capture Route",
1230 TWL4030_REG_ANAMICL, 4, 0,
1231 &twl4030_dapm_analoglmic_controls[0],
1232 ARRAY_SIZE(twl4030_dapm_analoglmic_controls)),
1233 SND_SOC_DAPM_MIXER("Analog Right Capture Route",
1234 TWL4030_REG_ANAMICR, 4, 0,
1235 &twl4030_dapm_analogrmic_controls[0],
1236 ARRAY_SIZE(twl4030_dapm_analogrmic_controls)),
1238 SND_SOC_DAPM_PGA("ADC Physical Left",
1239 TWL4030_REG_AVADC_CTL, 3, 0, NULL, 0),
1240 SND_SOC_DAPM_PGA("ADC Physical Right",
1241 TWL4030_REG_AVADC_CTL, 1, 0, NULL, 0),
1243 SND_SOC_DAPM_PGA("Digimic0 Enable",
1244 TWL4030_REG_ADCMICSEL, 1, 0, NULL, 0),
1245 SND_SOC_DAPM_PGA("Digimic1 Enable",
1246 TWL4030_REG_ADCMICSEL, 3, 0, NULL, 0),
1248 SND_SOC_DAPM_MICBIAS("Mic Bias 1", TWL4030_REG_MICBIAS_CTL, 0, 0),
1249 SND_SOC_DAPM_MICBIAS("Mic Bias 2", TWL4030_REG_MICBIAS_CTL, 1, 0),
1250 SND_SOC_DAPM_MICBIAS("Headset Mic Bias", TWL4030_REG_MICBIAS_CTL, 2, 0),
1254 static const struct snd_soc_dapm_route intercon[] = {
1255 {"Digital L1 Playback Mixer", NULL, "DAC Left1"},
1256 {"Digital R1 Playback Mixer", NULL, "DAC Right1"},
1257 {"Digital L2 Playback Mixer", NULL, "DAC Left2"},
1258 {"Digital R2 Playback Mixer", NULL, "DAC Right2"},
1259 {"Digital Voice Playback Mixer", NULL, "DAC Voice"},
1261 {"Analog L1 Playback Mixer", NULL, "Digital L1 Playback Mixer"},
1262 {"Analog R1 Playback Mixer", NULL, "Digital R1 Playback Mixer"},
1263 {"Analog L2 Playback Mixer", NULL, "Digital L2 Playback Mixer"},
1264 {"Analog R2 Playback Mixer", NULL, "Digital R2 Playback Mixer"},
1265 {"Analog Voice Playback Mixer", NULL, "Digital Voice Playback Mixer"},
1267 /* Internal playback routings */
1269 {"Earpiece Mixer", "Voice", "Analog Voice Playback Mixer"},
1270 {"Earpiece Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1271 {"Earpiece Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1272 {"Earpiece Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1274 {"PredriveL Mixer", "Voice", "Analog Voice Playback Mixer"},
1275 {"PredriveL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1276 {"PredriveL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1277 {"PredriveL Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1279 {"PredriveR Mixer", "Voice", "Analog Voice Playback Mixer"},
1280 {"PredriveR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1281 {"PredriveR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1282 {"PredriveR Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1284 {"HeadsetL Mixer", "Voice", "Analog Voice Playback Mixer"},
1285 {"HeadsetL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1286 {"HeadsetL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1287 {"HeadsetL PGA", NULL, "HeadsetL Mixer"},
1289 {"HeadsetR Mixer", "Voice", "Analog Voice Playback Mixer"},
1290 {"HeadsetR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1291 {"HeadsetR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1292 {"HeadsetR PGA", NULL, "HeadsetR Mixer"},
1294 {"CarkitL Mixer", "Voice", "Analog Voice Playback Mixer"},
1295 {"CarkitL Mixer", "AudioL1", "Analog L1 Playback Mixer"},
1296 {"CarkitL Mixer", "AudioL2", "Analog L2 Playback Mixer"},
1298 {"CarkitR Mixer", "Voice", "Analog Voice Playback Mixer"},
1299 {"CarkitR Mixer", "AudioR1", "Analog R1 Playback Mixer"},
1300 {"CarkitR Mixer", "AudioR2", "Analog R2 Playback Mixer"},
1302 {"HandsfreeL Mux", "Voice", "Analog Voice Playback Mixer"},
1303 {"HandsfreeL Mux", "AudioL1", "Analog L1 Playback Mixer"},
1304 {"HandsfreeL Mux", "AudioL2", "Analog L2 Playback Mixer"},
1305 {"HandsfreeL Mux", "AudioR2", "Analog R2 Playback Mixer"},
1307 {"HandsfreeR Mux", "Voice", "Analog Voice Playback Mixer"},
1308 {"HandsfreeR Mux", "AudioR1", "Analog R1 Playback Mixer"},
1309 {"HandsfreeR Mux", "AudioR2", "Analog R2 Playback Mixer"},
1310 {"HandsfreeR Mux", "AudioL2", "Analog L2 Playback Mixer"},
1312 {"Vibra Mux", "AudioL1", "DAC Left1"},
1313 {"Vibra Mux", "AudioR1", "DAC Right1"},
1314 {"Vibra Mux", "AudioL2", "DAC Left2"},
1315 {"Vibra Mux", "AudioR2", "DAC Right2"},
1318 {"OUTL", NULL, "Analog L2 Playback Mixer"},
1319 {"OUTR", NULL, "Analog R2 Playback Mixer"},
1320 {"EARPIECE", NULL, "Earpiece Mixer"},
1321 {"PREDRIVEL", NULL, "PredriveL Mixer"},
1322 {"PREDRIVER", NULL, "PredriveR Mixer"},
1323 {"HSOL", NULL, "HeadsetL PGA"},
1324 {"HSOR", NULL, "HeadsetR PGA"},
1325 {"CARKITL", NULL, "CarkitL Mixer"},
1326 {"CARKITR", NULL, "CarkitR Mixer"},
1327 {"HFL", NULL, "HandsfreeL Mux"},
1328 {"HFR", NULL, "HandsfreeR Mux"},
1329 {"Vibra Route", "Audio", "Vibra Mux"},
1330 {"VIBRA", NULL, "Vibra Route"},
1333 {"Analog Left Capture Route", "Main mic", "MAINMIC"},
1334 {"Analog Left Capture Route", "Headset mic", "HSMIC"},
1335 {"Analog Left Capture Route", "AUXL", "AUXL"},
1336 {"Analog Left Capture Route", "Carkit mic", "CARKITMIC"},
1338 {"Analog Right Capture Route", "Sub mic", "SUBMIC"},
1339 {"Analog Right Capture Route", "AUXR", "AUXR"},
1341 {"ADC Physical Left", NULL, "Analog Left Capture Route"},
1342 {"ADC Physical Right", NULL, "Analog Right Capture Route"},
1344 {"Digimic0 Enable", NULL, "DIGIMIC0"},
1345 {"Digimic1 Enable", NULL, "DIGIMIC1"},
1347 /* TX1 Left capture path */
1348 {"TX1 Capture Route", "Analog", "ADC Physical Left"},
1349 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1350 /* TX1 Right capture path */
1351 {"TX1 Capture Route", "Analog", "ADC Physical Right"},
1352 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1353 /* TX2 Left capture path */
1354 {"TX2 Capture Route", "Analog", "ADC Physical Left"},
1355 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1356 /* TX2 Right capture path */
1357 {"TX2 Capture Route", "Analog", "ADC Physical Right"},
1358 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1360 {"ADC Virtual Left1", NULL, "TX1 Capture Route"},
1361 {"ADC Virtual Right1", NULL, "TX1 Capture Route"},
1362 {"ADC Virtual Left2", NULL, "TX2 Capture Route"},
1363 {"ADC Virtual Right2", NULL, "TX2 Capture Route"},
1365 /* Analog bypass routes */
1366 {"Right1 Analog Loopback", "Switch", "Analog Right Capture Route"},
1367 {"Left1 Analog Loopback", "Switch", "Analog Left Capture Route"},
1368 {"Right2 Analog Loopback", "Switch", "Analog Right Capture Route"},
1369 {"Left2 Analog Loopback", "Switch", "Analog Left Capture Route"},
1370 {"Voice Analog Loopback", "Switch", "Analog Left Capture Route"},
1372 {"Analog R1 Playback Mixer", NULL, "Right1 Analog Loopback"},
1373 {"Analog L1 Playback Mixer", NULL, "Left1 Analog Loopback"},
1374 {"Analog R2 Playback Mixer", NULL, "Right2 Analog Loopback"},
1375 {"Analog L2 Playback Mixer", NULL, "Left2 Analog Loopback"},
1376 {"Analog Voice Playback Mixer", NULL, "Voice Analog Loopback"},
1378 /* Digital bypass routes */
1379 {"Right Digital Loopback", "Volume", "TX1 Capture Route"},
1380 {"Left Digital Loopback", "Volume", "TX1 Capture Route"},
1381 {"Voice Digital Loopback", "Volume", "TX2 Capture Route"},
1383 {"Digital R2 Playback Mixer", NULL, "Right Digital Loopback"},
1384 {"Digital L2 Playback Mixer", NULL, "Left Digital Loopback"},
1385 {"Digital Voice Playback Mixer", NULL, "Voice Digital Loopback"},
1389 static int twl4030_add_widgets(struct snd_soc_codec *codec)
1391 snd_soc_dapm_new_controls(codec, twl4030_dapm_widgets,
1392 ARRAY_SIZE(twl4030_dapm_widgets));
1394 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
1396 snd_soc_dapm_new_widgets(codec);
1400 static int twl4030_set_bias_level(struct snd_soc_codec *codec,
1401 enum snd_soc_bias_level level)
1403 struct twl4030_priv *twl4030 = codec->private_data;
1406 case SND_SOC_BIAS_ON:
1407 twl4030_codec_mute(codec, 0);
1409 case SND_SOC_BIAS_PREPARE:
1410 twl4030_power_up(codec);
1411 if (twl4030->bypass_state)
1412 twl4030_codec_mute(codec, 0);
1414 twl4030_codec_mute(codec, 1);
1416 case SND_SOC_BIAS_STANDBY:
1417 twl4030_power_up(codec);
1418 if (twl4030->bypass_state)
1419 twl4030_codec_mute(codec, 0);
1421 twl4030_codec_mute(codec, 1);
1423 case SND_SOC_BIAS_OFF:
1424 twl4030_power_down(codec);
1427 codec->bias_level = level;
1432 static void twl4030_constraints(struct twl4030_priv *twl4030,
1433 struct snd_pcm_substream *mst_substream)
1435 struct snd_pcm_substream *slv_substream;
1437 /* Pick the stream, which need to be constrained */
1438 if (mst_substream == twl4030->master_substream)
1439 slv_substream = twl4030->slave_substream;
1440 else if (mst_substream == twl4030->slave_substream)
1441 slv_substream = twl4030->master_substream;
1442 else /* This should not happen.. */
1445 /* Set the constraints according to the already configured stream */
1446 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1447 SNDRV_PCM_HW_PARAM_RATE,
1451 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1452 SNDRV_PCM_HW_PARAM_SAMPLE_BITS,
1453 twl4030->sample_bits,
1454 twl4030->sample_bits);
1456 snd_pcm_hw_constraint_minmax(slv_substream->runtime,
1457 SNDRV_PCM_HW_PARAM_CHANNELS,
1462 /* In case of 4 channel mode, the RX1 L/R for playback and the TX2 L/R for
1463 * capture has to be enabled/disabled. */
1464 static void twl4030_tdm_enable(struct snd_soc_codec *codec, int direction,
1469 reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1471 if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1472 mask = TWL4030_ARXL1_VRX_EN | TWL4030_ARXR1_EN;
1474 mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1481 twl4030_write(codec, TWL4030_REG_OPTION, reg);
1484 static int twl4030_startup(struct snd_pcm_substream *substream,
1485 struct snd_soc_dai *dai)
1487 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1488 struct snd_soc_device *socdev = rtd->socdev;
1489 struct snd_soc_codec *codec = socdev->card->codec;
1490 struct twl4030_priv *twl4030 = codec->private_data;
1492 if (twl4030->master_substream) {
1493 twl4030->slave_substream = substream;
1494 /* The DAI has one configuration for playback and capture, so
1495 * if the DAI has been already configured then constrain this
1496 * substream to match it. */
1497 if (twl4030->configured)
1498 twl4030_constraints(twl4030, twl4030->master_substream);
1500 if (!(twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE) &
1501 TWL4030_OPTION_1)) {
1502 /* In option2 4 channel is not supported, set the
1503 * constraint for the first stream for channels, the
1504 * second stream will 'inherit' this cosntraint */
1505 snd_pcm_hw_constraint_minmax(substream->runtime,
1506 SNDRV_PCM_HW_PARAM_CHANNELS,
1509 twl4030->master_substream = substream;
1515 static void twl4030_shutdown(struct snd_pcm_substream *substream,
1516 struct snd_soc_dai *dai)
1518 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1519 struct snd_soc_device *socdev = rtd->socdev;
1520 struct snd_soc_codec *codec = socdev->card->codec;
1521 struct twl4030_priv *twl4030 = codec->private_data;
1523 if (twl4030->master_substream == substream)
1524 twl4030->master_substream = twl4030->slave_substream;
1526 twl4030->slave_substream = NULL;
1528 /* If all streams are closed, or the remaining stream has not yet
1529 * been configured than set the DAI as not configured. */
1530 if (!twl4030->master_substream)
1531 twl4030->configured = 0;
1532 else if (!twl4030->master_substream->runtime->channels)
1533 twl4030->configured = 0;
1535 /* If the closing substream had 4 channel, do the necessary cleanup */
1536 if (substream->runtime->channels == 4)
1537 twl4030_tdm_enable(codec, substream->stream, 0);
1540 static int twl4030_hw_params(struct snd_pcm_substream *substream,
1541 struct snd_pcm_hw_params *params,
1542 struct snd_soc_dai *dai)
1544 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1545 struct snd_soc_device *socdev = rtd->socdev;
1546 struct snd_soc_codec *codec = socdev->card->codec;
1547 struct twl4030_priv *twl4030 = codec->private_data;
1548 u8 mode, old_mode, format, old_format;
1550 /* If the substream has 4 channel, do the necessary setup */
1551 if (params_channels(params) == 4) {
1552 /* Safety check: are we in the correct operating mode? */
1553 if ((twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE) &
1555 twl4030_tdm_enable(codec, substream->stream, 1);
1560 if (twl4030->configured)
1561 /* Ignoring hw_params for already configured DAI */
1565 old_mode = twl4030_read_reg_cache(codec,
1566 TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1567 mode = old_mode & ~TWL4030_APLL_RATE;
1569 switch (params_rate(params)) {
1571 mode |= TWL4030_APLL_RATE_8000;
1574 mode |= TWL4030_APLL_RATE_11025;
1577 mode |= TWL4030_APLL_RATE_12000;
1580 mode |= TWL4030_APLL_RATE_16000;
1583 mode |= TWL4030_APLL_RATE_22050;
1586 mode |= TWL4030_APLL_RATE_24000;
1589 mode |= TWL4030_APLL_RATE_32000;
1592 mode |= TWL4030_APLL_RATE_44100;
1595 mode |= TWL4030_APLL_RATE_48000;
1598 mode |= TWL4030_APLL_RATE_96000;
1601 printk(KERN_ERR "TWL4030 hw params: unknown rate %d\n",
1602 params_rate(params));
1606 if (mode != old_mode) {
1607 /* change rate and set CODECPDZ */
1608 twl4030_codec_enable(codec, 0);
1609 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1610 twl4030_codec_enable(codec, 1);
1614 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1615 format = old_format;
1616 format &= ~TWL4030_DATA_WIDTH;
1617 switch (params_format(params)) {
1618 case SNDRV_PCM_FORMAT_S16_LE:
1619 format |= TWL4030_DATA_WIDTH_16S_16W;
1621 case SNDRV_PCM_FORMAT_S24_LE:
1622 format |= TWL4030_DATA_WIDTH_32S_24W;
1625 printk(KERN_ERR "TWL4030 hw params: unknown format %d\n",
1626 params_format(params));
1630 if (format != old_format) {
1632 /* clear CODECPDZ before changing format (codec requirement) */
1633 twl4030_codec_enable(codec, 0);
1636 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1638 /* set CODECPDZ afterwards */
1639 twl4030_codec_enable(codec, 1);
1642 /* Store the important parameters for the DAI configuration and set
1643 * the DAI as configured */
1644 twl4030->configured = 1;
1645 twl4030->rate = params_rate(params);
1646 twl4030->sample_bits = hw_param_interval(params,
1647 SNDRV_PCM_HW_PARAM_SAMPLE_BITS)->min;
1648 twl4030->channels = params_channels(params);
1650 /* If both playback and capture streams are open, and one of them
1651 * is setting the hw parameters right now (since we are here), set
1652 * constraints to the other stream to match the current one. */
1653 if (twl4030->slave_substream)
1654 twl4030_constraints(twl4030, substream);
1659 static int twl4030_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1660 int clk_id, unsigned int freq, int dir)
1662 struct snd_soc_codec *codec = codec_dai->codec;
1663 struct twl4030_priv *twl4030 = codec->private_data;
1668 infreq = TWL4030_APLL_INFREQ_19200KHZ;
1669 twl4030->sysclk = 19200;
1672 infreq = TWL4030_APLL_INFREQ_26000KHZ;
1673 twl4030->sysclk = 26000;
1676 infreq = TWL4030_APLL_INFREQ_38400KHZ;
1677 twl4030->sysclk = 38400;
1680 printk(KERN_ERR "TWL4030 set sysclk: unknown rate %d\n",
1685 infreq |= TWL4030_APLL_EN;
1686 twl4030_write(codec, TWL4030_REG_APLL_CTL, infreq);
1691 static int twl4030_set_dai_fmt(struct snd_soc_dai *codec_dai,
1694 struct snd_soc_codec *codec = codec_dai->codec;
1695 u8 old_format, format;
1698 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1699 format = old_format;
1701 /* set master/slave audio interface */
1702 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1703 case SND_SOC_DAIFMT_CBM_CFM:
1704 format &= ~(TWL4030_AIF_SLAVE_EN);
1705 format &= ~(TWL4030_CLK256FS_EN);
1707 case SND_SOC_DAIFMT_CBS_CFS:
1708 format |= TWL4030_AIF_SLAVE_EN;
1709 format |= TWL4030_CLK256FS_EN;
1715 /* interface format */
1716 format &= ~TWL4030_AIF_FORMAT;
1717 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1718 case SND_SOC_DAIFMT_I2S:
1719 format |= TWL4030_AIF_FORMAT_CODEC;
1721 case SND_SOC_DAIFMT_DSP_A:
1722 format |= TWL4030_AIF_FORMAT_TDM;
1728 if (format != old_format) {
1730 /* clear CODECPDZ before changing format (codec requirement) */
1731 twl4030_codec_enable(codec, 0);
1734 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1736 /* set CODECPDZ afterwards */
1737 twl4030_codec_enable(codec, 1);
1743 /* In case of voice mode, the RX1 L(VRX) for downlink and the TX2 L/R
1744 * (VTXL, VTXR) for uplink has to be enabled/disabled. */
1745 static void twl4030_voice_enable(struct snd_soc_codec *codec, int direction,
1750 reg = twl4030_read_reg_cache(codec, TWL4030_REG_OPTION);
1752 if (direction == SNDRV_PCM_STREAM_PLAYBACK)
1753 mask = TWL4030_ARXL1_VRX_EN;
1755 mask = TWL4030_ATXL2_VTXL_EN | TWL4030_ATXR2_VTXR_EN;
1762 twl4030_write(codec, TWL4030_REG_OPTION, reg);
1765 static int twl4030_voice_startup(struct snd_pcm_substream *substream,
1766 struct snd_soc_dai *dai)
1768 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1769 struct snd_soc_device *socdev = rtd->socdev;
1770 struct snd_soc_codec *codec = socdev->card->codec;
1774 /* If the system master clock is not 26MHz, the voice PCM interface is
1777 infreq = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL)
1778 & TWL4030_APLL_INFREQ;
1780 if (infreq != TWL4030_APLL_INFREQ_26000KHZ) {
1781 printk(KERN_ERR "TWL4030 voice startup: "
1782 "MCLK is not 26MHz, call set_sysclk() on init\n");
1786 /* If the codec mode is not option2, the voice PCM interface is not
1789 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
1792 if (mode != TWL4030_OPTION_2) {
1793 printk(KERN_ERR "TWL4030 voice startup: "
1794 "the codec mode is not option2\n");
1801 static void twl4030_voice_shutdown(struct snd_pcm_substream *substream,
1802 struct snd_soc_dai *dai)
1804 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1805 struct snd_soc_device *socdev = rtd->socdev;
1806 struct snd_soc_codec *codec = socdev->card->codec;
1808 /* Enable voice digital filters */
1809 twl4030_voice_enable(codec, substream->stream, 0);
1812 static int twl4030_voice_hw_params(struct snd_pcm_substream *substream,
1813 struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
1815 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1816 struct snd_soc_device *socdev = rtd->socdev;
1817 struct snd_soc_codec *codec = socdev->card->codec;
1820 /* Enable voice digital filters */
1821 twl4030_voice_enable(codec, substream->stream, 1);
1824 old_mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE)
1825 & ~(TWL4030_CODECPDZ);
1828 switch (params_rate(params)) {
1830 mode &= ~(TWL4030_SEL_16K);
1833 mode |= TWL4030_SEL_16K;
1836 printk(KERN_ERR "TWL4030 voice hw params: unknown rate %d\n",
1837 params_rate(params));
1841 if (mode != old_mode) {
1842 /* change rate and set CODECPDZ */
1843 twl4030_codec_enable(codec, 0);
1844 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
1845 twl4030_codec_enable(codec, 1);
1851 static int twl4030_voice_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1852 int clk_id, unsigned int freq, int dir)
1854 struct snd_soc_codec *codec = codec_dai->codec;
1859 infreq = TWL4030_APLL_INFREQ_26000KHZ;
1862 printk(KERN_ERR "TWL4030 voice set sysclk: unknown rate %d\n",
1867 infreq |= TWL4030_APLL_EN;
1868 twl4030_write(codec, TWL4030_REG_APLL_CTL, infreq);
1873 static int twl4030_voice_set_dai_fmt(struct snd_soc_dai *codec_dai,
1876 struct snd_soc_codec *codec = codec_dai->codec;
1877 u8 old_format, format;
1880 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_VOICE_IF);
1881 format = old_format;
1883 /* set master/slave audio interface */
1884 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1885 case SND_SOC_DAIFMT_CBS_CFM:
1886 format &= ~(TWL4030_VIF_SLAVE_EN);
1888 case SND_SOC_DAIFMT_CBS_CFS:
1889 format |= TWL4030_VIF_SLAVE_EN;
1895 /* clock inversion */
1896 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1897 case SND_SOC_DAIFMT_IB_NF:
1898 format &= ~(TWL4030_VIF_FORMAT);
1900 case SND_SOC_DAIFMT_NB_IF:
1901 format |= TWL4030_VIF_FORMAT;
1907 if (format != old_format) {
1908 /* change format and set CODECPDZ */
1909 twl4030_codec_enable(codec, 0);
1910 twl4030_write(codec, TWL4030_REG_VOICE_IF, format);
1911 twl4030_codec_enable(codec, 1);
1917 #define TWL4030_RATES (SNDRV_PCM_RATE_8000_48000)
1918 #define TWL4030_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FORMAT_S24_LE)
1920 static struct snd_soc_dai_ops twl4030_dai_ops = {
1921 .startup = twl4030_startup,
1922 .shutdown = twl4030_shutdown,
1923 .hw_params = twl4030_hw_params,
1924 .set_sysclk = twl4030_set_dai_sysclk,
1925 .set_fmt = twl4030_set_dai_fmt,
1928 static struct snd_soc_dai_ops twl4030_dai_voice_ops = {
1929 .startup = twl4030_voice_startup,
1930 .shutdown = twl4030_voice_shutdown,
1931 .hw_params = twl4030_voice_hw_params,
1932 .set_sysclk = twl4030_voice_set_dai_sysclk,
1933 .set_fmt = twl4030_voice_set_dai_fmt,
1936 struct snd_soc_dai twl4030_dai[] = {
1940 .stream_name = "Playback",
1943 .rates = TWL4030_RATES | SNDRV_PCM_RATE_96000,
1944 .formats = TWL4030_FORMATS,},
1946 .stream_name = "Capture",
1949 .rates = TWL4030_RATES,
1950 .formats = TWL4030_FORMATS,},
1951 .ops = &twl4030_dai_ops,
1954 .name = "twl4030 Voice",
1956 .stream_name = "Playback",
1959 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
1960 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
1962 .stream_name = "Capture",
1965 .rates = SNDRV_PCM_RATE_8000 | SNDRV_PCM_RATE_16000,
1966 .formats = SNDRV_PCM_FMTBIT_S16_LE,},
1967 .ops = &twl4030_dai_voice_ops,
1970 EXPORT_SYMBOL_GPL(twl4030_dai);
1972 static int twl4030_suspend(struct platform_device *pdev, pm_message_t state)
1974 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1975 struct snd_soc_codec *codec = socdev->card->codec;
1977 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
1982 static int twl4030_resume(struct platform_device *pdev)
1984 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1985 struct snd_soc_codec *codec = socdev->card->codec;
1987 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1988 twl4030_set_bias_level(codec, codec->suspend_bias_level);
1993 * initialize the driver
1994 * register the mixer and dsp interfaces with the kernel
1997 static int twl4030_init(struct snd_soc_device *socdev)
1999 struct snd_soc_codec *codec = socdev->card->codec;
2002 printk(KERN_INFO "TWL4030 Audio Codec init \n");
2004 codec->name = "twl4030";
2005 codec->owner = THIS_MODULE;
2006 codec->read = twl4030_read_reg_cache;
2007 codec->write = twl4030_write;
2008 codec->set_bias_level = twl4030_set_bias_level;
2009 codec->dai = twl4030_dai;
2010 codec->num_dai = ARRAY_SIZE(twl4030_dai),
2011 codec->reg_cache_size = sizeof(twl4030_reg);
2012 codec->reg_cache = kmemdup(twl4030_reg, sizeof(twl4030_reg),
2014 if (codec->reg_cache == NULL)
2018 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
2020 printk(KERN_ERR "twl4030: failed to create pcms\n");
2024 twl4030_init_chip(codec);
2026 /* power on device */
2027 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
2029 snd_soc_add_controls(codec, twl4030_snd_controls,
2030 ARRAY_SIZE(twl4030_snd_controls));
2031 twl4030_add_widgets(codec);
2033 ret = snd_soc_init_card(socdev);
2035 printk(KERN_ERR "twl4030: failed to register card\n");
2042 snd_soc_free_pcms(socdev);
2043 snd_soc_dapm_free(socdev);
2045 kfree(codec->reg_cache);
2049 static struct snd_soc_device *twl4030_socdev;
2051 static int twl4030_probe(struct platform_device *pdev)
2053 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2054 struct snd_soc_codec *codec;
2055 struct twl4030_priv *twl4030;
2057 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
2061 twl4030 = kzalloc(sizeof(struct twl4030_priv), GFP_KERNEL);
2062 if (twl4030 == NULL) {
2066 /* Set default sysclk (used by the headsetl/rpga_event callback for
2067 * pop-attenuation) */
2068 twl4030->sysclk = 26000;
2070 codec->private_data = twl4030;
2071 socdev->card->codec = codec;
2072 mutex_init(&codec->mutex);
2073 INIT_LIST_HEAD(&codec->dapm_widgets);
2074 INIT_LIST_HEAD(&codec->dapm_paths);
2076 twl4030_socdev = socdev;
2077 twl4030_init(socdev);
2082 static int twl4030_remove(struct platform_device *pdev)
2084 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
2085 struct snd_soc_codec *codec = socdev->card->codec;
2087 printk(KERN_INFO "TWL4030 Audio Codec remove\n");
2088 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
2089 snd_soc_free_pcms(socdev);
2090 snd_soc_dapm_free(socdev);
2091 kfree(codec->private_data);
2097 struct snd_soc_codec_device soc_codec_dev_twl4030 = {
2098 .probe = twl4030_probe,
2099 .remove = twl4030_remove,
2100 .suspend = twl4030_suspend,
2101 .resume = twl4030_resume,
2103 EXPORT_SYMBOL_GPL(soc_codec_dev_twl4030);
2105 static int __init twl4030_modinit(void)
2107 return snd_soc_register_dais(&twl4030_dai[0], ARRAY_SIZE(twl4030_dai));
2109 module_init(twl4030_modinit);
2111 static void __exit twl4030_exit(void)
2113 snd_soc_unregister_dais(&twl4030_dai[0], ARRAY_SIZE(twl4030_dai));
2115 module_exit(twl4030_exit);
2117 MODULE_DESCRIPTION("ASoC TWL4030 codec driver");
2118 MODULE_AUTHOR("Steve Sakoman");
2119 MODULE_LICENSE("GPL");