Commit 1ca683ce authored by Srinivas Kandagatla's avatar Srinivas Kandagatla Committed by Zheng Zengkai
Browse files

ASoC: codecs: wcd934x: handle channel mappping list correctly 

stable inclusion
from stable-v5.10.85
commit 1089dac26c6b4b833323ae6c0ceab29fb30ede72
bugzilla: 186032 https://gitee.com/openeuler/kernel/issues/I4QVI4

Reference: https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git/commit/?id=1089dac26c6b4b833323ae6c0ceab29fb30ede72



--------------------------------

commit 23ba2861 upstream.

Currently each channel is added as list to dai channel list, however
there is danger of adding same channel to multiple dai channel list
which endups corrupting the other list where its already added.

This patch ensures that the channel is actually free before adding to
the dai channel list and also ensures that the channel is on the list
before deleting it.

This check was missing previously, and we did not hit this issue as
we were testing very simple usecases with sequence of amixer commands.

Fixes: a70d9245 ("ASoC: wcd934x: add capture dapm widgets")
Fixes: dd9eb19b ("ASoC: wcd934x: add playback dapm widgets")
Signed-off-by: default avatarSrinivas Kandagatla <srinivas.kandagatla@linaro.org>
Link: https://lore.kernel.org/r/20211130160507.22180-2-srinivas.kandagatla@linaro.org


Signed-off-by: default avatarMark Brown <broonie@kernel.org>
Signed-off-by: default avatarGreg Kroah-Hartman <gregkh@linuxfoundation.org>
Signed-off-by: default avatarChen Jun <chenjun102@huawei.com>
Signed-off-by: default avatarZheng Zengkai <zhengzengkai@huawei.com>
parent 1a59f6de

sound/soc/codecs/wcd934x.c

+88 −31
Original line number Diff line number Diff line
@@ -2540,6 +2540,31 @@ static int slim_rx_mux_get(struct snd_kcontrol *kc, 
	return 0;

}



static int slim_rx_mux_to_dai_id(int mux)

{

	int aif_id;



	switch (mux) {

	case 1:

		aif_id = AIF1_PB;

		break;

	case 2:

		aif_id = AIF2_PB;

		break;

	case 3:

		aif_id = AIF3_PB;

		break;

	case 4:

		aif_id = AIF4_PB;

		break;

	default:

		aif_id = -1;

		break;

	}



	return aif_id;

}



static int slim_rx_mux_put(struct snd_kcontrol *kc,

			   struct snd_ctl_elem_value *ucontrol)

{
@@ -2547,43 +2572,59 @@ static int slim_rx_mux_put(struct snd_kcontrol *kc, 
	struct wcd934x_codec *wcd = dev_get_drvdata(w->dapm->dev);

	struct soc_enum *e = (struct soc_enum *)kc->private_value;

	struct snd_soc_dapm_update *update = NULL;

	struct wcd934x_slim_ch *ch, *c;

	u32 port_id = w->shift;

	bool found = false;

	int mux_idx;

	int prev_mux_idx = wcd->rx_port_value[port_id];

	int aif_id;



	if (wcd->rx_port_value[port_id] == ucontrol->value.enumerated.item[0])

		return 0;

	mux_idx = ucontrol->value.enumerated.item[0];



	wcd->rx_port_value[port_id] = ucontrol->value.enumerated.item[0];

	if (mux_idx == prev_mux_idx)

		return 0;



	switch (wcd->rx_port_value[port_id]) {

	switch(mux_idx) {

	case 0:

		list_del_init(&wcd->rx_chs[port_id].list);

		break;

	case 1:

		list_add_tail(&wcd->rx_chs[port_id].list,

			      &wcd->dai[AIF1_PB].slim_ch_list);

		break;

	case 2:

		list_add_tail(&wcd->rx_chs[port_id].list,

			      &wcd->dai[AIF2_PB].slim_ch_list);

		aif_id = slim_rx_mux_to_dai_id(prev_mux_idx);

		if (aif_id < 0)

			return 0;



		list_for_each_entry_safe(ch, c, &wcd->dai[aif_id].slim_ch_list, list) {

			if (ch->port == port_id + WCD934X_RX_START) {

				found = true;

				list_del_init(&ch->list);

				break;

	case 3:

		list_add_tail(&wcd->rx_chs[port_id].list,

			      &wcd->dai[AIF3_PB].slim_ch_list);

			}

		}

		if (!found)

			return 0;



		break;

	case 4:

	case 1 ... 4:

		aif_id = slim_rx_mux_to_dai_id(mux_idx);

		if (aif_id < 0)

			return 0;



		if (list_empty(&wcd->rx_chs[port_id].list)) {

			list_add_tail(&wcd->rx_chs[port_id].list,

			      &wcd->dai[AIF4_PB].slim_ch_list);

				      &wcd->dai[aif_id].slim_ch_list);

		} else {

			dev_err(wcd->dev ,"SLIM_RX%d PORT is busy\n", port_id);

			return 0;

		}

		break;



	default:

		dev_err(wcd->dev, "Unknown AIF %d\n",

			wcd->rx_port_value[port_id]);

		dev_err(wcd->dev, "Unknown AIF %d\n", mux_idx);

		goto err;

	}



	wcd->rx_port_value[port_id] = mux_idx;

	snd_soc_dapm_mux_update_power(w->dapm, kc, wcd->rx_port_value[port_id],

				      e, update);



	return 0;

	return 1;

err:

	return -EINVAL;

}
@@ -3029,6 +3070,7 @@ static int slim_tx_mixer_put(struct snd_kcontrol *kc, 
	struct soc_mixer_control *mixer =

			(struct soc_mixer_control *)kc->private_value;

	int enable = ucontrol->value.integer.value[0];

	struct wcd934x_slim_ch *ch, *c;

	int dai_id = widget->shift;

	int port_id = mixer->shift;
@@ -3036,17 +3078,32 @@ static int slim_tx_mixer_put(struct snd_kcontrol *kc, 
	if (enable == wcd->tx_port_value[port_id])

		return 0;



	wcd->tx_port_value[port_id] = enable;



	if (enable)

	if (enable) {

		if (list_empty(&wcd->tx_chs[port_id].list)) {

			list_add_tail(&wcd->tx_chs[port_id].list,

				      &wcd->dai[dai_id].slim_ch_list);

	else

		} else {

			dev_err(wcd->dev ,"SLIM_TX%d PORT is busy\n", port_id);

			return 0;

		}

	 } else {

		bool found = false;



		list_for_each_entry_safe(ch, c, &wcd->dai[dai_id].slim_ch_list, list) {

			if (ch->port == port_id) {

				found = true;

				list_del_init(&wcd->tx_chs[port_id].list);

				break;

			}

		}

		if (!found)

			return 0;

	 }



	wcd->tx_port_value[port_id] = enable;

	snd_soc_dapm_mixer_update_power(widget->dapm, kc, enable, update);



	return 0;

	return 1;

}



static const struct snd_kcontrol_new aif1_slim_cap_mixer[] = {