
On Tue, 2019-05-21 at 13:36 +0300, Oleksandr Suvorov wrote:
Change VAG power on/off control according to the following algorithm:
- turn VAG power ON on the 1st incoming event.
- keep it ON if there is any active VAG consumer (ADC/DAC/HP/Line-
In).
- turn VAG power OFF when there is the latest consumer's pre-down
event come.
- always delay after VAG power OFF to avoid pop.
- delay after VAG power ON if the initiative consumer is Line-In,
this prevents pop during line-in muxing.
Also, according to the manual, to avoid any pops/clicks, the outputs should be muted during input/output routing changes.
Signed-off-by: Oleksandr Suvorov oleksandr.suvorov@toradex.com
Reviewed-by: Marcel Ziswiler marcel.ziswiler@toradex.com
sound/soc/codecs/sgtl5000.c | 227 +++++++++++++++++++++++++++++++---
1 file changed, 195 insertions(+), 32 deletions(-)
diff --git sound/soc/codecs/sgtl5000.c sound/soc/codecs/sgtl5000.c index ee1e4bf61322..acfbd5cdf936 100644 --- sound/soc/codecs/sgtl5000.c +++ sound/soc/codecs/sgtl5000.c @@ -31,6 +31,13 @@ #define SGTL5000_DAP_REG_OFFSET 0x0100 #define SGTL5000_MAX_REG_OFFSET 0x013A
+/* Delay for the VAG ramp up */ +#define SGTL5000_VAG_POWERUP_DELAY 500 /* ms */ +/* Delay for the VAG ramp down */ +#define SGTL5000_VAG_POWERDOWN_DELAY 500 /* ms */
+#define SGTL5000_OUTPUTS_MUTE (SGTL5000_HP_MUTE | SGTL5000_LINE_OUT_MUTE)
/* default value of sgtl5000 registers */ static const struct reg_default sgtl5000_reg_defaults[] = { { SGTL5000_CHIP_DIG_POWER, 0x0000 }, @@ -123,6 +130,18 @@ enum { I2S_SCLK_STRENGTH_HIGH, };
+enum {
- HP_POWER_EVENT,
- DAC_POWER_EVENT,
- ADC_POWER_EVENT
+};
+struct sgtl5000_mute_state {
- u16 hp_event;
- u16 dac_event;
- u16 adc_event;
+};
/* sgtl5000 private structure in codec */ struct sgtl5000_priv { int sysclk; /* sysclk rate */ @@ -137,8 +156,109 @@ struct sgtl5000_priv { u8 micbias_voltage; u8 lrclk_strength; u8 sclk_strength;
- struct sgtl5000_mute_state mute_state;
};
+static inline int hp_sel_input(struct snd_soc_component *component) +{
- return (snd_soc_component_read32(component,
SGTL5000_CHIP_ANA_CTRL) &
SGTL5000_HP_SEL_MASK) >> SGTL5000_HP_SEL_SHIFT;
+}
+static inline u16 mute_output(struct snd_soc_component *component,
u16 mute_mask)
+{
- u16 mute_reg = snd_soc_component_read32(component,
SGTL5000_CHIP_ANA_CTRL);
- snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_CTRL,
mute_mask, mute_mask);
- return mute_reg;
+}
+static inline void restore_output(struct snd_soc_component *component,
u16 mute_mask, u16 mute_reg)
+{
- snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_CTRL,
mute_mask, mute_reg);
+}
+static void vag_power_on(struct snd_soc_component *component, u32 source) +{
- if (snd_soc_component_read32(component,
SGTL5000_CHIP_ANA_POWER) &
SGTL5000_VAG_POWERUP)
return;
- snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_POWER,
SGTL5000_VAG_POWERUP,
SGTL5000_VAG_POWERUP);
- /* When VAG powering on to get local loop from Line-In, the
sleep
* is required to avoid loud pop.
*/
- if (hp_sel_input(component) == SGTL5000_HP_SEL_LINE_IN &&
source == HP_POWER_EVENT)
msleep(SGTL5000_VAG_POWERUP_DELAY);
+}
+static int vag_power_consumers(struct snd_soc_component *component,
u16 ana_pwr_reg, u32 source)
+{
- int consumers = 0;
- /* count dac/adc consumers unconditional */
- if (ana_pwr_reg & SGTL5000_DAC_POWERUP)
consumers++;
- if (ana_pwr_reg & SGTL5000_ADC_POWERUP)
consumers++;
- /*
* If the event comes from HP and Line-In is selected,
* current action is 'DAC to be powered down'.
* As HP_POWERUP is not set when HP muxed to line-in,
* we need to keep VAG power ON.
*/
- if (source == HP_POWER_EVENT) {
if (hp_sel_input(component) == SGTL5000_HP_SEL_LINE_IN)
consumers++;
- } else {
if (ana_pwr_reg & SGTL5000_HP_POWERUP)
consumers++;
- }
- return consumers;
+}
+static void vag_power_off(struct snd_soc_component *component, u32 source) +{
- u16 ana_pwr = snd_soc_component_read32(component,
SGTL5000_CHIP_ANA_POWER);
- if (!(ana_pwr & SGTL5000_VAG_POWERUP))
return;
- /*
* This function calls when any of VAG power consumers is
disappearing.
* Thus, if there is more than one consumer at the moment, as
minimum
* one consumer will definitely stay after the end of the
current
* event.
* Don't clear VAG_POWERUP if 2 or more consumers of VAG
present:
* - LINE_IN (for HP events) / HP (for DAC/ADC events)
* - DAC
* - ADC
* (the current consumer is disappearing right now)
*/
- if (vag_power_consumers(component, ana_pwr, source) >= 2)
return;
- snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_POWER,
SGTL5000_VAG_POWERUP, 0);
- /* In power down case, we need wait 400-1000 ms
* when VAG fully ramped down.
* As longer we wait, as smaller pop we've got.
*/
- msleep(SGTL5000_VAG_POWERDOWN_DELAY);
+}
/*
- mic_bias power on/off share the same register bits with
- output impedance of mic bias, when power on mic bias, we
@@ -170,40 +290,79 @@ static int mic_bias_event(struct snd_soc_dapm_widget *w, return 0; }
-/*
- As manual described, ADC/DAC only works when VAG powerup,
- So enabled VAG before ADC/DAC up.
- In power down case, we need wait 400ms when vag fully ramped
down.
- */
-static int power_vag_event(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+static void vag_and_mute_control(struct snd_soc_component *component,
int event, int event_source,
u16 mute_mask, u16 *mute_reg)
{
- struct snd_soc_component *component =
snd_soc_dapm_to_component(w->dapm);
- const u32 mask = SGTL5000_DAC_POWERUP | SGTL5000_ADC_POWERUP;
- switch (event) {
- case SND_SOC_DAPM_POST_PMU:
snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_POWER,
SGTL5000_VAG_POWERUP, SGTL5000_VAG_POWERUP);
msleep(400);
- case SND_SOC_DAPM_PRE_PMU:
*mute_reg = mute_output(component, mute_mask);
break;
- case SND_SOC_DAPM_POST_PMU:
vag_power_on(component, event_source);
break;restore_output(component, mute_mask, *mute_reg);
- case SND_SOC_DAPM_PRE_PMD:
/*
* Don't clear VAG_POWERUP, when both DAC and ADC are
* operational to prevent inadvertently starving the
* other one of them.
*/
if ((snd_soc_component_read32(component,
SGTL5000_CHIP_ANA_POWER) &
mask) != mask) {
snd_soc_component_update_bits(component,
SGTL5000_CHIP_ANA_POWER,
SGTL5000_VAG_POWERUP, 0);
msleep(400);
}
*mute_reg = mute_output(component, mute_mask);
vag_power_off(component, event_source);
break;
- case SND_SOC_DAPM_POST_PMD:
break; default: break; }restore_output(component, mute_mask, *mute_reg);
+}
+/*
- Mute Headphone when power it up/down.
- Control VAG power on HP power path.
- */
+static int headphone_pga_event(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+{
- struct snd_soc_component *component =
snd_soc_dapm_to_component(w->dapm);
- struct sgtl5000_priv *sgtl5000 =
snd_soc_component_get_drvdata(component);
- vag_and_mute_control(component, event, HP_POWER_EVENT,
SGTL5000_HP_MUTE,
&sgtl5000->mute_state.hp_event);
- return 0;
+}
+/* As manual describes, ADC/DAC powering up/down requires
- to mute outputs to avoid pops.
- Control VAG power on ADC/DAC power path.
- */
+static int adc_updown_depop(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+{
- struct snd_soc_component *component =
snd_soc_dapm_to_component(w->dapm);
- struct sgtl5000_priv *sgtl5000 =
snd_soc_component_get_drvdata(component);
- vag_and_mute_control(component, event, ADC_POWER_EVENT,
SGTL5000_OUTPUTS_MUTE,
&sgtl5000->mute_state.adc_event);
- return 0;
+}
+static int dac_updown_depop(struct snd_soc_dapm_widget *w,
- struct snd_kcontrol *kcontrol, int event)
+{
struct snd_soc_component *component =
snd_soc_dapm_to_component(w->dapm);
struct sgtl5000_priv *sgtl5000 =
snd_soc_component_get_drvdata(component);
vag_and_mute_control(component, event, DAC_POWER_EVENT,
SGTL5000_OUTPUTS_MUTE,
&sgtl5000->mute_state.dac_event);
return 0;
} @@ -280,7 +439,10 @@ static const struct snd_soc_dapm_widget sgtl5000_dapm_widgets[] = { mic_bias_event, SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
- SND_SOC_DAPM_PGA("HP", SGTL5000_CHIP_ANA_POWER, 4, 0, NULL, 0),
- SND_SOC_DAPM_PGA_E("HP", SGTL5000_CHIP_ANA_POWER, 4, 0, NULL,
0,
headphone_pga_event,
SND_SOC_DAPM_PRE_POST_PMU |
SND_SOC_DAPM_PRE_POST_PMD),
SND_SOC_DAPM_PGA("LO", SGTL5000_CHIP_ANA_POWER, 0, 0, NULL, 0),
SND_SOC_DAPM_MUX("Capture Mux", SND_SOC_NOPM, 0, 0, &adc_mux),
@@ -301,11 +463,12 @@ static const struct snd_soc_dapm_widget sgtl5000_dapm_widgets[] = { 0, SGTL5000_CHIP_DIG_POWER, 1, 0),
- SND_SOC_DAPM_ADC("ADC", "Capture", SGTL5000_CHIP_ANA_POWER, 1,
0),
- SND_SOC_DAPM_DAC("DAC", "Playback", SGTL5000_CHIP_ANA_POWER, 3,
0),
- SND_SOC_DAPM_PRE("VAG_POWER_PRE", power_vag_event),
- SND_SOC_DAPM_POST("VAG_POWER_POST", power_vag_event),
- SND_SOC_DAPM_ADC_E("ADC", "Capture", SGTL5000_CHIP_ANA_POWER,
1, 0,
adc_updown_depop, SND_SOC_DAPM_PRE_POST_PMU
|
SND_SOC_DAPM_PRE_POST_PMD),
- SND_SOC_DAPM_DAC_E("DAC", "Playback", SGTL5000_CHIP_ANA_POWER,
3, 0,
dac_updown_depop, SND_SOC_DAPM_PRE_POST_PMU
|
SND_SOC_DAPM_PRE_POST_PMD),
};
/* routes for sgtl5000 */
2.20.1