Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit cb919fbf authored by Vatsal Bucha's avatar Vatsal Bucha Committed by Gerrit - the friendly Code Review server
Browse files

asoc: bolero: Add routing for rx echo reference 



Add mixer control and routing to enable echo reference
for rx_macro.

Change-Id: Ic1095eaa8024f2cb61722609daae94bc645b263b
Signed-off-by: default avatarVatsal Bucha <vbucha@codeaurora.org>
parent 16a5627e

asoc/codecs/bolero/rx-macro.c

+144 −16
Original line number Diff line number Diff line
@@ -77,6 +77,10 @@ static const struct snd_kcontrol_new name##_mux = \ 


#define MAX_IMPED_PARAMS 6



#define RX_MACRO_EC_MIX_TX0_MASK 0xf0

#define RX_MACRO_EC_MIX_TX1_MASK 0x0f

#define RX_MACRO_EC_MIX_TX2_MASK 0x0f



struct wcd_imped_val {

	u32 imped_val;

	u8 index;
@@ -199,6 +203,13 @@ enum { 
	RX_MACRO_COMP_MAX

};



enum {

	RX_MACRO_EC0_MUX = 0,

	RX_MACRO_EC1_MUX,

	RX_MACRO_EC2_MUX,

	RX_MACRO_EC_MUX_MAX,

};



enum {

	INTn_1_INP_SEL_ZERO = 0,

