Merge "ASoC: bolero: Add LPI mode for VoLTE usecase" (b0fed904) · Commits · e / devices / android_kernel_fairphone_FP5

asoc/codecs/bolero/tx-macro.c

+95 −0

Original line number	Diff line number	Diff line
		@@ -177,6 +177,8 @@ struct tx_macro_priv {
		bool bcs_clk_en;
		bool hs_slow_insert_complete;
		int amic_sample_rate;
		bool lpi_enable;
		bool register_event_listener;
		};

		static bool tx_macro_get_data(struct snd_soc_component *component,
		@@ -330,6 +332,45 @@ static int tx_macro_tx_swr_clk_event(struct snd_soc_dapm_widget *w,
		return 0;
		}

		static int tx_macro_swr_pwr_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);
		int ret = 0;
		struct device *tx_dev = NULL;
		struct tx_macro_priv *tx_priv = NULL;

		if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
		return -EINVAL;

		dev_dbg(tx_dev, "%s: event = %d, lpi_enable = %d\n",
		__func__, event, tx_priv->lpi_enable);

		if (!tx_priv->lpi_enable)
		return ret;

		switch (event) {
		case SND_SOC_DAPM_PRE_PMU:
		if (tx_priv->lpi_enable) {
		bolero_register_event_listener(component, true);
		tx_priv->register_event_listener = true;
		}
		break;
		case SND_SOC_DAPM_POST_PMD:
		if (tx_priv->register_event_listener) {
		tx_priv->register_event_listener = false;
		bolero_register_event_listener(component, false);
		}
		break;
		default:
		dev_err(tx_priv->dev,
		"%s: invalid DAPM event %d\n", __func__, event);
		ret = -EINVAL;
		}
		return ret;
		}

		static int tx_macro_mclk_event(struct snd_soc_dapm_widget *w,
		struct snd_kcontrol *kcontrol, int event)
		{
		@@ -786,6 +827,38 @@ static int tx_macro_dec_mode_put(struct snd_kcontrol *kcontrol,
		return 0;
		}

		static int tx_macro_lpi_get(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		struct snd_soc_component *component =
		snd_soc_kcontrol_component(kcontrol);
		struct device *tx_dev = NULL;
		struct tx_macro_priv *tx_priv = NULL;

		if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
		return -EINVAL;

		ucontrol->value.integer.value[0] = tx_priv->lpi_enable;

		return 0;
		}

		static int tx_macro_lpi_put(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		struct snd_soc_component *component =
		snd_soc_kcontrol_component(kcontrol);
		struct device *tx_dev = NULL;
		struct tx_macro_priv *tx_priv = NULL;

		if (!tx_macro_get_data(component, &tx_dev, &tx_priv, __func__))
		return -EINVAL;

		tx_priv->lpi_enable = ucontrol->value.integer.value[0];

		return 0;
		}

		static int tx_macro_bcs_ch_get(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		@@ -1677,6 +1750,10 @@ static const struct snd_soc_dapm_widget tx_macro_dapm_widgets_common[] = {

		SND_SOC_DAPM_SUPPLY_S("TX_MCLK", 0, SND_SOC_NOPM, 0, 0,
		tx_macro_mclk_event, SND_SOC_DAPM_PRE_PMU \| SND_SOC_DAPM_POST_PMD),

		SND_SOC_DAPM_SUPPLY_S("TX_SWR_PWR", -1, SND_SOC_NOPM, 0, 0,
		tx_macro_swr_pwr_event,
		SND_SOC_DAPM_PRE_PMU \| SND_SOC_DAPM_POST_PMD),
		};

		static const struct snd_soc_dapm_widget tx_macro_dapm_widgets_v2[] = {
		@@ -2146,6 +2223,19 @@ static const struct snd_soc_dapm_route tx_audio_map_v3[] = {
		{"TX SMIC MUX5", NULL, "TX_SWR_CLK"},
		{"TX SMIC MUX6", NULL, "TX_SWR_CLK"},
		{"TX SMIC MUX7", NULL, "TX_SWR_CLK"},

		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		{"TX SWR_INPUT", NULL, "TX_SWR_PWR"},
		};

		static const struct snd_soc_dapm_route tx_audio_map[] = {
		@@ -2408,6 +2498,9 @@ static const struct snd_kcontrol_new tx_macro_snd_controls_common[] = {
		BOLERO_CDC_TX3_TX_VOL_CTL,
		-84, 40, digital_gain),

		SOC_SINGLE_EXT("TX LPI Enable", 0, 0, 1, 0,
		tx_macro_lpi_get, tx_macro_lpi_put),

		SOC_ENUM_EXT("DEC0 MODE", dec_mode_mux_enum,
		tx_macro_dec_mode_get, tx_macro_dec_mode_put),

		@@ -2939,6 +3032,8 @@ static int tx_macro_init(struct snd_soc_component *component)
		"%s: priv is null for macro!\n", __func__);
		return -EINVAL;
		}
		tx_priv->lpi_enable = false;
		tx_priv->register_event_listener = false;
		tx_priv->version = bolero_get_version(tx_dev);
		if (tx_priv->version >= BOLERO_VERSION_2_0) {
		ret = snd_soc_dapm_new_controls(dapm,