projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
ASoC: TWL4030: 96KHz playback support
[deliverable/linux.git] / sound / soc / codecs / twl4030.c
CommitLineData
cc17557e
SS		 1/*
2 * ALSA SoC TWL4030 codec driver
3 *
4 * Author: Steve Sakoman, <steve@sakoman.com>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * version 2 as published by the Free Software Foundation.
9 *
10 * This program is distributed in the hope that it will be useful, but
11 * WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
13 * General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
16 * along with this program; if not, write to the Free Software
17 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
18 * 02110-1301 USA
19 *
20 */
21
22#include <linux/module.h>
23#include <linux/moduleparam.h>
24#include <linux/init.h>
25#include <linux/delay.h>
26#include <linux/pm.h>
27#include <linux/i2c.h>
28#include <linux/platform_device.h>
29#include <linux/i2c/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>
c10b82cf 36#include <sound/tlv.h>
cc17557e
SS		 37
38#include "twl4030.h"
39
40/*
41 * twl4030 register cache & default register settings
42 */
43static const u8 twl4030_reg[TWL4030_CACHEREGNUM] = {
44 0x00, /* this register not used */
db04e2c5 45 0x91, /* REG_CODEC_MODE (0x1) */
cc17557e
SS		 46 0xc3, /* REG_OPTION (0x2) */
47 0x00, /* REG_UNKNOWN (0x3) */
48 0x00, /* REG_MICBIAS_CTL (0x4) */
5920b453
GI		 49 0x20, /* REG_ANAMICL (0x5) */
50 0x00, /* REG_ANAMICR (0x6) */
51 0x00, /* REG_AVADC_CTL (0x7) */
cc17557e
SS		 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) */
f8d05bdb 91 0x00, /* REG_SOFTVOL_CTL (0x2F) */
cc17557e
SS		 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};
119
7393958f
PU		 120/* codec private data */
121struct twl4030_priv {
122 unsigned int bypass_state;
123 unsigned int codec_powered;
124 unsigned int codec_muted;
125};
126
cc17557e
SS		 127/*
128 * read twl4030 register cache
129 */
130static inline unsigned int twl4030_read_reg_cache(struct snd_soc_codec *codec,
131 unsigned int reg)
132{
133 u8 *cache = codec->reg_cache;
134
91432e97
IM		 135 if (reg >= TWL4030_CACHEREGNUM)
136 return -EIO;
137
cc17557e
SS		 138 return cache[reg];
139}
140
141/*
142 * write twl4030 register cache
143 */
144static inline void twl4030_write_reg_cache(struct snd_soc_codec *codec,
145 u8 reg, u8 value)
146{
147 u8 *cache = codec->reg_cache;
148
149 if (reg >= TWL4030_CACHEREGNUM)
150 return;
151 cache[reg] = value;
152}
153
154/*
155 * write to the twl4030 register space
156 */
157static int twl4030_write(struct snd_soc_codec *codec,
158 unsigned int reg, unsigned int value)
159{
160 twl4030_write_reg_cache(codec, reg, value);
161 return twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE, value, reg);
162}
163
db04e2c5 164static void twl4030_codec_enable(struct snd_soc_codec *codec, int enable)
cc17557e 165{
7393958f 166 struct twl4030_priv *twl4030 = codec->private_data;
cc17557e
SS		 167 u8 mode;
168
7393958f
PU		 169 if (enable == twl4030->codec_powered)
170 return;
171
cc17557e 172 mode = twl4030_read_reg_cache(codec, TWL4030_REG_CODEC_MODE);
db04e2c5
PU		 173 if (enable)
174 mode |= TWL4030_CODECPDZ;
175 else
176 mode &= ~TWL4030_CODECPDZ;
cc17557e 177
db04e2c5 178 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
7393958f 179 twl4030->codec_powered = enable;
cc17557e
SS		 180
181 /* REVISIT: this delay is present in TI sample drivers */
182 /* but there seems to be no TRM requirement for it */
183 udelay(10);
184}
185
186static void twl4030_init_chip(struct snd_soc_codec *codec)
187{
188 int i;
189
190 /* clear CODECPDZ prior to setting register defaults */
db04e2c5 191 twl4030_codec_enable(codec, 0);
cc17557e
SS		 192
193 /* set all audio section registers to reasonable defaults */
194 for (i = TWL4030_REG_OPTION; i <= TWL4030_REG_MISC_SET_2; i++)
195 twl4030_write(codec, i, twl4030_reg[i]);
196
197}
198
7393958f
PU		 199static void twl4030_codec_mute(struct snd_soc_codec *codec, int mute)
200{
201 struct twl4030_priv *twl4030 = codec->private_data;
202 u8 reg_val;
203
204 if (mute == twl4030->codec_muted)
205 return;
206
207 if (mute) {
208 /* Bypass the reg_cache and mute the volumes
209 * Headset mute is done in it's own event handler
210 * Things to mute: Earpiece, PreDrivL/R, CarkitL/R
211 */
212 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL);
213 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
214 reg_val & (~TWL4030_EAR_GAIN),
215 TWL4030_REG_EAR_CTL);
216
217 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL);
218 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
219 reg_val & (~TWL4030_PREDL_GAIN),
220 TWL4030_REG_PREDL_CTL);
221 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL);
222 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
223 reg_val & (~TWL4030_PREDR_GAIN),
224 TWL4030_REG_PREDL_CTL);
225
226 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL);
227 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
228 reg_val & (~TWL4030_PRECKL_GAIN),
229 TWL4030_REG_PRECKL_CTL);
230 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL);
231 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
232 reg_val & (~TWL4030_PRECKL_GAIN),
233 TWL4030_REG_PRECKR_CTL);
234
235 /* Disable PLL */
236 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
237 reg_val &= ~TWL4030_APLL_EN;
238 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
239 } else {
240 /* Restore the volumes
241 * Headset mute is done in it's own event handler
242 * Things to restore: Earpiece, PreDrivL/R, CarkitL/R
243 */
244 twl4030_write(codec, TWL4030_REG_EAR_CTL,
245 twl4030_read_reg_cache(codec, TWL4030_REG_EAR_CTL));
246
247 twl4030_write(codec, TWL4030_REG_PREDL_CTL,
248 twl4030_read_reg_cache(codec, TWL4030_REG_PREDL_CTL));
249 twl4030_write(codec, TWL4030_REG_PREDR_CTL,
250 twl4030_read_reg_cache(codec, TWL4030_REG_PREDR_CTL));
251
252 twl4030_write(codec, TWL4030_REG_PRECKL_CTL,
253 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKL_CTL));
254 twl4030_write(codec, TWL4030_REG_PRECKR_CTL,
255 twl4030_read_reg_cache(codec, TWL4030_REG_PRECKR_CTL));
256
257 /* Enable PLL */
258 reg_val = twl4030_read_reg_cache(codec, TWL4030_REG_APLL_CTL);
259 reg_val |= TWL4030_APLL_EN;
260 twl4030_write(codec, TWL4030_REG_APLL_CTL, reg_val);
261 }
262
263 twl4030->codec_muted = mute;
264}
265
006f367e
PU		 266static void twl4030_power_up(struct snd_soc_codec *codec)
267{
7393958f 268 struct twl4030_priv *twl4030 = codec->private_data;
006f367e
PU		 269 u8 anamicl, regmisc1, byte;
270 int i = 0;
271
7393958f
PU		 272 if (twl4030->codec_powered)
273 return;
274
006f367e
PU		 275 /* set CODECPDZ to turn on codec */
276 twl4030_codec_enable(codec, 1);
277
278 /* initiate offset cancellation */
279 anamicl = twl4030_read_reg_cache(codec, TWL4030_REG_ANAMICL);
280 twl4030_write(codec, TWL4030_REG_ANAMICL,
281 anamicl | TWL4030_CNCL_OFFSET_START);
282
283 /* wait for offset cancellation to complete */
284 do {
285 /* this takes a little while, so don't slam i2c */
286 udelay(2000);
287 twl4030_i2c_read_u8(TWL4030_MODULE_AUDIO_VOICE, &byte,
288 TWL4030_REG_ANAMICL);
289 } while ((i++ < 100) &&
290 ((byte & TWL4030_CNCL_OFFSET_START) ==
291 TWL4030_CNCL_OFFSET_START));
292
293 /* Make sure that the reg_cache has the same value as the HW */
294 twl4030_write_reg_cache(codec, TWL4030_REG_ANAMICL, byte);
295
296 /* anti-pop when changing analog gain */
297 regmisc1 = twl4030_read_reg_cache(codec, TWL4030_REG_MISC_SET_1);
298 twl4030_write(codec, TWL4030_REG_MISC_SET_1,
299 regmisc1 | TWL4030_SMOOTH_ANAVOL_EN);
300
301 /* toggle CODECPDZ as per TRM */
302 twl4030_codec_enable(codec, 0);
303 twl4030_codec_enable(codec, 1);
304}
305
7393958f
PU		 306/*
307 * Unconditional power down
308 */
006f367e
PU		 309static void twl4030_power_down(struct snd_soc_codec *codec)
310{
311 /* power down */
312 twl4030_codec_enable(codec, 0);
313}
314
5e98a464
PU		 315/* Earpiece */
316static const char *twl4030_earpiece_texts[] =
2f423577 317 {"Off", "DACL1", "DACL2", "DACR1"};
5e98a464 318
2f423577
PU		 319static const unsigned int twl4030_earpiece_values[] =
320 {0x0, 0x1, 0x2, 0x4};
321
cb1ace04 322static const struct soc_enum twl4030_earpiece_enum =
2f423577 323 SOC_VALUE_ENUM_SINGLE(TWL4030_REG_EAR_CTL, 1, 0x7,
5e98a464 324 ARRAY_SIZE(twl4030_earpiece_texts),
2f423577
PU		 325 twl4030_earpiece_texts,
326 twl4030_earpiece_values);
5e98a464
PU		 327
328static const struct snd_kcontrol_new twl4030_dapm_earpiece_control =
2f423577 329SOC_DAPM_VALUE_ENUM("Route", twl4030_earpiece_enum);
5e98a464 330
2a6f5c58
PU		 331/* PreDrive Left */
332static const char *twl4030_predrivel_texts[] =
2f423577
PU		 333 {"Off", "DACL1", "DACL2", "DACR2"};
334
335static const unsigned int twl4030_predrivel_values[] =
336 {0x0, 0x1, 0x2, 0x4};
2a6f5c58 337
cb1ace04 338static const struct soc_enum twl4030_predrivel_enum =
2f423577 339 SOC_VALUE_ENUM_SINGLE(TWL4030_REG_PREDL_CTL, 1, 0x7,
2a6f5c58 340 ARRAY_SIZE(twl4030_predrivel_texts),
2f423577
PU		 341 twl4030_predrivel_texts,
342 twl4030_predrivel_values);
2a6f5c58
PU		 343
344static const struct snd_kcontrol_new twl4030_dapm_predrivel_control =
2f423577 345SOC_DAPM_VALUE_ENUM("Route", twl4030_predrivel_enum);
2a6f5c58
PU		 346
347/* PreDrive Right */
348static const char *twl4030_predriver_texts[] =
2f423577 349 {"Off", "DACR1", "DACR2", "DACL2"};
2a6f5c58 350
2f423577
PU		 351static const unsigned int twl4030_predriver_values[] =
352 {0x0, 0x1, 0x2, 0x4};
353
cb1ace04 354static const struct soc_enum twl4030_predriver_enum =
2f423577 355 SOC_VALUE_ENUM_SINGLE(TWL4030_REG_PREDR_CTL, 1, 0x7,
2a6f5c58 356 ARRAY_SIZE(twl4030_predriver_texts),
2f423577
PU		 357 twl4030_predriver_texts,
358 twl4030_predriver_values);
2a6f5c58
PU		 359
360static const struct snd_kcontrol_new twl4030_dapm_predriver_control =
2f423577 361SOC_DAPM_VALUE_ENUM("Route", twl4030_predriver_enum);
2a6f5c58 362
dfad21a2
PU		 363/* Headset Left */
364static const char *twl4030_hsol_texts[] =
365 {"Off", "DACL1", "DACL2"};
366
367static const struct soc_enum twl4030_hsol_enum =
368 SOC_ENUM_SINGLE(TWL4030_REG_HS_SEL, 1,
369 ARRAY_SIZE(twl4030_hsol_texts),
370 twl4030_hsol_texts);
371
372static const struct snd_kcontrol_new twl4030_dapm_hsol_control =
373SOC_DAPM_ENUM("Route", twl4030_hsol_enum);
374
375/* Headset Right */
376static const char *twl4030_hsor_texts[] =
377 {"Off", "DACR1", "DACR2"};
378
379static const struct soc_enum twl4030_hsor_enum =
380 SOC_ENUM_SINGLE(TWL4030_REG_HS_SEL, 4,
381 ARRAY_SIZE(twl4030_hsor_texts),
382 twl4030_hsor_texts);
383
384static const struct snd_kcontrol_new twl4030_dapm_hsor_control =
385SOC_DAPM_ENUM("Route", twl4030_hsor_enum);
386
5152d8c2
PU		 387/* Carkit Left */
388static const char *twl4030_carkitl_texts[] =
389 {"Off", "DACL1", "DACL2"};
390
391static const struct soc_enum twl4030_carkitl_enum =
392 SOC_ENUM_SINGLE(TWL4030_REG_PRECKL_CTL, 1,
393 ARRAY_SIZE(twl4030_carkitl_texts),
394 twl4030_carkitl_texts);
395
396static const struct snd_kcontrol_new twl4030_dapm_carkitl_control =
397SOC_DAPM_ENUM("Route", twl4030_carkitl_enum);
398
399/* Carkit Right */
400static const char *twl4030_carkitr_texts[] =
401 {"Off", "DACR1", "DACR2"};
402
403static const struct soc_enum twl4030_carkitr_enum =
404 SOC_ENUM_SINGLE(TWL4030_REG_PRECKR_CTL, 1,
405 ARRAY_SIZE(twl4030_carkitr_texts),
406 twl4030_carkitr_texts);
407
408static const struct snd_kcontrol_new twl4030_dapm_carkitr_control =
409SOC_DAPM_ENUM("Route", twl4030_carkitr_enum);
410
df339804
PU		 411/* Handsfree Left */
412static const char *twl4030_handsfreel_texts[] =
413 {"Voice", "DACL1", "DACL2", "DACR2"};
414
415static const struct soc_enum twl4030_handsfreel_enum =
416 SOC_ENUM_SINGLE(TWL4030_REG_HFL_CTL, 0,
417 ARRAY_SIZE(twl4030_handsfreel_texts),
418 twl4030_handsfreel_texts);
419
420static const struct snd_kcontrol_new twl4030_dapm_handsfreel_control =
421SOC_DAPM_ENUM("Route", twl4030_handsfreel_enum);
422
423/* Handsfree Right */
424static const char *twl4030_handsfreer_texts[] =
425 {"Voice", "DACR1", "DACR2", "DACL2"};
426
427static const struct soc_enum twl4030_handsfreer_enum =
428 SOC_ENUM_SINGLE(TWL4030_REG_HFR_CTL, 0,
429 ARRAY_SIZE(twl4030_handsfreer_texts),
430 twl4030_handsfreer_texts);
431
432static const struct snd_kcontrol_new twl4030_dapm_handsfreer_control =
433SOC_DAPM_ENUM("Route", twl4030_handsfreer_enum);
434
276c6222
PU		 435/* Left analog microphone selection */
436static const char *twl4030_analoglmic_texts[] =
2f423577
PU		 437 {"Off", "Main mic", "Headset mic", "AUXL", "Carkit mic"};
438
439static const unsigned int twl4030_analoglmic_values[] =
440 {0x0, 0x1, 0x2, 0x4, 0x8};
276c6222 441
cb1ace04 442static const struct soc_enum twl4030_analoglmic_enum =
2f423577 443 SOC_VALUE_ENUM_SINGLE(TWL4030_REG_ANAMICL, 0, 0xf,
276c6222 444 ARRAY_SIZE(twl4030_analoglmic_texts),
2f423577
PU		 445 twl4030_analoglmic_texts,
446 twl4030_analoglmic_values);
276c6222
PU		 447
448static const struct snd_kcontrol_new twl4030_dapm_analoglmic_control =
2f423577 449SOC_DAPM_VALUE_ENUM("Route", twl4030_analoglmic_enum);
276c6222
PU		 450
451/* Right analog microphone selection */
452static const char *twl4030_analogrmic_texts[] =
2f423577 453 {"Off", "Sub mic", "AUXR"};
276c6222 454
2f423577
PU		 455static const unsigned int twl4030_analogrmic_values[] =
456 {0x0, 0x1, 0x4};
457
cb1ace04 458static const struct soc_enum twl4030_analogrmic_enum =
2f423577 459 SOC_VALUE_ENUM_SINGLE(TWL4030_REG_ANAMICR, 0, 0x5,
276c6222 460 ARRAY_SIZE(twl4030_analogrmic_texts),
2f423577
PU		 461 twl4030_analogrmic_texts,
462 twl4030_analogrmic_values);
276c6222
PU		 463
464static const struct snd_kcontrol_new twl4030_dapm_analogrmic_control =
2f423577 465SOC_DAPM_VALUE_ENUM("Route", twl4030_analogrmic_enum);
276c6222
PU		 466
467/* TX1 L/R Analog/Digital microphone selection */
468static const char *twl4030_micpathtx1_texts[] =
469 {"Analog", "Digimic0"};
470
471static const struct soc_enum twl4030_micpathtx1_enum =
472 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 0,
473 ARRAY_SIZE(twl4030_micpathtx1_texts),
474 twl4030_micpathtx1_texts);
475
476static const struct snd_kcontrol_new twl4030_dapm_micpathtx1_control =
477SOC_DAPM_ENUM("Route", twl4030_micpathtx1_enum);
478
479/* TX2 L/R Analog/Digital microphone selection */
480static const char *twl4030_micpathtx2_texts[] =
481 {"Analog", "Digimic1"};
482
483static const struct soc_enum twl4030_micpathtx2_enum =
484 SOC_ENUM_SINGLE(TWL4030_REG_ADCMICSEL, 2,
485 ARRAY_SIZE(twl4030_micpathtx2_texts),
486 twl4030_micpathtx2_texts);
487
488static const struct snd_kcontrol_new twl4030_dapm_micpathtx2_control =
489SOC_DAPM_ENUM("Route", twl4030_micpathtx2_enum);
490
7393958f
PU		 491/* Analog bypass for AudioR1 */
492static const struct snd_kcontrol_new twl4030_dapm_abypassr1_control =
493 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR1_APGA_CTL, 2, 1, 0);
494
495/* Analog bypass for AudioL1 */
496static const struct snd_kcontrol_new twl4030_dapm_abypassl1_control =
497 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL1_APGA_CTL, 2, 1, 0);
498
499/* Analog bypass for AudioR2 */
500static const struct snd_kcontrol_new twl4030_dapm_abypassr2_control =
501 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXR2_APGA_CTL, 2, 1, 0);
502
503/* Analog bypass for AudioL2 */
504static const struct snd_kcontrol_new twl4030_dapm_abypassl2_control =
505 SOC_DAPM_SINGLE("Switch", TWL4030_REG_ARXL2_APGA_CTL, 2, 1, 0);
506
6bab83fd
PU		 507/* Digital bypass gain, 0 mutes the bypass */
508static const unsigned int twl4030_dapm_dbypass_tlv[] = {
509 TLV_DB_RANGE_HEAD(2),
510 0, 3, TLV_DB_SCALE_ITEM(-2400, 0, 1),
511 4, 7, TLV_DB_SCALE_ITEM(-1800, 600, 0),
512};
513
514/* Digital bypass left (TX1L -> RX2L) */
515static const struct snd_kcontrol_new twl4030_dapm_dbypassl_control =
516 SOC_DAPM_SINGLE_TLV("Volume",
517 TWL4030_REG_ATX2ARXPGA, 3, 7, 0,
518 twl4030_dapm_dbypass_tlv);
519
520/* Digital bypass right (TX1R -> RX2R) */
521static const struct snd_kcontrol_new twl4030_dapm_dbypassr_control =
522 SOC_DAPM_SINGLE_TLV("Volume",
523 TWL4030_REG_ATX2ARXPGA, 0, 7, 0,
524 twl4030_dapm_dbypass_tlv);
525
276c6222
PU		 526static int micpath_event(struct snd_soc_dapm_widget *w,
527 struct snd_kcontrol *kcontrol, int event)
528{
529 struct soc_enum *e = (struct soc_enum *)w->kcontrols->private_value;
530 unsigned char adcmicsel, micbias_ctl;
531
532 adcmicsel = twl4030_read_reg_cache(w->codec, TWL4030_REG_ADCMICSEL);
533 micbias_ctl = twl4030_read_reg_cache(w->codec, TWL4030_REG_MICBIAS_CTL);
534 /* Prepare the bits for the given TX path:
535 * shift_l == 0: TX1 microphone path
536 * shift_l == 2: TX2 microphone path */
537 if (e->shift_l) {
538 /* TX2 microphone path */
539 if (adcmicsel & TWL4030_TX2IN_SEL)
540 micbias_ctl |= TWL4030_MICBIAS2_CTL; /* digimic */
541 else
542 micbias_ctl &= ~TWL4030_MICBIAS2_CTL;
543 } else {
544 /* TX1 microphone path */
545 if (adcmicsel & TWL4030_TX1IN_SEL)
546 micbias_ctl |= TWL4030_MICBIAS1_CTL; /* digimic */
547 else
548 micbias_ctl &= ~TWL4030_MICBIAS1_CTL;
549 }
550
551 twl4030_write(w->codec, TWL4030_REG_MICBIAS_CTL, micbias_ctl);
552
553 return 0;
554}
555
49d92c7d
SM		 556static int handsfree_event(struct snd_soc_dapm_widget *w,
557 struct snd_kcontrol *kcontrol, int event)
558{
559 struct soc_enum *e = (struct soc_enum *)w->kcontrols->private_value;
560 unsigned char hs_ctl;
561
562 hs_ctl = twl4030_read_reg_cache(w->codec, e->reg);
563
564 if (hs_ctl & TWL4030_HF_CTL_REF_EN) {
565 hs_ctl |= TWL4030_HF_CTL_RAMP_EN;
566 twl4030_write(w->codec, e->reg, hs_ctl);
567 hs_ctl |= TWL4030_HF_CTL_LOOP_EN;
568 twl4030_write(w->codec, e->reg, hs_ctl);
569 hs_ctl |= TWL4030_HF_CTL_HB_EN;
570 twl4030_write(w->codec, e->reg, hs_ctl);
571 } else {
572 hs_ctl &= ~(TWL4030_HF_CTL_RAMP_EN | TWL4030_HF_CTL_LOOP_EN
573 | TWL4030_HF_CTL_HB_EN);
574 twl4030_write(w->codec, e->reg, hs_ctl);
575 }
576
577 return 0;
578}
579
aad749e5
PU		 580static int headsetl_event(struct snd_soc_dapm_widget *w,
581 struct snd_kcontrol *kcontrol, int event)
582{
583 unsigned char hs_gain, hs_pop;
584
585 /* Save the current volume */
586 hs_gain = twl4030_read_reg_cache(w->codec, TWL4030_REG_HS_GAIN_SET);
89492be8 587 hs_pop = twl4030_read_reg_cache(w->codec, TWL4030_REG_HS_POPN_SET);
aad749e5
PU		 588
589 switch (event) {
590 case SND_SOC_DAPM_POST_PMU:
591 /* Do the anti-pop/bias ramp enable according to the TRM */
aad749e5
PU		 592 hs_pop |= TWL4030_VMID_EN;
593 twl4030_write(w->codec, TWL4030_REG_HS_POPN_SET, hs_pop);
594 /* Is this needed? Can we just use whatever gain here? */
595 twl4030_write(w->codec, TWL4030_REG_HS_GAIN_SET,
596 (hs_gain & (~0x0f)) | 0x0a);
597 hs_pop |= TWL4030_RAMP_EN;
598 twl4030_write(w->codec, TWL4030_REG_HS_POPN_SET, hs_pop);
599
600 /* Restore the original volume */
601 twl4030_write(w->codec, TWL4030_REG_HS_GAIN_SET, hs_gain);
602 break;
603 case SND_SOC_DAPM_POST_PMD:
604 /* Do the anti-pop/bias ramp disable according to the TRM */
aad749e5
PU		 605 hs_pop &= ~TWL4030_RAMP_EN;
606 twl4030_write(w->codec, TWL4030_REG_HS_POPN_SET, hs_pop);
607 /* Bypass the reg_cache to mute the headset */
608 twl4030_i2c_write_u8(TWL4030_MODULE_AUDIO_VOICE,
609 hs_gain & (~0x0f),
610 TWL4030_REG_HS_GAIN_SET);
611 hs_pop &= ~TWL4030_VMID_EN;
612 twl4030_write(w->codec, TWL4030_REG_HS_POPN_SET, hs_pop);
613 break;
614 }
615 return 0;
616}
617
7393958f
PU		 618static int bypass_event(struct snd_soc_dapm_widget *w,
619 struct snd_kcontrol *kcontrol, int event)
620{
621 struct soc_mixer_control *m =
622 (struct soc_mixer_control *)w->kcontrols->private_value;
623 struct twl4030_priv *twl4030 = w->codec->private_data;
624 unsigned char reg;
625
626 reg = twl4030_read_reg_cache(w->codec, m->reg);
6bab83fd
PU		 627
628 if (m->reg <= TWL4030_REG_ARXR2_APGA_CTL) {
629 /* Analog bypass */
630 if (reg & (1 << m->shift))
631 twl4030->bypass_state |=
632 (1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
633 else
634 twl4030->bypass_state &=
635 ~(1 << (m->reg - TWL4030_REG_ARXL1_APGA_CTL));
636 } else {
637 /* Digital bypass */
638 if (reg & (0x7 << m->shift))
639 twl4030->bypass_state |= (1 << (m->shift ? 5 : 4));
640 else
641 twl4030->bypass_state &= ~(1 << (m->shift ? 5 : 4));
642 }
7393958f
PU		 643
644 if (w->codec->bias_level == SND_SOC_BIAS_STANDBY) {
645 if (twl4030->bypass_state)
646 twl4030_codec_mute(w->codec, 0);
647 else
648 twl4030_codec_mute(w->codec, 1);
649 }
650 return 0;
651}
652
b0bd53a7
PU		 653/*
654 * Some of the gain controls in TWL (mostly those which are associated with
655 * the outputs) are implemented in an interesting way:
656 * 0x0 : Power down (mute)
657 * 0x1 : 6dB
658 * 0x2 : 0 dB
659 * 0x3 : -6 dB
660 * Inverting not going to help with these.
661 * Custom volsw and volsw_2r get/put functions to handle these gain bits.
662 */
663#define SOC_DOUBLE_TLV_TWL4030(xname, xreg, shift_left, shift_right, xmax,\
664 xinvert, tlv_array) \
665{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
666 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
667 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
668 .tlv.p = (tlv_array), \
669 .info = snd_soc_info_volsw, \
670 .get = snd_soc_get_volsw_twl4030, \
671 .put = snd_soc_put_volsw_twl4030, \
672 .private_value = (unsigned long)&(struct soc_mixer_control) \
673 {.reg = xreg, .shift = shift_left, .rshift = shift_right,\
674 .max = xmax, .invert = xinvert} }
675#define SOC_DOUBLE_R_TLV_TWL4030(xname, reg_left, reg_right, xshift, xmax,\
676 xinvert, tlv_array) \
677{ .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = (xname),\
678 .access = SNDRV_CTL_ELEM_ACCESS_TLV_READ |\
679 SNDRV_CTL_ELEM_ACCESS_READWRITE,\
680 .tlv.p = (tlv_array), \
681 .info = snd_soc_info_volsw_2r, \
682 .get = snd_soc_get_volsw_r2_twl4030,\
683 .put = snd_soc_put_volsw_r2_twl4030, \
684 .private_value = (unsigned long)&(struct soc_mixer_control) \
685 {.reg = reg_left, .rreg = reg_right, .shift = xshift, \
64089b84 686 .rshift = xshift, .max = xmax, .invert = xinvert} }
b0bd53a7
PU		 687#define SOC_SINGLE_TLV_TWL4030(xname, xreg, xshift, xmax, xinvert, tlv_array) \
688 SOC_DOUBLE_TLV_TWL4030(xname, xreg, xshift, xshift, xmax, \
689 xinvert, tlv_array)
690
691static int snd_soc_get_volsw_twl4030(struct snd_kcontrol *kcontrol,
692 struct snd_ctl_elem_value *ucontrol)
693{
694 struct soc_mixer_control *mc =
695 (struct soc_mixer_control *)kcontrol->private_value;
696 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
697 unsigned int reg = mc->reg;
698 unsigned int shift = mc->shift;
699 unsigned int rshift = mc->rshift;
700 int max = mc->max;
701 int mask = (1 << fls(max)) - 1;
702
703 ucontrol->value.integer.value[0] =
704 (snd_soc_read(codec, reg) >> shift) & mask;
705 if (ucontrol->value.integer.value[0])
706 ucontrol->value.integer.value[0] =
707 max + 1 - ucontrol->value.integer.value[0];
708
709 if (shift != rshift) {
710 ucontrol->value.integer.value[1] =
711 (snd_soc_read(codec, reg) >> rshift) & mask;
712 if (ucontrol->value.integer.value[1])
713 ucontrol->value.integer.value[1] =
714 max + 1 - ucontrol->value.integer.value[1];
715 }
716
717 return 0;
718}
719
720static int snd_soc_put_volsw_twl4030(struct snd_kcontrol *kcontrol,
721 struct snd_ctl_elem_value *ucontrol)
722{
723 struct soc_mixer_control *mc =
724 (struct soc_mixer_control *)kcontrol->private_value;
725 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
726 unsigned int reg = mc->reg;
727 unsigned int shift = mc->shift;
728 unsigned int rshift = mc->rshift;
729 int max = mc->max;
730 int mask = (1 << fls(max)) - 1;
731 unsigned short val, val2, val_mask;
732
733 val = (ucontrol->value.integer.value[0] & mask);
734
735 val_mask = mask << shift;
736 if (val)
737 val = max + 1 - val;
738 val = val << shift;
739 if (shift != rshift) {
740 val2 = (ucontrol->value.integer.value[1] & mask);
741 val_mask |= mask << rshift;
742 if (val2)
743 val2 = max + 1 - val2;
744 val |= val2 << rshift;
745 }
746 return snd_soc_update_bits(codec, reg, val_mask, val);
747}
748
749static int snd_soc_get_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
750 struct snd_ctl_elem_value *ucontrol)
751{
752 struct soc_mixer_control *mc =
753 (struct soc_mixer_control *)kcontrol->private_value;
754 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
755 unsigned int reg = mc->reg;
756 unsigned int reg2 = mc->rreg;
757 unsigned int shift = mc->shift;
758 int max = mc->max;
759 int mask = (1<<fls(max))-1;
760
761 ucontrol->value.integer.value[0] =
762 (snd_soc_read(codec, reg) >> shift) & mask;
763 ucontrol->value.integer.value[1] =
764 (snd_soc_read(codec, reg2) >> shift) & mask;
765
766 if (ucontrol->value.integer.value[0])
767 ucontrol->value.integer.value[0] =
768 max + 1 - ucontrol->value.integer.value[0];
769 if (ucontrol->value.integer.value[1])
770 ucontrol->value.integer.value[1] =
771 max + 1 - ucontrol->value.integer.value[1];
772
773 return 0;
774}
775
776static int snd_soc_put_volsw_r2_twl4030(struct snd_kcontrol *kcontrol,
777 struct snd_ctl_elem_value *ucontrol)
778{
779 struct soc_mixer_control *mc =
780 (struct soc_mixer_control *)kcontrol->private_value;
781 struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol);
782 unsigned int reg = mc->reg;
783 unsigned int reg2 = mc->rreg;
784 unsigned int shift = mc->shift;
785 int max = mc->max;
786 int mask = (1 << fls(max)) - 1;
787 int err;
788 unsigned short val, val2, val_mask;
789
790 val_mask = mask << shift;
791 val = (ucontrol->value.integer.value[0] & mask);
792 val2 = (ucontrol->value.integer.value[1] & mask);
793
794 if (val)
795 val = max + 1 - val;
796 if (val2)
797 val2 = max + 1 - val2;
798
799 val = val << shift;
800 val2 = val2 << shift;
801
802 err = snd_soc_update_bits(codec, reg, val_mask, val);
803 if (err < 0)
804 return err;
805
806 err = snd_soc_update_bits(codec, reg2, val_mask, val2);
807 return err;
808}
809
c10b82cf
PU		 810/*
811 * FGAIN volume control:
812 * from -62 to 0 dB in 1 dB steps (mute instead of -63 dB)
813 */
d889a72c 814static DECLARE_TLV_DB_SCALE(digital_fine_tlv, -6300, 100, 1);
c10b82cf 815
0d33ea0b
PU		 816/*
817 * CGAIN volume control:
818 * 0 dB to 12 dB in 6 dB steps
819 * value 2 and 3 means 12 dB
820 */
d889a72c
PU		 821static DECLARE_TLV_DB_SCALE(digital_coarse_tlv, 0, 600, 0);
822
823/*
824 * Analog playback gain
825 * -24 dB to 12 dB in 2 dB steps
826 */
827static DECLARE_TLV_DB_SCALE(analog_tlv, -2400, 200, 0);
0d33ea0b 828
4290239c
PU		 829/*
830 * Gain controls tied to outputs
831 * -6 dB to 6 dB in 6 dB steps (mute instead of -12)
832 */
833static DECLARE_TLV_DB_SCALE(output_tvl, -1200, 600, 1);
834
381a22b5
PU		 835/*
836 * Capture gain after the ADCs
837 * from 0 dB to 31 dB in 1 dB steps
838 */
839static DECLARE_TLV_DB_SCALE(digital_capture_tlv, 0, 100, 0);
840
5920b453
GI		 841/*
842 * Gain control for input amplifiers
843 * 0 dB to 30 dB in 6 dB steps
844 */
845static DECLARE_TLV_DB_SCALE(input_gain_tlv, 0, 600, 0);
846
89492be8
PU		 847static const char *twl4030_rampdelay_texts[] = {
848 "27/20/14 ms", "55/40/27 ms", "109/81/55 ms", "218/161/109 ms",
849 "437/323/218 ms", "874/645/437 ms", "1748/1291/874 ms",
850 "3495/2581/1748 ms"
851};
852
853static const struct soc_enum twl4030_rampdelay_enum =
854 SOC_ENUM_SINGLE(TWL4030_REG_HS_POPN_SET, 2,
855 ARRAY_SIZE(twl4030_rampdelay_texts),
856 twl4030_rampdelay_texts);
857
cc17557e 858static const struct snd_kcontrol_new twl4030_snd_controls[] = {
d889a72c
PU		 859 /* Common playback gain controls */
860 SOC_DOUBLE_R_TLV("DAC1 Digital Fine Playback Volume",
861 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
862 0, 0x3f, 0, digital_fine_tlv),
863 SOC_DOUBLE_R_TLV("DAC2 Digital Fine Playback Volume",
864 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
865 0, 0x3f, 0, digital_fine_tlv),
866
867 SOC_DOUBLE_R_TLV("DAC1 Digital Coarse Playback Volume",
868 TWL4030_REG_ARXL1PGA, TWL4030_REG_ARXR1PGA,
869 6, 0x2, 0, digital_coarse_tlv),
870 SOC_DOUBLE_R_TLV("DAC2 Digital Coarse Playback Volume",
871 TWL4030_REG_ARXL2PGA, TWL4030_REG_ARXR2PGA,
872 6, 0x2, 0, digital_coarse_tlv),
873
874 SOC_DOUBLE_R_TLV("DAC1 Analog Playback Volume",
875 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
876 3, 0x12, 1, analog_tlv),
877 SOC_DOUBLE_R_TLV("DAC2 Analog Playback Volume",
878 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
879 3, 0x12, 1, analog_tlv),
44c55870
PU		 880 SOC_DOUBLE_R("DAC1 Analog Playback Switch",
881 TWL4030_REG_ARXL1_APGA_CTL, TWL4030_REG_ARXR1_APGA_CTL,
882 1, 1, 0),
883 SOC_DOUBLE_R("DAC2 Analog Playback Switch",
884 TWL4030_REG_ARXL2_APGA_CTL, TWL4030_REG_ARXR2_APGA_CTL,
885 1, 1, 0),
381a22b5 886
4290239c
PU		 887 /* Separate output gain controls */
888 SOC_DOUBLE_R_TLV_TWL4030("PreDriv Playback Volume",
889 TWL4030_REG_PREDL_CTL, TWL4030_REG_PREDR_CTL,
890 4, 3, 0, output_tvl),
891
892 SOC_DOUBLE_TLV_TWL4030("Headset Playback Volume",
893 TWL4030_REG_HS_GAIN_SET, 0, 2, 3, 0, output_tvl),
894
895 SOC_DOUBLE_R_TLV_TWL4030("Carkit Playback Volume",
896 TWL4030_REG_PRECKL_CTL, TWL4030_REG_PRECKR_CTL,
897 4, 3, 0, output_tvl),
898
899 SOC_SINGLE_TLV_TWL4030("Earpiece Playback Volume",
900 TWL4030_REG_EAR_CTL, 4, 3, 0, output_tvl),
901
381a22b5 902 /* Common capture gain controls */
276c6222 903 SOC_DOUBLE_R_TLV("TX1 Digital Capture Volume",
381a22b5
PU		 904 TWL4030_REG_ATXL1PGA, TWL4030_REG_ATXR1PGA,
905 0, 0x1f, 0, digital_capture_tlv),
276c6222
PU		 906 SOC_DOUBLE_R_TLV("TX2 Digital Capture Volume",
907 TWL4030_REG_AVTXL2PGA, TWL4030_REG_AVTXR2PGA,
908 0, 0x1f, 0, digital_capture_tlv),
5920b453 909
276c6222 910 SOC_DOUBLE_TLV("Analog Capture Volume", TWL4030_REG_ANAMIC_GAIN,
5920b453 911 0, 3, 5, 0, input_gain_tlv),
89492be8
PU		 912
913 SOC_ENUM("HS ramp delay", twl4030_rampdelay_enum),
cc17557e
SS		 914};
915
cc17557e 916static const struct snd_soc_dapm_widget twl4030_dapm_widgets[] = {
276c6222
PU		 917 /* Left channel inputs */
918 SND_SOC_DAPM_INPUT("MAINMIC"),
919 SND_SOC_DAPM_INPUT("HSMIC"),
920 SND_SOC_DAPM_INPUT("AUXL"),
921 SND_SOC_DAPM_INPUT("CARKITMIC"),
922 /* Right channel inputs */
923 SND_SOC_DAPM_INPUT("SUBMIC"),
924 SND_SOC_DAPM_INPUT("AUXR"),
925 /* Digital microphones (Stereo) */
926 SND_SOC_DAPM_INPUT("DIGIMIC0"),
927 SND_SOC_DAPM_INPUT("DIGIMIC1"),
928
929 /* Outputs */
cc17557e
SS		 930 SND_SOC_DAPM_OUTPUT("OUTL"),
931 SND_SOC_DAPM_OUTPUT("OUTR"),
5e98a464 932 SND_SOC_DAPM_OUTPUT("EARPIECE"),
2a6f5c58
PU		 933 SND_SOC_DAPM_OUTPUT("PREDRIVEL"),
934 SND_SOC_DAPM_OUTPUT("PREDRIVER"),
dfad21a2
PU		 935 SND_SOC_DAPM_OUTPUT("HSOL"),
936 SND_SOC_DAPM_OUTPUT("HSOR"),
6a1bee4a
PU		 937 SND_SOC_DAPM_OUTPUT("CARKITL"),
938 SND_SOC_DAPM_OUTPUT("CARKITR"),
df339804
PU		 939 SND_SOC_DAPM_OUTPUT("HFL"),
940 SND_SOC_DAPM_OUTPUT("HFR"),
cc17557e 941
53b5047d 942 /* DACs */
1e5fa31f 943 SND_SOC_DAPM_DAC("DAC Right1", "Right Front Playback",
7393958f 944 SND_SOC_NOPM, 0, 0),
1e5fa31f 945 SND_SOC_DAPM_DAC("DAC Left1", "Left Front Playback",
7393958f 946 SND_SOC_NOPM, 0, 0),
1e5fa31f 947 SND_SOC_DAPM_DAC("DAC Right2", "Right Rear Playback",
7393958f 948 SND_SOC_NOPM, 0, 0),
1e5fa31f 949 SND_SOC_DAPM_DAC("DAC Left2", "Left Rear Playback",
7393958f 950 SND_SOC_NOPM, 0, 0),
cc17557e 951
44c55870
PU		 952 /* Analog PGAs */
953 SND_SOC_DAPM_PGA("ARXR1_APGA", TWL4030_REG_ARXR1_APGA_CTL,
954 0, 0, NULL, 0),
955 SND_SOC_DAPM_PGA("ARXL1_APGA", TWL4030_REG_ARXL1_APGA_CTL,
956 0, 0, NULL, 0),
957 SND_SOC_DAPM_PGA("ARXR2_APGA", TWL4030_REG_ARXR2_APGA_CTL,
958 0, 0, NULL, 0),
959 SND_SOC_DAPM_PGA("ARXL2_APGA", TWL4030_REG_ARXL2_APGA_CTL,
960 0, 0, NULL, 0),
961
7393958f
PU		 962 /* Analog bypasses */
963 SND_SOC_DAPM_SWITCH_E("Right1 Analog Loopback", SND_SOC_NOPM, 0, 0,
964 &twl4030_dapm_abypassr1_control, bypass_event,
965 SND_SOC_DAPM_POST_REG),
966 SND_SOC_DAPM_SWITCH_E("Left1 Analog Loopback", SND_SOC_NOPM, 0, 0,
967 &twl4030_dapm_abypassl1_control,
968 bypass_event, SND_SOC_DAPM_POST_REG),
969 SND_SOC_DAPM_SWITCH_E("Right2 Analog Loopback", SND_SOC_NOPM, 0, 0,
970 &twl4030_dapm_abypassr2_control,
971 bypass_event, SND_SOC_DAPM_POST_REG),
972 SND_SOC_DAPM_SWITCH_E("Left2 Analog Loopback", SND_SOC_NOPM, 0, 0,
973 &twl4030_dapm_abypassl2_control,
974 bypass_event, SND_SOC_DAPM_POST_REG),
975
6bab83fd
PU		 976 /* Digital bypasses */
977 SND_SOC_DAPM_SWITCH_E("Left Digital Loopback", SND_SOC_NOPM, 0, 0,
978 &twl4030_dapm_dbypassl_control, bypass_event,
979 SND_SOC_DAPM_POST_REG),
980 SND_SOC_DAPM_SWITCH_E("Right Digital Loopback", SND_SOC_NOPM, 0, 0,
981 &twl4030_dapm_dbypassr_control, bypass_event,
982 SND_SOC_DAPM_POST_REG),
983
7393958f
PU		 984 SND_SOC_DAPM_MIXER("Analog R1 Playback Mixer", TWL4030_REG_AVDAC_CTL,
985 0, 0, NULL, 0),
986 SND_SOC_DAPM_MIXER("Analog L1 Playback Mixer", TWL4030_REG_AVDAC_CTL,
987 1, 0, NULL, 0),
988 SND_SOC_DAPM_MIXER("Analog R2 Playback Mixer", TWL4030_REG_AVDAC_CTL,
989 2, 0, NULL, 0),
990 SND_SOC_DAPM_MIXER("Analog L2 Playback Mixer", TWL4030_REG_AVDAC_CTL,
991 3, 0, NULL, 0),
992
5e98a464
PU		 993 /* Output MUX controls */
994 /* Earpiece */
2f423577
PU		 995 SND_SOC_DAPM_VALUE_MUX("Earpiece Mux", SND_SOC_NOPM, 0, 0,
996 &twl4030_dapm_earpiece_control),
2a6f5c58 997 /* PreDrivL/R */
2f423577
PU		 998 SND_SOC_DAPM_VALUE_MUX("PredriveL Mux", SND_SOC_NOPM, 0, 0,
999 &twl4030_dapm_predrivel_control),
1000 SND_SOC_DAPM_VALUE_MUX("PredriveR Mux", SND_SOC_NOPM, 0, 0,
1001 &twl4030_dapm_predriver_control),
dfad21a2 1002 /* HeadsetL/R */
aad749e5
PU		 1003 SND_SOC_DAPM_MUX_E("HeadsetL Mux", SND_SOC_NOPM, 0, 0,
1004 &twl4030_dapm_hsol_control, headsetl_event,
1005 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
dfad21a2
PU		 1006 SND_SOC_DAPM_MUX("HeadsetR Mux", SND_SOC_NOPM, 0, 0,
1007 &twl4030_dapm_hsor_control),
5152d8c2
PU		 1008 /* CarkitL/R */
1009 SND_SOC_DAPM_MUX("CarkitL Mux", SND_SOC_NOPM, 0, 0,
1010 &twl4030_dapm_carkitl_control),
1011 SND_SOC_DAPM_MUX("CarkitR Mux", SND_SOC_NOPM, 0, 0,
1012 &twl4030_dapm_carkitr_control),
df339804 1013 /* HandsfreeL/R */
49d92c7d
SM		 1014 SND_SOC_DAPM_MUX_E("HandsfreeL Mux", TWL4030_REG_HFL_CTL, 5, 0,
1015 &twl4030_dapm_handsfreel_control, handsfree_event,
1016 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
1017 SND_SOC_DAPM_MUX_E("HandsfreeR Mux", TWL4030_REG_HFR_CTL, 5, 0,
1018 &twl4030_dapm_handsfreer_control, handsfree_event,
1019 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD),
5e98a464 1020
276c6222
PU		 1021 /* Introducing four virtual ADC, since TWL4030 have four channel for
1022 capture */
1023 SND_SOC_DAPM_ADC("ADC Virtual Left1", "Left Front Capture",
1024 SND_SOC_NOPM, 0, 0),
1025 SND_SOC_DAPM_ADC("ADC Virtual Right1", "Right Front Capture",
1026 SND_SOC_NOPM, 0, 0),
1027 SND_SOC_DAPM_ADC("ADC Virtual Left2", "Left Rear Capture",
1028 SND_SOC_NOPM, 0, 0),
1029 SND_SOC_DAPM_ADC("ADC Virtual Right2", "Right Rear Capture",
1030 SND_SOC_NOPM, 0, 0),
1031
1032 /* Analog/Digital mic path selection.
1033 TX1 Left/Right: either analog Left/Right or Digimic0
1034 TX2 Left/Right: either analog Left/Right or Digimic1 */
1035 SND_SOC_DAPM_MUX_E("TX1 Capture Route", SND_SOC_NOPM, 0, 0,
1036 &twl4030_dapm_micpathtx1_control, micpath_event,
1037 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1038 SND_SOC_DAPM_POST_REG),
1039 SND_SOC_DAPM_MUX_E("TX2 Capture Route", SND_SOC_NOPM, 0, 0,
1040 &twl4030_dapm_micpathtx2_control, micpath_event,
1041 SND_SOC_DAPM_POST_PMU|SND_SOC_DAPM_POST_PMD|
1042 SND_SOC_DAPM_POST_REG),
1043
fb2a2f84 1044 /* Analog input muxes with switch for the capture amplifiers */
2f423577 1045 SND_SOC_DAPM_VALUE_MUX("Analog Left Capture Route",
fb2a2f84 1046 TWL4030_REG_ANAMICL, 4, 0, &twl4030_dapm_analoglmic_control),
2f423577 1047 SND_SOC_DAPM_VALUE_MUX("Analog Right Capture Route",
fb2a2f84 1048 TWL4030_REG_ANAMICR, 4, 0, &twl4030_dapm_analogrmic_control),
276c6222 1049
fb2a2f84
PU		 1050 SND_SOC_DAPM_PGA("ADC Physical Left",
1051 TWL4030_REG_AVADC_CTL, 3, 0, NULL, 0),
1052 SND_SOC_DAPM_PGA("ADC Physical Right",
1053 TWL4030_REG_AVADC_CTL, 1, 0, NULL, 0),
276c6222
PU		 1054
1055 SND_SOC_DAPM_PGA("Digimic0 Enable",
1056 TWL4030_REG_ADCMICSEL, 1, 0, NULL, 0),
1057 SND_SOC_DAPM_PGA("Digimic1 Enable",
1058 TWL4030_REG_ADCMICSEL, 3, 0, NULL, 0),
1059
1060 SND_SOC_DAPM_MICBIAS("Mic Bias 1", TWL4030_REG_MICBIAS_CTL, 0, 0),
1061 SND_SOC_DAPM_MICBIAS("Mic Bias 2", TWL4030_REG_MICBIAS_CTL, 1, 0),
1062 SND_SOC_DAPM_MICBIAS("Headset Mic Bias", TWL4030_REG_MICBIAS_CTL, 2, 0),
7393958f 1063
cc17557e
SS		 1064};
1065
1066static const struct snd_soc_dapm_route intercon[] = {
7393958f
PU		 1067 {"Analog L1 Playback Mixer", NULL, "DAC Left1"},
1068 {"Analog R1 Playback Mixer", NULL, "DAC Right1"},
1069 {"Analog L2 Playback Mixer", NULL, "DAC Left2"},
1070 {"Analog R2 Playback Mixer", NULL, "DAC Right2"},
1071
1072 {"ARXL1_APGA", NULL, "Analog L1 Playback Mixer"},
1073 {"ARXR1_APGA", NULL, "Analog R1 Playback Mixer"},
1074 {"ARXL2_APGA", NULL, "Analog L2 Playback Mixer"},
1075 {"ARXR2_APGA", NULL, "Analog R2 Playback Mixer"},
44c55870 1076
5e98a464
PU		 1077 /* Internal playback routings */
1078 /* Earpiece */
1079 {"Earpiece Mux", "DACL1", "ARXL1_APGA"},
1080 {"Earpiece Mux", "DACL2", "ARXL2_APGA"},
1081 {"Earpiece Mux", "DACR1", "ARXR1_APGA"},
2a6f5c58
PU		 1082 /* PreDrivL */
1083 {"PredriveL Mux", "DACL1", "ARXL1_APGA"},
1084 {"PredriveL Mux", "DACL2", "ARXL2_APGA"},
1085 {"PredriveL Mux", "DACR2", "ARXR2_APGA"},
1086 /* PreDrivR */
1087 {"PredriveR Mux", "DACR1", "ARXR1_APGA"},
1088 {"PredriveR Mux", "DACR2", "ARXR2_APGA"},
1089 {"PredriveR Mux", "DACL2", "ARXL2_APGA"},
dfad21a2
PU		 1090 /* HeadsetL */
1091 {"HeadsetL Mux", "DACL1", "ARXL1_APGA"},
1092 {"HeadsetL Mux", "DACL2", "ARXL2_APGA"},
1093 /* HeadsetR */
1094 {"HeadsetR Mux", "DACR1", "ARXR1_APGA"},
1095 {"HeadsetR Mux", "DACR2", "ARXR2_APGA"},
5152d8c2
PU		 1096 /* CarkitL */
1097 {"CarkitL Mux", "DACL1", "ARXL1_APGA"},
1098 {"CarkitL Mux", "DACL2", "ARXL2_APGA"},
1099 /* CarkitR */
1100 {"CarkitR Mux", "DACR1", "ARXR1_APGA"},
1101 {"CarkitR Mux", "DACR2", "ARXR2_APGA"},
df339804
PU		 1102 /* HandsfreeL */
1103 {"HandsfreeL Mux", "DACL1", "ARXL1_APGA"},
1104 {"HandsfreeL Mux", "DACL2", "ARXL2_APGA"},
1105 {"HandsfreeL Mux", "DACR2", "ARXR2_APGA"},
1106 /* HandsfreeR */
1107 {"HandsfreeR Mux", "DACR1", "ARXR1_APGA"},
1108 {"HandsfreeR Mux", "DACR2", "ARXR2_APGA"},
1109 {"HandsfreeR Mux", "DACL2", "ARXL2_APGA"},
5e98a464 1110
cc17557e 1111 /* outputs */
44c55870
PU		 1112 {"OUTL", NULL, "ARXL2_APGA"},
1113 {"OUTR", NULL, "ARXR2_APGA"},
5e98a464 1114 {"EARPIECE", NULL, "Earpiece Mux"},
2a6f5c58
PU		 1115 {"PREDRIVEL", NULL, "PredriveL Mux"},
1116 {"PREDRIVER", NULL, "PredriveR Mux"},
dfad21a2
PU		 1117 {"HSOL", NULL, "HeadsetL Mux"},
1118 {"HSOR", NULL, "HeadsetR Mux"},
5152d8c2
PU		 1119 {"CARKITL", NULL, "CarkitL Mux"},
1120 {"CARKITR", NULL, "CarkitR Mux"},
df339804
PU		 1121 {"HFL", NULL, "HandsfreeL Mux"},
1122 {"HFR", NULL, "HandsfreeR Mux"},
cc17557e 1123
276c6222
PU		 1124 /* Capture path */
1125 {"Analog Left Capture Route", "Main mic", "MAINMIC"},
1126 {"Analog Left Capture Route", "Headset mic", "HSMIC"},
1127 {"Analog Left Capture Route", "AUXL", "AUXL"},
1128 {"Analog Left Capture Route", "Carkit mic", "CARKITMIC"},
1129
1130 {"Analog Right Capture Route", "Sub mic", "SUBMIC"},
1131 {"Analog Right Capture Route", "AUXR", "AUXR"},
1132
fb2a2f84
PU		 1133 {"ADC Physical Left", NULL, "Analog Left Capture Route"},
1134 {"ADC Physical Right", NULL, "Analog Right Capture Route"},
276c6222
PU		 1135
1136 {"Digimic0 Enable", NULL, "DIGIMIC0"},
1137 {"Digimic1 Enable", NULL, "DIGIMIC1"},
1138
1139 /* TX1 Left capture path */
fb2a2f84 1140 {"TX1 Capture Route", "Analog", "ADC Physical Left"},
276c6222
PU		 1141 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1142 /* TX1 Right capture path */
fb2a2f84 1143 {"TX1 Capture Route", "Analog", "ADC Physical Right"},
276c6222
PU		 1144 {"TX1 Capture Route", "Digimic0", "Digimic0 Enable"},
1145 /* TX2 Left capture path */
fb2a2f84 1146 {"TX2 Capture Route", "Analog", "ADC Physical Left"},
276c6222
PU		 1147 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1148 /* TX2 Right capture path */
fb2a2f84 1149 {"TX2 Capture Route", "Analog", "ADC Physical Right"},
276c6222
PU		 1150 {"TX2 Capture Route", "Digimic1", "Digimic1 Enable"},
1151
1152 {"ADC Virtual Left1", NULL, "TX1 Capture Route"},
1153 {"ADC Virtual Right1", NULL, "TX1 Capture Route"},
1154 {"ADC Virtual Left2", NULL, "TX2 Capture Route"},
1155 {"ADC Virtual Right2", NULL, "TX2 Capture Route"},
1156
7393958f
PU		 1157 /* Analog bypass routes */
1158 {"Right1 Analog Loopback", "Switch", "Analog Right Capture Route"},
1159 {"Left1 Analog Loopback", "Switch", "Analog Left Capture Route"},
1160 {"Right2 Analog Loopback", "Switch", "Analog Right Capture Route"},
1161 {"Left2 Analog Loopback", "Switch", "Analog Left Capture Route"},
1162
1163 {"Analog R1 Playback Mixer", NULL, "Right1 Analog Loopback"},
1164 {"Analog L1 Playback Mixer", NULL, "Left1 Analog Loopback"},
1165 {"Analog R2 Playback Mixer", NULL, "Right2 Analog Loopback"},
1166 {"Analog L2 Playback Mixer", NULL, "Left2 Analog Loopback"},
1167
6bab83fd
PU		 1168 /* Digital bypass routes */
1169 {"Right Digital Loopback", "Volume", "TX1 Capture Route"},
1170 {"Left Digital Loopback", "Volume", "TX1 Capture Route"},
1171
1172 {"Analog R2 Playback Mixer", NULL, "Right Digital Loopback"},
1173 {"Analog L2 Playback Mixer", NULL, "Left Digital Loopback"},
1174
cc17557e
SS		 1175};
1176
1177static int twl4030_add_widgets(struct snd_soc_codec *codec)
1178{
1179 snd_soc_dapm_new_controls(codec, twl4030_dapm_widgets,
1180 ARRAY_SIZE(twl4030_dapm_widgets));
1181
1182 snd_soc_dapm_add_routes(codec, intercon, ARRAY_SIZE(intercon));
1183
1184 snd_soc_dapm_new_widgets(codec);
1185 return 0;
1186}
1187
cc17557e
SS		 1188static int twl4030_set_bias_level(struct snd_soc_codec *codec,
1189 enum snd_soc_bias_level level)
1190{
7393958f
PU		 1191 struct twl4030_priv *twl4030 = codec->private_data;
1192
cc17557e
SS		 1193 switch (level) {
1194 case SND_SOC_BIAS_ON:
7393958f 1195 twl4030_codec_mute(codec, 0);
cc17557e
SS		 1196 break;
1197 case SND_SOC_BIAS_PREPARE:
7393958f
PU		 1198 twl4030_power_up(codec);
1199 if (twl4030->bypass_state)
1200 twl4030_codec_mute(codec, 0);
1201 else
1202 twl4030_codec_mute(codec, 1);
cc17557e
SS		 1203 break;
1204 case SND_SOC_BIAS_STANDBY:
7393958f
PU		 1205 twl4030_power_up(codec);
1206 if (twl4030->bypass_state)
1207 twl4030_codec_mute(codec, 0);
1208 else
1209 twl4030_codec_mute(codec, 1);
cc17557e
SS		 1210 break;
1211 case SND_SOC_BIAS_OFF:
1212 twl4030_power_down(codec);
1213 break;
1214 }
1215 codec->bias_level = level;
1216
1217 return 0;
1218}
1219
1220static int twl4030_hw_params(struct snd_pcm_substream *substream,
dee89c4d
MB		 1221 struct snd_pcm_hw_params *params,
1222 struct snd_soc_dai *dai)
cc17557e
SS		 1223{
1224 struct snd_soc_pcm_runtime *rtd = substream->private_data;
1225 struct snd_soc_device *socdev = rtd->socdev;
6627a653 1226 struct snd_soc_codec *codec = socdev->card->codec;
cc17557e
SS		 1227 u8 mode, old_mode, format, old_format;
1228
cc17557e
SS		 1229 /* bit rate */
1230 old_mode = twl4030_read_reg_cache(codec,
1231 TWL4030_REG_CODEC_MODE) & ~TWL4030_CODECPDZ;
1232 mode = old_mode & ~TWL4030_APLL_RATE;
1233
1234 switch (params_rate(params)) {
1235 case 8000:
1236 mode |= TWL4030_APLL_RATE_8000;
1237 break;
1238 case 11025:
1239 mode |= TWL4030_APLL_RATE_11025;
1240 break;
1241 case 12000:
1242 mode |= TWL4030_APLL_RATE_12000;
1243 break;
1244 case 16000:
1245 mode |= TWL4030_APLL_RATE_16000;
1246 break;
1247 case 22050:
1248 mode |= TWL4030_APLL_RATE_22050;
1249 break;
1250 case 24000:
1251 mode |= TWL4030_APLL_RATE_24000;
1252 break;
1253 case 32000:
1254 mode |= TWL4030_APLL_RATE_32000;
1255 break;
1256 case 44100:
1257 mode |= TWL4030_APLL_RATE_44100;
1258 break;
1259 case 48000:
1260 mode |= TWL4030_APLL_RATE_48000;
1261 break;
1262 default:
1263 printk(KERN_ERR "TWL4030 hw params: unknown rate %d\n",
1264 params_rate(params));
1265 return -EINVAL;
1266 }
1267
1268 if (mode != old_mode) {
1269 /* change rate and set CODECPDZ */
7393958f 1270 twl4030_codec_enable(codec, 0);
cc17557e 1271 twl4030_write(codec, TWL4030_REG_CODEC_MODE, mode);
db04e2c5 1272 twl4030_codec_enable(codec, 1);
cc17557e
SS		 1273 }
1274
1275 /* sample size */
1276 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1277 format = old_format;
1278 format &= ~TWL4030_DATA_WIDTH;
1279 switch (params_format(params)) {
1280 case SNDRV_PCM_FORMAT_S16_LE:
1281 format |= TWL4030_DATA_WIDTH_16S_16W;
1282 break;
1283 case SNDRV_PCM_FORMAT_S24_LE:
1284 format |= TWL4030_DATA_WIDTH_32S_24W;
1285 break;
1286 default:
1287 printk(KERN_ERR "TWL4030 hw params: unknown format %d\n",
1288 params_format(params));
1289 return -EINVAL;
1290 }
1291
1292 if (format != old_format) {
1293
1294 /* clear CODECPDZ before changing format (codec requirement) */
db04e2c5 1295 twl4030_codec_enable(codec, 0);
cc17557e
SS		 1296
1297 /* change format */
1298 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1299
1300 /* set CODECPDZ afterwards */
db04e2c5 1301 twl4030_codec_enable(codec, 1);
cc17557e
SS		 1302 }
1303 return 0;
1304}
1305
1306static int twl4030_set_dai_sysclk(struct snd_soc_dai *codec_dai,
1307 int clk_id, unsigned int freq, int dir)
1308{
1309 struct snd_soc_codec *codec = codec_dai->codec;
1310 u8 infreq;
1311
1312 switch (freq) {
1313 case 19200000:
1314 infreq = TWL4030_APLL_INFREQ_19200KHZ;
1315 break;
1316 case 26000000:
1317 infreq = TWL4030_APLL_INFREQ_26000KHZ;
1318 break;
1319 case 38400000:
1320 infreq = TWL4030_APLL_INFREQ_38400KHZ;
1321 break;
1322 default:
1323 printk(KERN_ERR "TWL4030 set sysclk: unknown rate %d\n",
1324 freq);
1325 return -EINVAL;
1326 }
1327
1328 infreq |= TWL4030_APLL_EN;
1329 twl4030_write(codec, TWL4030_REG_APLL_CTL, infreq);
1330
1331 return 0;
1332}
1333
1334static int twl4030_set_dai_fmt(struct snd_soc_dai *codec_dai,
1335 unsigned int fmt)
1336{
1337 struct snd_soc_codec *codec = codec_dai->codec;
1338 u8 old_format, format;
1339
1340 /* get format */
1341 old_format = twl4030_read_reg_cache(codec, TWL4030_REG_AUDIO_IF);
1342 format = old_format;
1343
1344 /* set master/slave audio interface */
1345 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1346 case SND_SOC_DAIFMT_CBM_CFM:
1347 format &= ~(TWL4030_AIF_SLAVE_EN);
e18c94d2 1348 format &= ~(TWL4030_CLK256FS_EN);
cc17557e
SS		 1349 break;
1350 case SND_SOC_DAIFMT_CBS_CFS:
cc17557e 1351 format |= TWL4030_AIF_SLAVE_EN;
e18c94d2 1352 format |= TWL4030_CLK256FS_EN;
cc17557e
SS		 1353 break;
1354 default:
1355 return -EINVAL;
1356 }
1357
1358 /* interface format */
1359 format &= ~TWL4030_AIF_FORMAT;
1360 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1361 case SND_SOC_DAIFMT_I2S:
1362 format |= TWL4030_AIF_FORMAT_CODEC;
1363 break;
1364 default:
1365 return -EINVAL;
1366 }
1367
1368 if (format != old_format) {
1369
1370 /* clear CODECPDZ before changing format (codec requirement) */
db04e2c5 1371 twl4030_codec_enable(codec, 0);
cc17557e
SS		 1372
1373 /* change format */
1374 twl4030_write(codec, TWL4030_REG_AUDIO_IF, format);
1375
1376 /* set CODECPDZ afterwards */
db04e2c5 1377 twl4030_codec_enable(codec, 1);
cc17557e
SS		 1378 }
1379
1380 return 0;
1381}
1382
bbba9444 1383#define TWL4030_RATES (SNDRV_PCM_RATE_8000_48000)
cc17557e
SS		 1384#define TWL4030_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FORMAT_S24_LE)
1385
10d9e3d9
JS		 1386static struct snd_soc_dai_ops twl4030_dai_ops = {
1387 .hw_params = twl4030_hw_params,
1388 .set_sysclk = twl4030_set_dai_sysclk,
1389 .set_fmt = twl4030_set_dai_fmt,
1390};
1391
cc17557e
SS		 1392struct snd_soc_dai twl4030_dai = {
1393 .name = "twl4030",
1394 .playback = {
1395 .stream_name = "Playback",
1396 .channels_min = 2,
1397 .channels_max = 2,
31ad0f31 1398 .rates = TWL4030_RATES | SNDRV_PCM_RATE_96000,
cc17557e
SS		 1399 .formats = TWL4030_FORMATS,},
1400 .capture = {
1401 .stream_name = "Capture",
1402 .channels_min = 2,
1403 .channels_max = 2,
1404 .rates = TWL4030_RATES,
1405 .formats = TWL4030_FORMATS,},
10d9e3d9 1406 .ops = &twl4030_dai_ops,
cc17557e
SS		 1407};
1408EXPORT_SYMBOL_GPL(twl4030_dai);
1409
1410static int twl4030_suspend(struct platform_device *pdev, pm_message_t state)
1411{
1412 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 1413 struct snd_soc_codec *codec = socdev->card->codec;
cc17557e
SS		 1414
1415 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
1416
1417 return 0;
1418}
1419
1420static int twl4030_resume(struct platform_device *pdev)
1421{
1422 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 1423 struct snd_soc_codec *codec = socdev->card->codec;
cc17557e
SS		 1424
1425 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1426 twl4030_set_bias_level(codec, codec->suspend_bias_level);
1427 return 0;
1428}
1429
1430/*
1431 * initialize the driver
1432 * register the mixer and dsp interfaces with the kernel
1433 */
1434
1435static int twl4030_init(struct snd_soc_device *socdev)
1436{
6627a653 1437 struct snd_soc_codec *codec = socdev->card->codec;
cc17557e
SS		 1438 int ret = 0;
1439
1440 printk(KERN_INFO "TWL4030 Audio Codec init \n");
1441
1442 codec->name = "twl4030";
1443 codec->owner = THIS_MODULE;
1444 codec->read = twl4030_read_reg_cache;
1445 codec->write = twl4030_write;
1446 codec->set_bias_level = twl4030_set_bias_level;
1447 codec->dai = &twl4030_dai;
1448 codec->num_dai = 1;
1449 codec->reg_cache_size = sizeof(twl4030_reg);
1450 codec->reg_cache = kmemdup(twl4030_reg, sizeof(twl4030_reg),
1451 GFP_KERNEL);
1452 if (codec->reg_cache == NULL)
1453 return -ENOMEM;
1454
1455 /* register pcms */
1456 ret = snd_soc_new_pcms(socdev, SNDRV_DEFAULT_IDX1, SNDRV_DEFAULT_STR1);
1457 if (ret < 0) {
1458 printk(KERN_ERR "twl4030: failed to create pcms\n");
1459 goto pcm_err;
1460 }
1461
1462 twl4030_init_chip(codec);
1463
1464 /* power on device */
1465 twl4030_set_bias_level(codec, SND_SOC_BIAS_STANDBY);
1466
3e8e1952
IM		 1467 snd_soc_add_controls(codec, twl4030_snd_controls,
1468 ARRAY_SIZE(twl4030_snd_controls));
cc17557e
SS		 1469 twl4030_add_widgets(codec);
1470
968a6025 1471 ret = snd_soc_init_card(socdev);
cc17557e
SS		 1472 if (ret < 0) {
1473 printk(KERN_ERR "twl4030: failed to register card\n");
1474 goto card_err;
1475 }
1476
1477 return ret;
1478
1479card_err:
1480 snd_soc_free_pcms(socdev);
1481 snd_soc_dapm_free(socdev);
1482pcm_err:
1483 kfree(codec->reg_cache);
1484 return ret;
1485}
1486
1487static struct snd_soc_device *twl4030_socdev;
1488
1489static int twl4030_probe(struct platform_device *pdev)
1490{
1491 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
1492 struct snd_soc_codec *codec;
7393958f 1493 struct twl4030_priv *twl4030;
cc17557e
SS		 1494
1495 codec = kzalloc(sizeof(struct snd_soc_codec), GFP_KERNEL);
1496 if (codec == NULL)
1497 return -ENOMEM;
1498
7393958f
PU		 1499 twl4030 = kzalloc(sizeof(struct twl4030_priv), GFP_KERNEL);
1500 if (twl4030 == NULL) {
1501 kfree(codec);
1502 return -ENOMEM;
1503 }
1504
1505 codec->private_data = twl4030;
6627a653 1506 socdev->card->codec = codec;
cc17557e
SS		 1507 mutex_init(&codec->mutex);
1508 INIT_LIST_HEAD(&codec->dapm_widgets);
1509 INIT_LIST_HEAD(&codec->dapm_paths);
1510
1511 twl4030_socdev = socdev;
1512 twl4030_init(socdev);
1513
1514 return 0;
1515}
1516
1517static int twl4030_remove(struct platform_device *pdev)
1518{
1519 struct snd_soc_device *socdev = platform_get_drvdata(pdev);
6627a653 1520 struct snd_soc_codec *codec = socdev->card->codec;
cc17557e
SS		 1521
1522 printk(KERN_INFO "TWL4030 Audio Codec remove\n");
7393958f 1523 twl4030_set_bias_level(codec, SND_SOC_BIAS_OFF);
c6d1662b
PU		 1524 snd_soc_free_pcms(socdev);
1525 snd_soc_dapm_free(socdev);
7393958f 1526 kfree(codec->private_data);
cc17557e
SS		 1527 kfree(codec);
1528
1529 return 0;
1530}
1531
1532struct snd_soc_codec_device soc_codec_dev_twl4030 = {
1533 .probe = twl4030_probe,
1534 .remove = twl4030_remove,
1535 .suspend = twl4030_suspend,
1536 .resume = twl4030_resume,
1537};
1538EXPORT_SYMBOL_GPL(soc_codec_dev_twl4030);
1539
24e07db8 1540static int __init twl4030_modinit(void)
64089b84
MB		 1541{
1542 return snd_soc_register_dai(&twl4030_dai);
1543}
24e07db8 1544module_init(twl4030_modinit);
64089b84
MB		 1545
1546static void __exit twl4030_exit(void)
1547{
1548 snd_soc_unregister_dai(&twl4030_dai);
1549}
1550module_exit(twl4030_exit);
1551
cc17557e
SS		 1552MODULE_DESCRIPTION("ASoC TWL4030 codec driver");
1553MODULE_AUTHOR("Steve Sakoman");
1554MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.109971 seconds and 5 git commands to generate.