	INTn_1_INP_SEL_DEC0,
@@ -306,6 +317,7 @@ enum { 
	RX_MACRO_AIF2_PB,

	RX_MACRO_AIF3_PB,

	RX_MACRO_AIF4_PB,

	RX_MACRO_AIF_ECHO,

	RX_MACRO_MAX_DAIS,

};
@@ -389,10 +401,6 @@ static const char * const rx_sidetone_mix_text[] = { 
	"ZERO", "SRC0", "SRC1", "SRC_SUM"

};



static const char * const rx_echo_mux_text[] = {

	"ZERO", "RX_MIX0", "RX_MIX1", "RX_MIX2"

};



static const char * const iir_inp_mux_text[] = {

	"ZERO", "DEC0", "DEC1", "DEC2", "DEC3",

	"RX0", "RX1", "RX2", "RX3", "RX4", "RX5"
@@ -484,13 +492,6 @@ RX_MACRO_DAPM_ENUM(rx_int1_mix2_inp, BOLERO_CDC_RX_INP_MUX_SIDETONE_SRC_CFG0, 4, 
RX_MACRO_DAPM_ENUM(rx_int2_mix2_inp, BOLERO_CDC_RX_INP_MUX_SIDETONE_SRC_CFG0, 6,

		rx_sidetone_mix_text);



RX_MACRO_DAPM_ENUM(rx_mix_tx0, BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4, 4,

	rx_echo_mux_text);

RX_MACRO_DAPM_ENUM(rx_mix_tx1, BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4, 0,

	rx_echo_mux_text);

RX_MACRO_DAPM_ENUM(rx_mix_tx2, BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4, 0,

	rx_echo_mux_text);



RX_MACRO_DAPM_ENUM(iir0_inp0, BOLERO_CDC_RX_IIR_INP_MUX_IIR0_MIX_CFG0, 0,

	iir_inp_mux_text);

RX_MACRO_DAPM_ENUM(iir0_inp1, BOLERO_CDC_RX_IIR_INP_MUX_IIR0_MIX_CFG1, 0,
@@ -542,6 +543,31 @@ RX_MACRO_DAPM_ENUM_EXT(rx_macro_rx4, SND_SOC_NOPM, 0, rx_macro_mux_text, 
RX_MACRO_DAPM_ENUM_EXT(rx_macro_rx5, SND_SOC_NOPM, 0, rx_macro_mux_text,

	rx_macro_mux_get, rx_macro_mux_put);



static const char * const rx_echo_mux_text[] = {

	"ZERO", "RX_MIX0", "RX_MIX1", "RX_MIX2"

};



static const struct soc_enum rx_mix_tx2_mux_enum =

	SOC_ENUM_SINGLE(BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG5, 0, 4,

			rx_echo_mux_text);



static const struct snd_kcontrol_new rx_mix_tx2_mux =

	SOC_DAPM_ENUM("RX MIX TX2_MUX Mux", rx_mix_tx2_mux_enum);



static const struct soc_enum rx_mix_tx1_mux_enum =

	SOC_ENUM_SINGLE(BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4, 0, 4,

			rx_echo_mux_text);



static const struct snd_kcontrol_new rx_mix_tx1_mux =

	SOC_DAPM_ENUM("RX MIX TX1_MUX Mux", rx_mix_tx1_mux_enum);



static const struct soc_enum rx_mix_tx0_mux_enum =

	SOC_ENUM_SINGLE(BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4, 4, 4,

			rx_echo_mux_text);



static const struct snd_kcontrol_new rx_mix_tx0_mux =

	SOC_DAPM_ENUM("RX MIX TX0_MUX Mux", rx_mix_tx0_mux_enum);



static struct snd_soc_dai_ops rx_macro_dai_ops = {

	.hw_params = rx_macro_hw_params,

	.get_channel_map = rx_macro_get_channel_map,
@@ -604,6 +630,20 @@ static struct snd_soc_dai_driver rx_macro_dai[] = { 
		},

		.ops = &rx_macro_dai_ops,

	},

	{

		.name = "rx_macro_echo",

		.id = RX_MACRO_AIF_ECHO,

		.capture = {

			.stream_name = "RX_AIF_ECHO Capture",

			.rates = RX_MACRO_ECHO_RATES,

			.formats = RX_MACRO_ECHO_FORMATS,

			.rate_max = 48000,

			.rate_min = 8000,

			.channels_min = 1,

			.channels_max = 3,

		},

		.ops = &rx_macro_dai_ops,

	},

};



static int get_impedance_index(int imped)
@@ -702,7 +742,7 @@ static bool rx_macro_get_data(struct snd_soc_codec *codec, 


	if (!(*rx_priv)->codec) {

		dev_err(codec->dev,

			"%s: tx_priv codec is not initialized!\n", func_name);

			"%s: rx_priv codec is not initialized!\n", func_name);

		return false;

	}
@@ -941,7 +981,7 @@ static int rx_macro_get_channel_map(struct snd_soc_dai *dai, 
	struct device *rx_dev = NULL;

	struct rx_macro_priv *rx_priv = NULL;

	unsigned int temp = 0, ch_mask = 0;

	u16 i = 0;

	u16 val = 0, mask = 0, cnt = 0, i = 0;



	if (!rx_macro_get_data(codec, &rx_dev, &rx_priv, __func__))

		return -EINVAL;
@@ -960,6 +1000,26 @@ static int rx_macro_get_channel_map(struct snd_soc_dai *dai, 
		*rx_slot = ch_mask;

		*rx_num = rx_priv->active_ch_cnt[dai->id];

		break;

	case RX_MACRO_AIF_ECHO:

		val = snd_soc_read(codec,

			BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4);

		if (val & RX_MACRO_EC_MIX_TX0_MASK) {

			mask |= 0x1;

			cnt++;

		}

		if (val & RX_MACRO_EC_MIX_TX1_MASK) {

			mask |= 0x2;

			cnt++;

		}

		val = snd_soc_read(codec,

			BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG5);

		if (val & RX_MACRO_EC_MIX_TX2_MASK) {

			mask |= 0x4;

			cnt++;

		}

		*tx_slot = mask;

		*tx_num = cnt;

		break;

	default:

		dev_err(rx_dev, "%s: Invalid AIF\n", __func__);

		break;
@@ -2546,6 +2606,47 @@ static const struct snd_kcontrol_new rx_macro_snd_controls[] = { 
		rx_macro_iir_band_audio_mixer_put),

};



static int rx_macro_enable_echo(struct snd_soc_dapm_widget *w,

				struct snd_kcontrol *kcontrol,

				int event)

{

	struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm);

	struct device *rx_dev = NULL;

	struct rx_macro_priv *rx_priv = NULL;

	u16 val = 0, ec_hq_reg = 0;

	int ec_tx = 0;



	if (!rx_macro_get_data(codec, &rx_dev, &rx_priv, __func__))

		return -EINVAL;



	dev_dbg(rx_dev, "%s %d %s\n", __func__, event, w->name);



	val = snd_soc_read(codec, BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG4);

	if (!(strcmp(w->name, "RX MIX TX0 MUX")))

		ec_tx = ((val & 0xf0) >> 0x4) - 1;

	else if (!(strcmp(w->name, "RX MIX TX1 MUX")))

		ec_tx = (val & 0x0f) - 1;



	val = snd_soc_read(codec, BOLERO_CDC_RX_INP_MUX_RX_MIX_CFG5);

	if (!(strcmp(w->name, "RX MIX TX2 MUX")))

		ec_tx = (val & 0x0f) - 1;



	if (ec_tx < 0 || (ec_tx >= RX_MACRO_EC_MUX_MAX)) {

		dev_err(rx_dev, "%s: EC mix control not set correctly\n",

			__func__);

		return -EINVAL;

	}

	ec_hq_reg = BOLERO_CDC_RX_EC_REF_HQ0_EC_REF_HQ_PATH_CTL +

			    0x40 * ec_tx;

	snd_soc_update_bits(codec, ec_hq_reg, 0x01, 0x01);

	ec_hq_reg = BOLERO_CDC_RX_EC_REF_HQ0_EC_REF_HQ_CFG0 +

				0x40 * ec_tx;

	/* default set to 48k */

	snd_soc_update_bits(codec, ec_hq_reg, 0x1E, 0x08);



	return 0;

}



static const struct snd_soc_dapm_widget rx_macro_dapm_widgets[] = {

	SND_SOC_DAPM_AIF_IN("RX AIF1 PB", "RX_MACRO_AIF1 Playback", 0,

		SND_SOC_NOPM, 0, 0),
@@ -2559,6 +2660,9 @@ static const struct snd_soc_dapm_widget rx_macro_dapm_widgets[] = { 
	SND_SOC_DAPM_AIF_IN("RX AIF4 PB", "RX_MACRO_AIF4 Playback", 0,

		SND_SOC_NOPM, 0, 0),



	SND_SOC_DAPM_AIF_OUT("RX AIF_ECHO", "RX_AIF_ECHO Capture", 0,

		SND_SOC_NOPM, 0, 0),



	RX_MACRO_DAPM_MUX("RX_MACRO RX0 MUX", RX_MACRO_RX0, rx_macro_rx0),

	RX_MACRO_DAPM_MUX("RX_MACRO RX1 MUX", RX_MACRO_RX1, rx_macro_rx1),

	RX_MACRO_DAPM_MUX("RX_MACRO RX2 MUX", RX_MACRO_RX2, rx_macro_rx2),
@@ -2582,6 +2686,19 @@ static const struct snd_soc_dapm_widget rx_macro_dapm_widgets[] = { 
	RX_MACRO_DAPM_MUX("IIR1 INP2 MUX", 0, iir1_inp2),

	RX_MACRO_DAPM_MUX("IIR1 INP3 MUX", 0, iir1_inp3),



	SND_SOC_DAPM_MUX_E("RX MIX TX0 MUX", SND_SOC_NOPM,

			   RX_MACRO_EC0_MUX, 0,

			   &rx_mix_tx0_mux, rx_macro_enable_echo,

			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),

	SND_SOC_DAPM_MUX_E("RX MIX TX1 MUX", SND_SOC_NOPM,

			   RX_MACRO_EC1_MUX, 0,

			   &rx_mix_tx1_mux, rx_macro_enable_echo,

			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),

	SND_SOC_DAPM_MUX_E("RX MIX TX2 MUX", SND_SOC_NOPM,

			   RX_MACRO_EC2_MUX, 0,

			   &rx_mix_tx2_mux, rx_macro_enable_echo,

			   SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),



	SND_SOC_DAPM_MIXER_E("IIR0", BOLERO_CDC_RX_SIDETONE_IIR0_IIR_PATH_CTL,

		4, 0, NULL, 0, rx_macro_set_iir_gain,

		SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
@@ -2593,9 +2710,6 @@ static const struct snd_soc_dapm_widget rx_macro_dapm_widgets[] = { 
	SND_SOC_DAPM_MIXER("SRC1", BOLERO_CDC_RX_SIDETONE_SRC1_ST_SRC_PATH_CTL,

		4, 0, NULL, 0),



	RX_MACRO_DAPM_MUX("RX MIX TX0 MUX", 0, rx_mix_tx0),

	RX_MACRO_DAPM_MUX("RX MIX TX1 MUX", 0, rx_mix_tx1),

	RX_MACRO_DAPM_MUX("RX MIX TX2 MUX", 0, rx_mix_tx2),

	RX_MACRO_DAPM_MUX("RX INT0 DEM MUX", 0, rx_int0_dem_inp),

	RX_MACRO_DAPM_MUX("RX INT1 DEM MUX", 0, rx_int1_dem_inp),
@@ -2805,6 +2919,20 @@ static const struct snd_soc_dapm_route rx_audio_map[] = { 
	{"RX INT2_1 MIX1", NULL, "RX INT2_1 MIX1 INP1"},

	{"RX INT2_1 MIX1", NULL, "RX INT2_1 MIX1 INP2"},



	{"RX MIX TX0 MUX", "RX_MIX0", "RX INT0 SEC MIX"},

	{"RX MIX TX0 MUX", "RX_MIX1", "RX INT1 SEC MIX"},

	{"RX MIX TX0 MUX", "RX_MIX2", "RX INT2 SEC MIX"},

	{"RX MIX TX1 MUX", "RX_MIX0", "RX INT0 SEC MIX"},

	{"RX MIX TX1 MUX", "RX_MIX1", "RX INT1 SEC MIX"},

	{"RX MIX TX1 MUX", "RX_MIX2", "RX INT2 SEC MIX"},

	{"RX MIX TX2 MUX", "RX_MIX0", "RX INT0 SEC MIX"},

	{"RX MIX TX2 MUX", "RX_MIX1", "RX INT1 SEC MIX"},

	{"RX MIX TX2 MUX", "RX_MIX2", "RX INT2 SEC MIX"},

	{"RX AIF_ECHO", NULL, "RX MIX TX0 MUX"},

	{"RX AIF_ECHO", NULL, "RX MIX TX1 MUX"},

	{"RX AIF_ECHO", NULL, "RX MIX TX2 MUX"},

	{"RX AIF_ECHO", NULL, "RX_MCLK"},



	/* Mixing path INT0 */

	{"RX INT0_2 MUX", "RX0", "RX_RX0"},

	{"RX INT0_2 MUX", "RX1", "RX_RX1"},