2 * ALSA SoC TWL6040 codec driver
4 * Author: Misael Lopez Cruz <x0052729@ti.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/platform_device.h>
28 #include <linux/slab.h>
29 #include <linux/mfd/twl6040.h>
31 #include <sound/core.h>
32 #include <sound/pcm.h>
33 #include <sound/pcm_params.h>
34 #include <sound/soc.h>
35 #include <sound/soc-dapm.h>
36 #include <sound/initval.h>
37 #include <sound/tlv.h>
42 TWL6040_DAI_LEGACY
= 0,
49 #define TWL6040_RATES SNDRV_PCM_RATE_8000_96000
50 #define TWL6040_FORMATS (SNDRV_PCM_FMTBIT_S32_LE)
52 #define TWL6040_OUTHS_0dB 0x00
53 #define TWL6040_OUTHS_M30dB 0x0F
54 #define TWL6040_OUTHF_0dB 0x03
55 #define TWL6040_OUTHF_M52dB 0x1D
57 /* Shadow register used by the driver */
58 #define TWL6040_REG_SW_SHADOW 0x2F
59 #define TWL6040_CACHEREGNUM (TWL6040_REG_SW_SHADOW + 1)
61 /* TWL6040_REG_SW_SHADOW (0x2F) fields */
62 #define TWL6040_EAR_PATH_ENABLE 0x01
64 struct twl6040_jack_data
{
65 struct snd_soc_jack
*jack
;
66 struct delayed_work work
;
70 /* codec private data */
77 int hs_power_mode_locked
;
80 struct twl6040_jack_data hs_jack
;
81 struct snd_soc_codec
*codec
;
86 * twl6040 register cache & default register settings
88 static const u8 twl6040_reg
[TWL6040_CACHEREGNUM
] = {
89 0x00, /* not used 0x00 */
90 0x4B, /* REG_ASICID 0x01 (ro) */
91 0x00, /* REG_ASICREV 0x02 (ro) */
92 0x00, /* REG_INTID 0x03 */
93 0x00, /* REG_INTMR 0x04 */
94 0x00, /* REG_NCPCTRL 0x05 */
95 0x00, /* REG_LDOCTL 0x06 */
96 0x60, /* REG_HPPLLCTL 0x07 */
97 0x00, /* REG_LPPLLCTL 0x08 */
98 0x4A, /* REG_LPPLLDIV 0x09 */
99 0x00, /* REG_AMICBCTL 0x0A */
100 0x00, /* REG_DMICBCTL 0x0B */
101 0x00, /* REG_MICLCTL 0x0C */
102 0x00, /* REG_MICRCTL 0x0D */
103 0x00, /* REG_MICGAIN 0x0E */
104 0x1B, /* REG_LINEGAIN 0x0F */
105 0x00, /* REG_HSLCTL 0x10 */
106 0x00, /* REG_HSRCTL 0x11 */
107 0x00, /* REG_HSGAIN 0x12 */
108 0x00, /* REG_EARCTL 0x13 */
109 0x00, /* REG_HFLCTL 0x14 */
110 0x00, /* REG_HFLGAIN 0x15 */
111 0x00, /* REG_HFRCTL 0x16 */
112 0x00, /* REG_HFRGAIN 0x17 */
113 0x00, /* REG_VIBCTLL 0x18 */
114 0x00, /* REG_VIBDATL 0x19 */
115 0x00, /* REG_VIBCTLR 0x1A */
116 0x00, /* REG_VIBDATR 0x1B */
117 0x00, /* REG_HKCTL1 0x1C */
118 0x00, /* REG_HKCTL2 0x1D */
119 0x00, /* REG_GPOCTL 0x1E */
120 0x00, /* REG_ALB 0x1F */
121 0x00, /* REG_DLB 0x20 */
122 0x00, /* not used 0x21 */
123 0x00, /* not used 0x22 */
124 0x00, /* not used 0x23 */
125 0x00, /* not used 0x24 */
126 0x00, /* not used 0x25 */
127 0x00, /* not used 0x26 */
128 0x00, /* not used 0x27 */
129 0x00, /* REG_TRIM1 0x28 */
130 0x00, /* REG_TRIM2 0x29 */
131 0x00, /* REG_TRIM3 0x2A */
132 0x00, /* REG_HSOTRIM 0x2B */
133 0x00, /* REG_HFOTRIM 0x2C */
134 0x09, /* REG_ACCCTL 0x2D */
135 0x00, /* REG_STATUS 0x2E (ro) */
137 0x00, /* REG_SW_SHADOW 0x2F - Shadow, non HW register */
140 /* List of registers to be restored after power up */
141 static const int twl6040_restore_list
[] = {
145 TWL6040_REG_LINEGAIN
,
156 /* set of rates for each pll: low-power and high-performance */
157 static unsigned int lp_rates
[] = {
169 static unsigned int hp_rates
[] = {
177 static struct snd_pcm_hw_constraint_list sysclk_constraints
[] = {
178 { .count
= ARRAY_SIZE(lp_rates
), .list
= lp_rates
, },
179 { .count
= ARRAY_SIZE(hp_rates
), .list
= hp_rates
, },
183 * read twl6040 register cache
185 static inline unsigned int twl6040_read_reg_cache(struct snd_soc_codec
*codec
,
188 u8
*cache
= codec
->reg_cache
;
190 if (reg
>= TWL6040_CACHEREGNUM
)
197 * write twl6040 register cache
199 static inline void twl6040_write_reg_cache(struct snd_soc_codec
*codec
,
202 u8
*cache
= codec
->reg_cache
;
204 if (reg
>= TWL6040_CACHEREGNUM
)
210 * read from twl6040 hardware register
212 static int twl6040_read_reg_volatile(struct snd_soc_codec
*codec
,
215 struct twl6040
*twl6040
= codec
->control_data
;
218 if (reg
>= TWL6040_CACHEREGNUM
)
221 if (likely(reg
< TWL6040_REG_SW_SHADOW
)) {
222 value
= twl6040_reg_read(twl6040
, reg
);
223 twl6040_write_reg_cache(codec
, reg
, value
);
225 value
= twl6040_read_reg_cache(codec
, reg
);
232 * write to the twl6040 register space
234 static int twl6040_write(struct snd_soc_codec
*codec
,
235 unsigned int reg
, unsigned int value
)
237 struct twl6040
*twl6040
= codec
->control_data
;
239 if (reg
>= TWL6040_CACHEREGNUM
)
242 twl6040_write_reg_cache(codec
, reg
, value
);
243 if (likely(reg
< TWL6040_REG_SW_SHADOW
))
244 return twl6040_reg_write(twl6040
, reg
, value
);
249 static void twl6040_init_chip(struct snd_soc_codec
*codec
)
251 struct twl6040
*twl6040
= codec
->control_data
;
254 /* Update reg_cache: ASICREV, and TRIM values */
255 val
= twl6040_get_revid(twl6040
);
256 twl6040_write_reg_cache(codec
, TWL6040_REG_ASICREV
, val
);
258 twl6040_read_reg_volatile(codec
, TWL6040_REG_TRIM1
);
259 twl6040_read_reg_volatile(codec
, TWL6040_REG_TRIM2
);
260 twl6040_read_reg_volatile(codec
, TWL6040_REG_TRIM3
);
261 twl6040_read_reg_volatile(codec
, TWL6040_REG_HSOTRIM
);
262 twl6040_read_reg_volatile(codec
, TWL6040_REG_HFOTRIM
);
264 /* Change chip defaults */
265 /* No imput selected for microphone amplifiers */
266 twl6040_write_reg_cache(codec
, TWL6040_REG_MICLCTL
, 0x18);
267 twl6040_write_reg_cache(codec
, TWL6040_REG_MICRCTL
, 0x18);
270 * We need to lower the default gain values, so the ramp code
271 * can work correctly for the first playback.
272 * This reduces the pop noise heard at the first playback.
274 twl6040_write_reg_cache(codec
, TWL6040_REG_HSGAIN
, 0xff);
275 twl6040_write_reg_cache(codec
, TWL6040_REG_EARCTL
, 0x1e);
276 twl6040_write_reg_cache(codec
, TWL6040_REG_HFLGAIN
, 0x1d);
277 twl6040_write_reg_cache(codec
, TWL6040_REG_HFRGAIN
, 0x1d);
278 twl6040_write_reg_cache(codec
, TWL6040_REG_LINEGAIN
, 0);
281 static void twl6040_restore_regs(struct snd_soc_codec
*codec
)
283 u8
*cache
= codec
->reg_cache
;
286 for (i
= 0; i
< ARRAY_SIZE(twl6040_restore_list
); i
++) {
287 reg
= twl6040_restore_list
[i
];
288 twl6040_write(codec
, reg
, cache
[reg
]);
292 /* set headset dac and driver power mode */
293 static int headset_power_mode(struct snd_soc_codec
*codec
, int high_perf
)
296 int mask
= TWL6040_HSDRVMODE
| TWL6040_HSDACMODE
;
298 hslctl
= twl6040_read_reg_cache(codec
, TWL6040_REG_HSLCTL
);
299 hsrctl
= twl6040_read_reg_cache(codec
, TWL6040_REG_HSRCTL
);
309 twl6040_write(codec
, TWL6040_REG_HSLCTL
, hslctl
);
310 twl6040_write(codec
, TWL6040_REG_HSRCTL
, hsrctl
);
315 static int twl6040_hs_dac_event(struct snd_soc_dapm_widget
*w
,
316 struct snd_kcontrol
*kcontrol
, int event
)
318 struct snd_soc_codec
*codec
= w
->codec
;
322 * Workaround for Headset DC offset caused pop noise:
323 * Both HS DAC need to be turned on (before the HS driver) and off at
326 hslctl
= twl6040_read_reg_cache(codec
, TWL6040_REG_HSLCTL
);
327 hsrctl
= twl6040_read_reg_cache(codec
, TWL6040_REG_HSRCTL
);
328 if (SND_SOC_DAPM_EVENT_ON(event
)) {
329 hslctl
|= TWL6040_HSDACENA
;
330 hsrctl
|= TWL6040_HSDACENA
;
332 hslctl
&= ~TWL6040_HSDACENA
;
333 hsrctl
&= ~TWL6040_HSDACENA
;
335 twl6040_write(codec
, TWL6040_REG_HSLCTL
, hslctl
);
336 twl6040_write(codec
, TWL6040_REG_HSRCTL
, hsrctl
);
342 static int twl6040_ep_drv_event(struct snd_soc_dapm_widget
*w
,
343 struct snd_kcontrol
*kcontrol
, int event
)
345 struct snd_soc_codec
*codec
= w
->codec
;
346 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
349 if (SND_SOC_DAPM_EVENT_ON(event
)) {
350 /* Earphone doesn't support low power mode */
351 priv
->hs_power_mode_locked
= 1;
352 ret
= headset_power_mode(codec
, 1);
354 priv
->hs_power_mode_locked
= 0;
355 ret
= headset_power_mode(codec
, priv
->hs_power_mode
);
363 static void twl6040_hs_jack_report(struct snd_soc_codec
*codec
,
364 struct snd_soc_jack
*jack
, int report
)
366 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
369 mutex_lock(&priv
->mutex
);
372 status
= twl6040_read_reg_volatile(codec
, TWL6040_REG_STATUS
);
373 if (status
& TWL6040_PLUGCOMP
)
374 snd_soc_jack_report(jack
, report
, report
);
376 snd_soc_jack_report(jack
, 0, report
);
378 mutex_unlock(&priv
->mutex
);
381 void twl6040_hs_jack_detect(struct snd_soc_codec
*codec
,
382 struct snd_soc_jack
*jack
, int report
)
384 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
385 struct twl6040_jack_data
*hs_jack
= &priv
->hs_jack
;
387 hs_jack
->jack
= jack
;
388 hs_jack
->report
= report
;
390 twl6040_hs_jack_report(codec
, hs_jack
->jack
, hs_jack
->report
);
392 EXPORT_SYMBOL_GPL(twl6040_hs_jack_detect
);
394 static void twl6040_accessory_work(struct work_struct
*work
)
396 struct twl6040_data
*priv
= container_of(work
,
397 struct twl6040_data
, hs_jack
.work
.work
);
398 struct snd_soc_codec
*codec
= priv
->codec
;
399 struct twl6040_jack_data
*hs_jack
= &priv
->hs_jack
;
401 twl6040_hs_jack_report(codec
, hs_jack
->jack
, hs_jack
->report
);
404 /* audio interrupt handler */
405 static irqreturn_t
twl6040_audio_handler(int irq
, void *data
)
407 struct snd_soc_codec
*codec
= data
;
408 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
410 schedule_delayed_work(&priv
->hs_jack
.work
, msecs_to_jiffies(200));
415 static int twl6040_soc_dapm_put_vibra_enum(struct snd_kcontrol
*kcontrol
,
416 struct snd_ctl_elem_value
*ucontrol
)
418 struct snd_soc_dapm_widget_list
*wlist
= snd_kcontrol_chip(kcontrol
);
419 struct snd_soc_dapm_widget
*widget
= wlist
->widgets
[0];
420 struct snd_soc_codec
*codec
= widget
->codec
;
421 struct soc_enum
*e
= (struct soc_enum
*)kcontrol
->private_value
;
424 /* Do not allow changes while Input/FF efect is running */
425 val
= twl6040_read_reg_volatile(codec
, e
->reg
);
426 if (val
& TWL6040_VIBENA
&& !(val
& TWL6040_VIBSEL
))
429 return snd_soc_dapm_put_enum_double(kcontrol
, ucontrol
);
433 * MICATT volume control:
434 * from -6 to 0 dB in 6 dB steps
436 static DECLARE_TLV_DB_SCALE(mic_preamp_tlv
, -600, 600, 0);
439 * MICGAIN volume control:
440 * from 6 to 30 dB in 6 dB steps
442 static DECLARE_TLV_DB_SCALE(mic_amp_tlv
, 600, 600, 0);
445 * AFMGAIN volume control:
446 * from -18 to 24 dB in 6 dB steps
448 static DECLARE_TLV_DB_SCALE(afm_amp_tlv
, -1800, 600, 0);
451 * HSGAIN volume control:
452 * from -30 to 0 dB in 2 dB steps
454 static DECLARE_TLV_DB_SCALE(hs_tlv
, -3000, 200, 0);
457 * HFGAIN volume control:
458 * from -52 to 6 dB in 2 dB steps
460 static DECLARE_TLV_DB_SCALE(hf_tlv
, -5200, 200, 0);
463 * EPGAIN volume control:
464 * from -24 to 6 dB in 2 dB steps
466 static DECLARE_TLV_DB_SCALE(ep_tlv
, -2400, 200, 0);
468 /* Left analog microphone selection */
469 static const char *twl6040_amicl_texts
[] =
470 {"Headset Mic", "Main Mic", "Aux/FM Left", "Off"};
472 /* Right analog microphone selection */
473 static const char *twl6040_amicr_texts
[] =
474 {"Headset Mic", "Sub Mic", "Aux/FM Right", "Off"};
476 static const struct soc_enum twl6040_enum
[] = {
477 SOC_ENUM_SINGLE(TWL6040_REG_MICLCTL
, 3, 4, twl6040_amicl_texts
),
478 SOC_ENUM_SINGLE(TWL6040_REG_MICRCTL
, 3, 4, twl6040_amicr_texts
),
481 static const char *twl6040_hs_texts
[] = {
482 "Off", "HS DAC", "Line-In amp"
485 static const struct soc_enum twl6040_hs_enum
[] = {
486 SOC_ENUM_SINGLE(TWL6040_REG_HSLCTL
, 5, ARRAY_SIZE(twl6040_hs_texts
),
488 SOC_ENUM_SINGLE(TWL6040_REG_HSRCTL
, 5, ARRAY_SIZE(twl6040_hs_texts
),
492 static const char *twl6040_hf_texts
[] = {
493 "Off", "HF DAC", "Line-In amp"
496 static const struct soc_enum twl6040_hf_enum
[] = {
497 SOC_ENUM_SINGLE(TWL6040_REG_HFLCTL
, 2, ARRAY_SIZE(twl6040_hf_texts
),
499 SOC_ENUM_SINGLE(TWL6040_REG_HFRCTL
, 2, ARRAY_SIZE(twl6040_hf_texts
),
503 static const char *twl6040_vibrapath_texts
[] = {
504 "Input FF", "Audio PDM"
507 static const struct soc_enum twl6040_vibra_enum
[] = {
508 SOC_ENUM_SINGLE(TWL6040_REG_VIBCTLL
, 1,
509 ARRAY_SIZE(twl6040_vibrapath_texts
),
510 twl6040_vibrapath_texts
),
511 SOC_ENUM_SINGLE(TWL6040_REG_VIBCTLR
, 1,
512 ARRAY_SIZE(twl6040_vibrapath_texts
),
513 twl6040_vibrapath_texts
),
516 static const struct snd_kcontrol_new amicl_control
=
517 SOC_DAPM_ENUM("Route", twl6040_enum
[0]);
519 static const struct snd_kcontrol_new amicr_control
=
520 SOC_DAPM_ENUM("Route", twl6040_enum
[1]);
522 /* Headset DAC playback switches */
523 static const struct snd_kcontrol_new hsl_mux_controls
=
524 SOC_DAPM_ENUM("Route", twl6040_hs_enum
[0]);
526 static const struct snd_kcontrol_new hsr_mux_controls
=
527 SOC_DAPM_ENUM("Route", twl6040_hs_enum
[1]);
529 /* Handsfree DAC playback switches */
530 static const struct snd_kcontrol_new hfl_mux_controls
=
531 SOC_DAPM_ENUM("Route", twl6040_hf_enum
[0]);
533 static const struct snd_kcontrol_new hfr_mux_controls
=
534 SOC_DAPM_ENUM("Route", twl6040_hf_enum
[1]);
536 static const struct snd_kcontrol_new ep_path_enable_control
=
537 SOC_DAPM_SINGLE("Switch", TWL6040_REG_SW_SHADOW
, 0, 1, 0);
539 static const struct snd_kcontrol_new auxl_switch_control
=
540 SOC_DAPM_SINGLE("Switch", TWL6040_REG_HFLCTL
, 6, 1, 0);
542 static const struct snd_kcontrol_new auxr_switch_control
=
543 SOC_DAPM_SINGLE("Switch", TWL6040_REG_HFRCTL
, 6, 1, 0);
545 /* Vibra playback switches */
546 static const struct snd_kcontrol_new vibral_mux_controls
=
547 SOC_DAPM_ENUM_EXT("Route", twl6040_vibra_enum
[0],
548 snd_soc_dapm_get_enum_double
,
549 twl6040_soc_dapm_put_vibra_enum
);
551 static const struct snd_kcontrol_new vibrar_mux_controls
=
552 SOC_DAPM_ENUM_EXT("Route", twl6040_vibra_enum
[1],
553 snd_soc_dapm_get_enum_double
,
554 twl6040_soc_dapm_put_vibra_enum
);
556 /* Headset power mode */
557 static const char *twl6040_power_mode_texts
[] = {
558 "Low-Power", "High-Performance",
561 static const struct soc_enum twl6040_power_mode_enum
=
562 SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(twl6040_power_mode_texts
),
563 twl6040_power_mode_texts
);
565 static int twl6040_headset_power_get_enum(struct snd_kcontrol
*kcontrol
,
566 struct snd_ctl_elem_value
*ucontrol
)
568 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
569 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
571 ucontrol
->value
.enumerated
.item
[0] = priv
->hs_power_mode
;
576 static int twl6040_headset_power_put_enum(struct snd_kcontrol
*kcontrol
,
577 struct snd_ctl_elem_value
*ucontrol
)
579 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
580 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
581 int high_perf
= ucontrol
->value
.enumerated
.item
[0];
584 if (!priv
->hs_power_mode_locked
)
585 ret
= headset_power_mode(codec
, high_perf
);
588 priv
->hs_power_mode
= high_perf
;
593 static int twl6040_pll_get_enum(struct snd_kcontrol
*kcontrol
,
594 struct snd_ctl_elem_value
*ucontrol
)
596 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
597 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
599 ucontrol
->value
.enumerated
.item
[0] = priv
->pll_power_mode
;
604 static int twl6040_pll_put_enum(struct snd_kcontrol
*kcontrol
,
605 struct snd_ctl_elem_value
*ucontrol
)
607 struct snd_soc_codec
*codec
= snd_kcontrol_chip(kcontrol
);
608 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
610 priv
->pll_power_mode
= ucontrol
->value
.enumerated
.item
[0];
615 int twl6040_get_dl1_gain(struct snd_soc_codec
*codec
)
617 struct snd_soc_dapm_context
*dapm
= &codec
->dapm
;
619 if (snd_soc_dapm_get_pin_status(dapm
, "EP"))
620 return -1; /* -1dB */
622 if (snd_soc_dapm_get_pin_status(dapm
, "HSOR") ||
623 snd_soc_dapm_get_pin_status(dapm
, "HSOL")) {
625 u8 val
= snd_soc_read(codec
, TWL6040_REG_HSLCTL
);
626 if (val
& TWL6040_HSDACMODE
)
627 /* HSDACL in LP mode */
628 return -8; /* -8dB */
630 /* HSDACL in HP mode */
631 return -1; /* -1dB */
635 EXPORT_SYMBOL_GPL(twl6040_get_dl1_gain
);
637 int twl6040_get_clk_id(struct snd_soc_codec
*codec
)
639 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
641 return priv
->pll_power_mode
;
643 EXPORT_SYMBOL_GPL(twl6040_get_clk_id
);
645 int twl6040_get_trim_value(struct snd_soc_codec
*codec
, enum twl6040_trim trim
)
647 if (unlikely(trim
>= TWL6040_TRIM_INVAL
))
650 return twl6040_read_reg_cache(codec
, TWL6040_REG_TRIM1
+ trim
);
652 EXPORT_SYMBOL_GPL(twl6040_get_trim_value
);
654 int twl6040_get_hs_step_size(struct snd_soc_codec
*codec
)
656 struct twl6040
*twl6040
= codec
->control_data
;
658 if (twl6040_get_revid(twl6040
) < TWL6040_REV_ES1_3
)
659 /* For ES under ES_1.3 HS step is 2 mV */
662 /* For ES_1.3 HS step is 1 mV */
665 EXPORT_SYMBOL_GPL(twl6040_get_hs_step_size
);
667 static const struct snd_kcontrol_new twl6040_snd_controls
[] = {
669 SOC_DOUBLE_TLV("Capture Preamplifier Volume",
670 TWL6040_REG_MICGAIN
, 6, 7, 1, 1, mic_preamp_tlv
),
671 SOC_DOUBLE_TLV("Capture Volume",
672 TWL6040_REG_MICGAIN
, 0, 3, 4, 0, mic_amp_tlv
),
675 SOC_DOUBLE_TLV("Aux FM Volume",
676 TWL6040_REG_LINEGAIN
, 0, 3, 7, 0, afm_amp_tlv
),
679 SOC_DOUBLE_TLV("Headset Playback Volume",
680 TWL6040_REG_HSGAIN
, 0, 4, 0xF, 1, hs_tlv
),
681 SOC_DOUBLE_R_TLV("Handsfree Playback Volume",
682 TWL6040_REG_HFLGAIN
, TWL6040_REG_HFRGAIN
, 0, 0x1D, 1, hf_tlv
),
683 SOC_SINGLE_TLV("Earphone Playback Volume",
684 TWL6040_REG_EARCTL
, 1, 0xF, 1, ep_tlv
),
686 SOC_ENUM_EXT("Headset Power Mode", twl6040_power_mode_enum
,
687 twl6040_headset_power_get_enum
,
688 twl6040_headset_power_put_enum
),
690 SOC_ENUM_EXT("PLL Selection", twl6040_power_mode_enum
,
691 twl6040_pll_get_enum
, twl6040_pll_put_enum
),
694 static const struct snd_soc_dapm_widget twl6040_dapm_widgets
[] = {
696 SND_SOC_DAPM_INPUT("MAINMIC"),
697 SND_SOC_DAPM_INPUT("HSMIC"),
698 SND_SOC_DAPM_INPUT("SUBMIC"),
699 SND_SOC_DAPM_INPUT("AFML"),
700 SND_SOC_DAPM_INPUT("AFMR"),
703 SND_SOC_DAPM_OUTPUT("HSOL"),
704 SND_SOC_DAPM_OUTPUT("HSOR"),
705 SND_SOC_DAPM_OUTPUT("HFL"),
706 SND_SOC_DAPM_OUTPUT("HFR"),
707 SND_SOC_DAPM_OUTPUT("EP"),
708 SND_SOC_DAPM_OUTPUT("AUXL"),
709 SND_SOC_DAPM_OUTPUT("AUXR"),
710 SND_SOC_DAPM_OUTPUT("VIBRAL"),
711 SND_SOC_DAPM_OUTPUT("VIBRAR"),
713 /* Analog input muxes for the capture amplifiers */
714 SND_SOC_DAPM_MUX("Analog Left Capture Route",
715 SND_SOC_NOPM
, 0, 0, &amicl_control
),
716 SND_SOC_DAPM_MUX("Analog Right Capture Route",
717 SND_SOC_NOPM
, 0, 0, &amicr_control
),
719 /* Analog capture PGAs */
720 SND_SOC_DAPM_PGA("MicAmpL",
721 TWL6040_REG_MICLCTL
, 0, 0, NULL
, 0),
722 SND_SOC_DAPM_PGA("MicAmpR",
723 TWL6040_REG_MICRCTL
, 0, 0, NULL
, 0),
725 /* Auxiliary FM PGAs */
726 SND_SOC_DAPM_PGA("AFMAmpL",
727 TWL6040_REG_MICLCTL
, 1, 0, NULL
, 0),
728 SND_SOC_DAPM_PGA("AFMAmpR",
729 TWL6040_REG_MICRCTL
, 1, 0, NULL
, 0),
732 SND_SOC_DAPM_ADC("ADC Left", NULL
, TWL6040_REG_MICLCTL
, 2, 0),
733 SND_SOC_DAPM_ADC("ADC Right", NULL
, TWL6040_REG_MICRCTL
, 2, 0),
735 /* Microphone bias */
736 SND_SOC_DAPM_SUPPLY("Headset Mic Bias",
737 TWL6040_REG_AMICBCTL
, 0, 0, NULL
, 0),
738 SND_SOC_DAPM_SUPPLY("Main Mic Bias",
739 TWL6040_REG_AMICBCTL
, 4, 0, NULL
, 0),
740 SND_SOC_DAPM_SUPPLY("Digital Mic1 Bias",
741 TWL6040_REG_DMICBCTL
, 0, 0, NULL
, 0),
742 SND_SOC_DAPM_SUPPLY("Digital Mic2 Bias",
743 TWL6040_REG_DMICBCTL
, 4, 0, NULL
, 0),
746 SND_SOC_DAPM_DAC("HSDAC Left", NULL
, SND_SOC_NOPM
, 0, 0),
747 SND_SOC_DAPM_DAC("HSDAC Right", NULL
, SND_SOC_NOPM
, 0, 0),
748 SND_SOC_DAPM_DAC("HFDAC Left", NULL
, TWL6040_REG_HFLCTL
, 0, 0),
749 SND_SOC_DAPM_DAC("HFDAC Right", NULL
, TWL6040_REG_HFRCTL
, 0, 0),
750 /* Virtual DAC for vibra path (DL4 channel) */
751 SND_SOC_DAPM_DAC("VIBRA DAC", NULL
, SND_SOC_NOPM
, 0, 0),
753 SND_SOC_DAPM_MUX("Handsfree Left Playback",
754 SND_SOC_NOPM
, 0, 0, &hfl_mux_controls
),
755 SND_SOC_DAPM_MUX("Handsfree Right Playback",
756 SND_SOC_NOPM
, 0, 0, &hfr_mux_controls
),
757 /* Analog playback Muxes */
758 SND_SOC_DAPM_MUX("Headset Left Playback",
759 SND_SOC_NOPM
, 0, 0, &hsl_mux_controls
),
760 SND_SOC_DAPM_MUX("Headset Right Playback",
761 SND_SOC_NOPM
, 0, 0, &hsr_mux_controls
),
763 SND_SOC_DAPM_MUX("Vibra Left Playback", SND_SOC_NOPM
, 0, 0,
764 &vibral_mux_controls
),
765 SND_SOC_DAPM_MUX("Vibra Right Playback", SND_SOC_NOPM
, 0, 0,
766 &vibrar_mux_controls
),
768 SND_SOC_DAPM_SWITCH("Earphone Playback", SND_SOC_NOPM
, 0, 0,
769 &ep_path_enable_control
),
770 SND_SOC_DAPM_SWITCH("AUXL Playback", SND_SOC_NOPM
, 0, 0,
771 &auxl_switch_control
),
772 SND_SOC_DAPM_SWITCH("AUXR Playback", SND_SOC_NOPM
, 0, 0,
773 &auxr_switch_control
),
775 /* Analog playback drivers */
776 SND_SOC_DAPM_OUT_DRV("HF Left Driver",
777 TWL6040_REG_HFLCTL
, 4, 0, NULL
, 0),
778 SND_SOC_DAPM_OUT_DRV("HF Right Driver",
779 TWL6040_REG_HFRCTL
, 4, 0, NULL
, 0),
780 SND_SOC_DAPM_OUT_DRV("HS Left Driver",
781 TWL6040_REG_HSLCTL
, 2, 0, NULL
, 0),
782 SND_SOC_DAPM_OUT_DRV("HS Right Driver",
783 TWL6040_REG_HSRCTL
, 2, 0, NULL
, 0),
784 SND_SOC_DAPM_OUT_DRV_E("Earphone Driver",
785 TWL6040_REG_EARCTL
, 0, 0, NULL
, 0,
786 twl6040_ep_drv_event
,
787 SND_SOC_DAPM_PRE_PMU
| SND_SOC_DAPM_POST_PMD
),
788 SND_SOC_DAPM_OUT_DRV("Vibra Left Driver",
789 TWL6040_REG_VIBCTLL
, 0, 0, NULL
, 0),
790 SND_SOC_DAPM_OUT_DRV("Vibra Right Driver",
791 TWL6040_REG_VIBCTLR
, 0, 0, NULL
, 0),
793 SND_SOC_DAPM_SUPPLY("Vibra Left Control", TWL6040_REG_VIBCTLL
, 2, 0,
795 SND_SOC_DAPM_SUPPLY("Vibra Right Control", TWL6040_REG_VIBCTLR
, 2, 0,
797 SND_SOC_DAPM_SUPPLY_S("HSDAC Power", 1, SND_SOC_NOPM
, 0, 0,
798 twl6040_hs_dac_event
,
799 SND_SOC_DAPM_POST_PMU
| SND_SOC_DAPM_POST_PMD
),
801 /* Analog playback PGAs */
802 SND_SOC_DAPM_PGA("HF Left PGA",
803 TWL6040_REG_HFLCTL
, 1, 0, NULL
, 0),
804 SND_SOC_DAPM_PGA("HF Right PGA",
805 TWL6040_REG_HFRCTL
, 1, 0, NULL
, 0),
809 static const struct snd_soc_dapm_route intercon
[] = {
810 /* Stream -> DAC mapping */
811 {"HSDAC Left", NULL
, "Legacy Playback"},
812 {"HSDAC Left", NULL
, "Headset Playback"},
813 {"HSDAC Right", NULL
, "Legacy Playback"},
814 {"HSDAC Right", NULL
, "Headset Playback"},
816 {"HFDAC Left", NULL
, "Legacy Playback"},
817 {"HFDAC Left", NULL
, "Handsfree Playback"},
818 {"HFDAC Right", NULL
, "Legacy Playback"},
819 {"HFDAC Right", NULL
, "Handsfree Playback"},
821 {"VIBRA DAC", NULL
, "Legacy Playback"},
822 {"VIBRA DAC", NULL
, "Vibra Playback"},
824 /* ADC -> Stream mapping */
825 {"Legacy Capture" , NULL
, "ADC Left"},
826 {"Capture", NULL
, "ADC Left"},
827 {"Legacy Capture", NULL
, "ADC Right"},
828 {"Capture" , NULL
, "ADC Right"},
831 {"Analog Left Capture Route", "Headset Mic", "HSMIC"},
832 {"Analog Left Capture Route", "Main Mic", "MAINMIC"},
833 {"Analog Left Capture Route", "Aux/FM Left", "AFML"},
835 {"Analog Right Capture Route", "Headset Mic", "HSMIC"},
836 {"Analog Right Capture Route", "Sub Mic", "SUBMIC"},
837 {"Analog Right Capture Route", "Aux/FM Right", "AFMR"},
839 {"MicAmpL", NULL
, "Analog Left Capture Route"},
840 {"MicAmpR", NULL
, "Analog Right Capture Route"},
842 {"ADC Left", NULL
, "MicAmpL"},
843 {"ADC Right", NULL
, "MicAmpR"},
846 {"AFMAmpL", NULL
, "AFML"},
847 {"AFMAmpR", NULL
, "AFMR"},
849 {"HSDAC Left", NULL
, "HSDAC Power"},
850 {"HSDAC Right", NULL
, "HSDAC Power"},
852 {"Headset Left Playback", "HS DAC", "HSDAC Left"},
853 {"Headset Left Playback", "Line-In amp", "AFMAmpL"},
855 {"Headset Right Playback", "HS DAC", "HSDAC Right"},
856 {"Headset Right Playback", "Line-In amp", "AFMAmpR"},
858 {"HS Left Driver", NULL
, "Headset Left Playback"},
859 {"HS Right Driver", NULL
, "Headset Right Playback"},
861 {"HSOL", NULL
, "HS Left Driver"},
862 {"HSOR", NULL
, "HS Right Driver"},
864 /* Earphone playback path */
865 {"Earphone Playback", "Switch", "HSDAC Left"},
866 {"Earphone Driver", NULL
, "Earphone Playback"},
867 {"EP", NULL
, "Earphone Driver"},
869 {"Handsfree Left Playback", "HF DAC", "HFDAC Left"},
870 {"Handsfree Left Playback", "Line-In amp", "AFMAmpL"},
872 {"Handsfree Right Playback", "HF DAC", "HFDAC Right"},
873 {"Handsfree Right Playback", "Line-In amp", "AFMAmpR"},
875 {"HF Left PGA", NULL
, "Handsfree Left Playback"},
876 {"HF Right PGA", NULL
, "Handsfree Right Playback"},
878 {"HF Left Driver", NULL
, "HF Left PGA"},
879 {"HF Right Driver", NULL
, "HF Right PGA"},
881 {"HFL", NULL
, "HF Left Driver"},
882 {"HFR", NULL
, "HF Right Driver"},
884 {"AUXL Playback", "Switch", "HF Left PGA"},
885 {"AUXR Playback", "Switch", "HF Right PGA"},
887 {"AUXL", NULL
, "AUXL Playback"},
888 {"AUXR", NULL
, "AUXR Playback"},
891 {"Vibra Left Playback", "Audio PDM", "VIBRA DAC"},
892 {"Vibra Right Playback", "Audio PDM", "VIBRA DAC"},
894 {"Vibra Left Driver", NULL
, "Vibra Left Playback"},
895 {"Vibra Right Driver", NULL
, "Vibra Right Playback"},
896 {"Vibra Left Driver", NULL
, "Vibra Left Control"},
897 {"Vibra Right Driver", NULL
, "Vibra Right Control"},
899 {"VIBRAL", NULL
, "Vibra Left Driver"},
900 {"VIBRAR", NULL
, "Vibra Right Driver"},
903 static int twl6040_set_bias_level(struct snd_soc_codec
*codec
,
904 enum snd_soc_bias_level level
)
906 struct twl6040
*twl6040
= codec
->control_data
;
907 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
911 case SND_SOC_BIAS_ON
:
913 case SND_SOC_BIAS_PREPARE
:
915 case SND_SOC_BIAS_STANDBY
:
916 if (priv
->codec_powered
)
919 ret
= twl6040_power(twl6040
, 1);
923 priv
->codec_powered
= 1;
925 twl6040_restore_regs(codec
);
927 /* Set external boost GPO */
928 twl6040_write(codec
, TWL6040_REG_GPOCTL
, 0x02);
930 case SND_SOC_BIAS_OFF
:
931 if (!priv
->codec_powered
)
934 twl6040_power(twl6040
, 0);
935 priv
->codec_powered
= 0;
939 codec
->dapm
.bias_level
= level
;
944 static int twl6040_startup(struct snd_pcm_substream
*substream
,
945 struct snd_soc_dai
*dai
)
947 struct snd_soc_codec
*codec
= dai
->codec
;
948 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
950 snd_pcm_hw_constraint_list(substream
->runtime
, 0,
951 SNDRV_PCM_HW_PARAM_RATE
,
952 &sysclk_constraints
[priv
->pll_power_mode
]);
957 static int twl6040_hw_params(struct snd_pcm_substream
*substream
,
958 struct snd_pcm_hw_params
*params
,
959 struct snd_soc_dai
*dai
)
961 struct snd_soc_codec
*codec
= dai
->codec
;
962 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
965 rate
= params_rate(params
);
971 /* These rates are not supported when HPPLL is in use */
972 if (unlikely(priv
->pll
== TWL6040_SYSCLK_SEL_HPPLL
)) {
973 dev_err(codec
->dev
, "HPPLL does not support rate %d\n",
977 priv
->sysclk
= 17640000;
984 priv
->sysclk
= 19200000;
987 dev_err(codec
->dev
, "unsupported rate %d\n", rate
);
994 static int twl6040_prepare(struct snd_pcm_substream
*substream
,
995 struct snd_soc_dai
*dai
)
997 struct snd_soc_codec
*codec
= dai
->codec
;
998 struct twl6040
*twl6040
= codec
->control_data
;
999 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
1002 if (!priv
->sysclk
) {
1004 "no mclk configured, call set_sysclk() on init\n");
1008 ret
= twl6040_set_pll(twl6040
, priv
->pll
, priv
->clk_in
, priv
->sysclk
);
1010 dev_err(codec
->dev
, "Can not set PLL (%d)\n", ret
);
1017 static int twl6040_set_dai_sysclk(struct snd_soc_dai
*codec_dai
,
1018 int clk_id
, unsigned int freq
, int dir
)
1020 struct snd_soc_codec
*codec
= codec_dai
->codec
;
1021 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
1024 case TWL6040_SYSCLK_SEL_LPPLL
:
1025 case TWL6040_SYSCLK_SEL_HPPLL
:
1027 priv
->clk_in
= freq
;
1030 dev_err(codec
->dev
, "unknown clk_id %d\n", clk_id
);
1037 static const struct snd_soc_dai_ops twl6040_dai_ops
= {
1038 .startup
= twl6040_startup
,
1039 .hw_params
= twl6040_hw_params
,
1040 .prepare
= twl6040_prepare
,
1041 .set_sysclk
= twl6040_set_dai_sysclk
,
1044 static struct snd_soc_dai_driver twl6040_dai
[] = {
1046 .name
= "twl6040-legacy",
1047 .id
= TWL6040_DAI_LEGACY
,
1049 .stream_name
= "Legacy Playback",
1052 .rates
= TWL6040_RATES
,
1053 .formats
= TWL6040_FORMATS
,
1056 .stream_name
= "Legacy Capture",
1059 .rates
= TWL6040_RATES
,
1060 .formats
= TWL6040_FORMATS
,
1062 .ops
= &twl6040_dai_ops
,
1065 .name
= "twl6040-ul",
1066 .id
= TWL6040_DAI_UL
,
1068 .stream_name
= "Capture",
1071 .rates
= TWL6040_RATES
,
1072 .formats
= TWL6040_FORMATS
,
1074 .ops
= &twl6040_dai_ops
,
1077 .name
= "twl6040-dl1",
1078 .id
= TWL6040_DAI_DL1
,
1080 .stream_name
= "Headset Playback",
1083 .rates
= TWL6040_RATES
,
1084 .formats
= TWL6040_FORMATS
,
1086 .ops
= &twl6040_dai_ops
,
1089 .name
= "twl6040-dl2",
1090 .id
= TWL6040_DAI_DL2
,
1092 .stream_name
= "Handsfree Playback",
1095 .rates
= TWL6040_RATES
,
1096 .formats
= TWL6040_FORMATS
,
1098 .ops
= &twl6040_dai_ops
,
1101 .name
= "twl6040-vib",
1102 .id
= TWL6040_DAI_VIB
,
1104 .stream_name
= "Vibra Playback",
1107 .rates
= SNDRV_PCM_RATE_CONTINUOUS
,
1108 .formats
= TWL6040_FORMATS
,
1110 .ops
= &twl6040_dai_ops
,
1115 static int twl6040_suspend(struct snd_soc_codec
*codec
)
1117 twl6040_set_bias_level(codec
, SND_SOC_BIAS_OFF
);
1122 static int twl6040_resume(struct snd_soc_codec
*codec
)
1124 twl6040_set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
1129 #define twl6040_suspend NULL
1130 #define twl6040_resume NULL
1133 static int twl6040_probe(struct snd_soc_codec
*codec
)
1135 struct twl6040_data
*priv
;
1136 struct platform_device
*pdev
= container_of(codec
->dev
,
1137 struct platform_device
, dev
);
1140 priv
= devm_kzalloc(codec
->dev
, sizeof(*priv
), GFP_KERNEL
);
1144 snd_soc_codec_set_drvdata(codec
, priv
);
1146 priv
->codec
= codec
;
1147 codec
->control_data
= dev_get_drvdata(codec
->dev
->parent
);
1149 priv
->plug_irq
= platform_get_irq(pdev
, 0);
1150 if (priv
->plug_irq
< 0) {
1151 dev_err(codec
->dev
, "invalid irq\n");
1155 INIT_DELAYED_WORK(&priv
->hs_jack
.work
, twl6040_accessory_work
);
1157 mutex_init(&priv
->mutex
);
1159 ret
= request_threaded_irq(priv
->plug_irq
, NULL
,
1160 twl6040_audio_handler
, IRQF_NO_SUSPEND
,
1161 "twl6040_irq_plug", codec
);
1163 dev_err(codec
->dev
, "PLUG IRQ request failed: %d\n", ret
);
1167 twl6040_init_chip(codec
);
1169 /* power on device */
1170 return twl6040_set_bias_level(codec
, SND_SOC_BIAS_STANDBY
);
1173 static int twl6040_remove(struct snd_soc_codec
*codec
)
1175 struct twl6040_data
*priv
= snd_soc_codec_get_drvdata(codec
);
1177 free_irq(priv
->plug_irq
, codec
);
1178 twl6040_set_bias_level(codec
, SND_SOC_BIAS_OFF
);
1183 static struct snd_soc_codec_driver soc_codec_dev_twl6040
= {
1184 .probe
= twl6040_probe
,
1185 .remove
= twl6040_remove
,
1186 .suspend
= twl6040_suspend
,
1187 .resume
= twl6040_resume
,
1188 .read
= twl6040_read_reg_cache
,
1189 .write
= twl6040_write
,
1190 .set_bias_level
= twl6040_set_bias_level
,
1191 .reg_cache_size
= ARRAY_SIZE(twl6040_reg
),
1192 .reg_word_size
= sizeof(u8
),
1193 .reg_cache_default
= twl6040_reg
,
1194 .ignore_pmdown_time
= true,
1196 .controls
= twl6040_snd_controls
,
1197 .num_controls
= ARRAY_SIZE(twl6040_snd_controls
),
1198 .dapm_widgets
= twl6040_dapm_widgets
,
1199 .num_dapm_widgets
= ARRAY_SIZE(twl6040_dapm_widgets
),
1200 .dapm_routes
= intercon
,
1201 .num_dapm_routes
= ARRAY_SIZE(intercon
),
1204 static int twl6040_codec_probe(struct platform_device
*pdev
)
1206 return snd_soc_register_codec(&pdev
->dev
, &soc_codec_dev_twl6040
,
1207 twl6040_dai
, ARRAY_SIZE(twl6040_dai
));
1210 static int twl6040_codec_remove(struct platform_device
*pdev
)
1212 snd_soc_unregister_codec(&pdev
->dev
);
1216 static struct platform_driver twl6040_codec_driver
= {
1218 .name
= "twl6040-codec",
1219 .owner
= THIS_MODULE
,
1221 .probe
= twl6040_codec_probe
,
1222 .remove
= twl6040_codec_remove
,
1225 module_platform_driver(twl6040_codec_driver
);
1227 MODULE_DESCRIPTION("ASoC TWL6040 codec driver");
1228 MODULE_AUTHOR("Misael Lopez Cruz");
1229 MODULE_LICENSE("GPL");