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

Commit 1b29a217 authored by Laxminath Kasam's avatar Laxminath Kasam
Browse files

ASoC: msm: Add support for USB/WCN/TDM Audio 



Add required machine driver support for
USB Audio, BT, FM, TDM interfaces both
for internal and external codecs.

CRs-Fixed: 1083537
Change-Id: I3d2765535793d6ef9153cfcab4b44a9adad67e15
Signed-off-by: default avatarLaxminath Kasam <lkasam@codeaurora.org>
parent 61f26e3a

sound/soc/msm/msmfalcon-common.c

+1086 −57

File changed.

Preview size limit exceeded, changes collapsed.

sound/soc/msm/msmfalcon-common.h

+28 −0
Original line number Diff line number Diff line
@@ -31,6 +31,34 @@ 
#define SAMPLING_RATE_352P8KHZ  352800

#define SAMPLING_RATE_384KHZ    384000



#define TDM_CHANNEL_MAX 8

#define TDM_SLOT_OFFSET_MAX 8



enum {

	TDM_0 = 0,

	TDM_1,

	TDM_2,

	TDM_3,

	TDM_4,

	TDM_5,

	TDM_6,

	TDM_7,

	TDM_PORT_MAX,

};



enum {

	TDM_PRI = 0,

	TDM_SEC,

	TDM_TERT,

	TDM_QUAT,

	TDM_INTERFACE_MAX,

};



struct tdm_port {

	u32 mode;

	u32 channel;

};



extern const struct snd_kcontrol_new msm_common_snd_controls[];

struct msmfalcon_codec {

	void* (*get_afe_config_fn)(struct snd_soc_codec *codec,

sound/soc/msm/msmfalcon-ext-dai-links.c

+431 −2
Original line number Diff line number Diff line
@@ -16,6 +16,7 @@ 
#include <sound/soc.h>

#include <sound/soc-dapm.h>

#include <sound/pcm.h>

#include <sound/pcm_params.h>

#include "qdsp6v2/msm-pcm-routing-v2.h"

#include "../codecs/wcd9335.h"

#include "msmfalcon-common.h"
@@ -25,6 +26,9 @@ 
#define __CHIPSET__ "MSMFALCON "

#define MSM_DAILINK_NAME(name) (__CHIPSET__#name)



#define WCN_CDC_SLIM_RX_CH_MAX 2

#define WCN_CDC_SLIM_TX_CH_MAX 3



static struct snd_soc_card snd_soc_card_msm_card;



static struct snd_soc_ops msm_ext_slimbus_be_ops = {
@@ -49,6 +53,222 @@ static struct snd_soc_ops msm_aux_pcm_be_ops = { 
	.shutdown = msm_aux_pcm_snd_shutdown,

};



static int msm_wcn_init(struct snd_soc_pcm_runtime *rtd)

{

	unsigned int rx_ch[WCN_CDC_SLIM_RX_CH_MAX] = {157, 158};

	unsigned int tx_ch[WCN_CDC_SLIM_TX_CH_MAX]  = {159, 160, 161};

	struct snd_soc_dai *codec_dai = rtd->codec_dai;



	return snd_soc_dai_set_channel_map(codec_dai, ARRAY_SIZE(tx_ch),

					   tx_ch, ARRAY_SIZE(rx_ch), rx_ch);

}



static int msm_wcn_hw_params(struct snd_pcm_substream *substream,

			     struct snd_pcm_hw_params *params)

{

	struct snd_soc_pcm_runtime *rtd = substream->private_data;

	struct snd_soc_dai *codec_dai = rtd->codec_dai;

	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;

	struct snd_soc_dai_link *dai_link = rtd->dai_link;

	u32 rx_ch[WCN_CDC_SLIM_RX_CH_MAX], tx_ch[WCN_CDC_SLIM_TX_CH_MAX];

	u32 rx_ch_cnt = 0, tx_ch_cnt = 0;

	int ret;



	dev_dbg(rtd->dev, "%s: %s_tx_dai_id_%d\n", __func__,

		 codec_dai->name, codec_dai->id);

	ret = snd_soc_dai_get_channel_map(codec_dai,

				 &tx_ch_cnt, tx_ch, &rx_ch_cnt, rx_ch);

	if (ret) {

		dev_err(rtd->dev,

			"%s: failed to get BTFM codec chan map\n, err:%d\n",

			__func__, ret);

		goto exit;

	}



	dev_dbg(rtd->dev, "%s: tx_ch_cnt(%d) be_id %d\n",

		__func__, tx_ch_cnt, dai_link->be_id);



	ret = snd_soc_dai_set_channel_map(cpu_dai,

					  tx_ch_cnt, tx_ch, rx_ch_cnt, rx_ch);

	if (ret)

		dev_err(rtd->dev, "%s: failed to set cpu chan map, err:%d\n",

			__func__, ret);



exit:

	return ret;

}



static struct snd_soc_ops msm_wcn_ops = {

	.hw_params = msm_wcn_hw_params,

};



/*TDM default offset currently only supporting TDM_RX_0 and TDM_TX_0 */

static unsigned int tdm_slot_offset[TDM_PORT_MAX][TDM_SLOT_OFFSET_MAX] = {

	{0, 4, 8, 12, 16, 20, 24, 28},/* TX_0 | RX_0 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_1 | RX_1 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_2 | RX_2 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_3 | RX_3 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_4 | RX_4 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_5 | RX_5 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_6 | RX_6 */

	{AFE_SLOT_MAPPING_OFFSET_INVALID},/* TX_7 | RX_7 */

};



static unsigned int tdm_param_set_slot_mask(u16 port_id, int slot_width,

					    int slots)

{

	unsigned int slot_mask = 0;

	int i, j;

	unsigned int *slot_offset;



	for (i = TDM_0; i < TDM_PORT_MAX; i++) {

		slot_offset = tdm_slot_offset[i];



		for (j = 0; j < TDM_SLOT_OFFSET_MAX; j++) {

			if (slot_offset[j] != AFE_SLOT_MAPPING_OFFSET_INVALID)

				slot_mask |=

				(1 << ((slot_offset[j] * 8) / slot_width));

			else

				break;

		}

	}



	return slot_mask;

}



static int msm_tdm_snd_hw_params(struct snd_pcm_substream *substream,

				     struct snd_pcm_hw_params *params)

{

	struct snd_soc_pcm_runtime *rtd = substream->private_data;

	struct snd_soc_dai *cpu_dai = rtd->cpu_dai;

	int ret = 0;

	int channels, slot_width, slots;

	unsigned int slot_mask;

	unsigned int *slot_offset;

	int offset_channels = 0;

	int i;



	pr_debug("%s: dai id = 0x%x\n", __func__, cpu_dai->id);



	channels = params_channels(params);

	switch (channels) {

	case 1:

	case 2:

	case 3:

	case 4:

	case 5:

	case 6:

	case 7:

	case 8:

		switch (params_format(params)) {

		case SNDRV_PCM_FORMAT_S32_LE:

		case SNDRV_PCM_FORMAT_S24_LE:

		case SNDRV_PCM_FORMAT_S16_LE:

		/*

		 * up to 8 channels HW config should

		 * use 32 bit slot width for max support of

		 * stream bit width. (slot_width > bit_width)

		 */

			slot_width = 32;

			break;

		default:

			pr_err("%s: invalid param format 0x%x\n",

				__func__, params_format(params));

			return -EINVAL;

		}

		slots = 8;

		slot_mask = tdm_param_set_slot_mask(cpu_dai->id,

						    slot_width,

						    slots);

		if (!slot_mask) {

			pr_err("%s: invalid slot_mask 0x%x\n",

				__func__, slot_mask);

			return -EINVAL;

		}

		break;

	default:

		pr_err("%s: invalid param channels %d\n",

			__func__, channels);

		return -EINVAL;

	}

	/* currently only supporting TDM_RX_0 and TDM_TX_0 */

	switch (cpu_dai->id) {

	case AFE_PORT_ID_PRIMARY_TDM_RX:

	case AFE_PORT_ID_SECONDARY_TDM_RX:

	case AFE_PORT_ID_TERTIARY_TDM_RX:

	case AFE_PORT_ID_QUATERNARY_TDM_RX:

	case AFE_PORT_ID_PRIMARY_TDM_TX:

	case AFE_PORT_ID_SECONDARY_TDM_TX:

	case AFE_PORT_ID_TERTIARY_TDM_TX:

	case AFE_PORT_ID_QUATERNARY_TDM_TX:

		slot_offset = tdm_slot_offset[TDM_0];

		break;

	default:

		pr_err("%s: dai id 0x%x not supported\n",

			__func__, cpu_dai->id);

		return -EINVAL;

	}



	for (i = 0; i < TDM_SLOT_OFFSET_MAX; i++) {

		if (slot_offset[i] != AFE_SLOT_MAPPING_OFFSET_INVALID)

			offset_channels++;

		else

			break;

	}



	if (offset_channels == 0) {

		pr_err("%s: slot offset not supported, offset_channels %d\n",

			__func__, offset_channels);

		return -EINVAL;

	}



	if (channels > offset_channels) {

		pr_err("%s: channels %d exceed offset_channels %d\n",

			__func__, channels, offset_channels);

		return -EINVAL;

	}



	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {

		ret = snd_soc_dai_set_tdm_slot(cpu_dai, 0, slot_mask,

					       slots, slot_width);

		if (ret < 0) {

			pr_err("%s: failed to set tdm slot, err:%d\n",

				__func__, ret);

			goto end;

		}



		ret = snd_soc_dai_set_channel_map(cpu_dai, 0, NULL,

						  channels, slot_offset);

		if (ret < 0) {

			pr_err("%s: failed to set channel map, err:%d\n",

				__func__, ret);

			goto end;

		}

	} else {

		ret = snd_soc_dai_set_tdm_slot(cpu_dai, slot_mask, 0,

					       slots, slot_width);

		if (ret < 0) {

			pr_err("%s: failed to set tdm slot, err:%d\n",

				__func__, ret);

			goto end;

		}



		ret = snd_soc_dai_set_channel_map(cpu_dai, channels,

						  slot_offset, 0, NULL);

		if (ret < 0) {

			pr_err("%s: failed to set channel map, err:%d\n",

				__func__, ret);

			goto end;

		}

	}

end:

	return ret;

}



static struct snd_soc_ops msm_tdm_be_ops = {

	.hw_params = msm_tdm_snd_hw_params

};



static struct snd_soc_dai_link msm_ext_tasha_fe_dai[] = {

	/* tasha_vifeedback for speaker protection */

	{
@@ -1167,6 +1387,145 @@ static struct snd_soc_dai_link msm_ext_common_be_dai[] = { 
		.be_hw_params_fixup = msm_ext_be_hw_params_fixup,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_USB_AUDIO_RX,

		.stream_name = "USB Audio Playback",

		.cpu_dai_name = "msm-dai-q6-dev.28672",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_USB_RX,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ignore_pmdown_time = 1,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_USB_AUDIO_TX,

		.stream_name = "USB Audio Capture",

		.cpu_dai_name = "msm-dai-q6-dev.28673",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_USB_TX,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_PRI_TDM_RX_0,

		.stream_name = "Primary TDM0 Playback",

		.cpu_dai_name = "msm-dai-q6-tdm.36864",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_PRI_TDM_RX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_PRI_TDM_TX_0,

		.stream_name = "Primary TDM0 Capture",

		.cpu_dai_name = "msm-dai-q6-tdm.36865",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_PRI_TDM_TX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_SEC_TDM_RX_0,

		.stream_name = "Secondary TDM0 Playback",

		.cpu_dai_name = "msm-dai-q6-tdm.36880",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_SEC_TDM_RX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_SEC_TDM_TX_0,

		.stream_name = "Secondary TDM0 Capture",

		.cpu_dai_name = "msm-dai-q6-tdm.36881",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_SEC_TDM_TX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_TERT_TDM_RX_0,

		.stream_name = "Tertiary TDM0 Playback",

		.cpu_dai_name = "msm-dai-q6-tdm.36896",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_TERT_TDM_RX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_TERT_TDM_TX_0,

		.stream_name = "Tertiary TDM0 Capture",

		.cpu_dai_name = "msm-dai-q6-tdm.36897",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_TERT_TDM_TX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_QUAT_TDM_RX_0,

		.stream_name = "Quaternary TDM0 Playback",

		.cpu_dai_name = "msm-dai-q6-tdm.36912",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_QUAT_TDM_RX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_QUAT_TDM_TX_0,

		.stream_name = "Quaternary TDM0 Capture",

		.cpu_dai_name = "msm-dai-q6-tdm.36913",

		.platform_name = "msm-pcm-routing",

		.codec_name = "msm-stub-codec.1",

		.codec_dai_name = "msm-stub-tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_QUAT_TDM_TX_0,

		.be_hw_params_fixup = msm_common_be_hw_params_fixup,

		.ops = &msm_tdm_be_ops,

		.ignore_suspend = 1,

	},

};



static struct snd_soc_dai_link msm_mi2s_be_dai_links[] = {
@@ -1415,13 +1774,66 @@ static struct snd_soc_dai_link msm_auxpcm_be_dai_links[] = { 
	},

};



static struct snd_soc_dai_link msm_wcn_be_dai_links[] = {

	{

		.name = LPASS_BE_SLIMBUS_7_RX,

		.stream_name = "Slimbus7 Playback",

		.cpu_dai_name = "msm-dai-q6-dev.16398",

		.platform_name = "msm-pcm-routing",

		.codec_name = "btfmslim_slave",

		/* BT codec driver determines capabilities based on

		 * dai name, bt codecdai name should always contains

		 * supported usecase information

		 */

		.codec_dai_name = "btfm_bt_sco_a2dp_slim_rx",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.be_id = MSM_BACKEND_DAI_SLIMBUS_7_RX,

		.be_hw_params_fixup = msm_ext_be_hw_params_fixup,

		.ops = &msm_wcn_ops,

		/* dai link has playback support */

		.ignore_pmdown_time = 1,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_SLIMBUS_7_TX,

		.stream_name = "Slimbus7 Capture",

		.cpu_dai_name = "msm-dai-q6-dev.16399",

		.platform_name = "msm-pcm-routing",

		.codec_name = "btfmslim_slave",

		.codec_dai_name = "btfm_bt_sco_slim_tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_SLIMBUS_7_TX,

		.be_hw_params_fixup = msm_ext_be_hw_params_fixup,

		.ops = &msm_wcn_ops,

		.ignore_suspend = 1,

	},

	{

		.name = LPASS_BE_SLIMBUS_8_TX,

		.stream_name = "Slimbus8 Capture",

		.cpu_dai_name = "msm-dai-q6-dev.16401",

		.platform_name = "msm-pcm-routing",

		.codec_name = "btfmslim_slave",

		.codec_dai_name = "btfm_fm_slim_tx",

		.no_pcm = 1,

		.dpcm_capture = 1,

		.be_id = MSM_BACKEND_DAI_SLIMBUS_8_TX,

		.be_hw_params_fixup = msm_ext_be_hw_params_fixup,

		.init = &msm_wcn_init,

		.ops = &msm_wcn_ops,

		.ignore_suspend = 1,

	},

};



static struct snd_soc_dai_link msm_ext_tasha_dai_links[

ARRAY_SIZE(msm_ext_common_fe_dai) +

ARRAY_SIZE(msm_ext_tasha_fe_dai) +

ARRAY_SIZE(msm_ext_common_be_dai) +

ARRAY_SIZE(msm_ext_tasha_be_dai) +

ARRAY_SIZE(msm_mi2s_be_dai_links) +

ARRAY_SIZE(msm_auxpcm_be_dai_links)];

ARRAY_SIZE(msm_auxpcm_be_dai_links) +

ARRAY_SIZE(msm_wcn_be_dai_links)];



static struct snd_soc_dai_link msm_ext_tavil_dai_links[

ARRAY_SIZE(msm_ext_common_fe_dai) +
@@ -1429,7 +1841,8 @@ ARRAY_SIZE(msm_ext_tavil_fe_dai) + 
ARRAY_SIZE(msm_ext_common_be_dai) +

ARRAY_SIZE(msm_ext_tavil_be_dai) +

ARRAY_SIZE(msm_mi2s_be_dai_links) +

ARRAY_SIZE(msm_auxpcm_be_dai_links)];

ARRAY_SIZE(msm_auxpcm_be_dai_links) +

ARRAY_SIZE(msm_wcn_be_dai_links)];



/**

 * populate_snd_card_dailinks - prepares dailink array and initializes card.
@@ -1484,6 +1897,14 @@ struct snd_soc_card *populate_snd_card_dailinks(struct device *dev) 
			       sizeof(msm_auxpcm_be_dai_links));

			len4 += ARRAY_SIZE(msm_auxpcm_be_dai_links);

		}

		if (of_property_read_bool(dev->of_node, "qcom,wcn-btfm")) {

			dev_dbg(dev, "%s(): WCN BTFM support present\n",

					__func__);

			memcpy(msm_ext_tasha_dai_links + len4,

				   msm_wcn_be_dai_links,

				   sizeof(msm_wcn_be_dai_links));

			len4 += ARRAY_SIZE(msm_wcn_be_dai_links);

		}

		msm_ext_dai_links = msm_ext_tasha_dai_links;

	} else if (strnstr(card->name, "tavil", strlen(card->name))) {

		len1 = ARRAY_SIZE(msm_ext_common_fe_dai);
@@ -1512,6 +1933,14 @@ struct snd_soc_card *populate_snd_card_dailinks(struct device *dev) 
			       sizeof(msm_auxpcm_be_dai_links));

			len4 += ARRAY_SIZE(msm_auxpcm_be_dai_links);

		}

		if (of_property_read_bool(dev->of_node, "qcom,wcn-btfm")) {

			dev_dbg(dev, "%s(): WCN BTFM support present\n",

					__func__);

			memcpy(msm_ext_tavil_dai_links + len4,

				   msm_wcn_be_dai_links,

				   sizeof(msm_wcn_be_dai_links));

			len4 += ARRAY_SIZE(msm_wcn_be_dai_links);

		}

		msm_ext_dai_links = msm_ext_tavil_dai_links;

	} else {

		dev_err(dev, "%s: failing as no matching card name\n",

sound/soc/msm/msmfalcon-external.c

+58 −0
Original line number Diff line number Diff line
@@ -122,6 +122,7 @@ static char const *slim_sample_rate_text[] = {"KHZ_8", "KHZ_16", 
					"KHZ_88P2", "KHZ_96", "KHZ_176P4",

					"KHZ_192", "KHZ_352P8", "KHZ_384"};

static const char *const spk_function_text[] = {"Off", "On"};

static char const *bt_sample_rate_text[] = {"KHZ_8", "KHZ_16", "KHZ_48"};



static SOC_ENUM_SINGLE_EXT_DECL(spk_func_en, spk_function_text);

static SOC_ENUM_SINGLE_EXT_DECL(slim_0_rx_chs, slim_rx_ch_text);
@@ -140,6 +141,7 @@ static SOC_ENUM_SINGLE_EXT_DECL(slim_2_rx_sample_rate, slim_sample_rate_text); 
static SOC_ENUM_SINGLE_EXT_DECL(slim_0_tx_sample_rate, slim_sample_rate_text);

static SOC_ENUM_SINGLE_EXT_DECL(slim_5_rx_sample_rate, slim_sample_rate_text);

static SOC_ENUM_SINGLE_EXT_DECL(slim_6_rx_sample_rate, slim_sample_rate_text);

static SOC_ENUM_SINGLE_EXT_DECL(bt_sample_rate, bt_sample_rate_text);



static int slim_get_sample_rate_val(int sample_rate)

{
@@ -302,6 +304,59 @@ static int slim_get_port_idx(struct snd_kcontrol *kcontrol) 
	return port_id;

}



static int msm_bt_sample_rate_get(struct snd_kcontrol *kcontrol,

				  struct snd_ctl_elem_value *ucontrol)

{

	/*

	 * Slimbus_7_Rx/Tx sample rate values should always be in sync (same)

	 * when used for BT_SCO use case. Return either Rx or Tx sample rate

	 * value.

	 */

	switch (slim_rx_cfg[SLIM_RX_7].sample_rate) {

	case SAMPLING_RATE_48KHZ:

		ucontrol->value.integer.value[0] = 2;

		break;

	case SAMPLING_RATE_16KHZ:

		ucontrol->value.integer.value[0] = 1;

		break;

	case SAMPLING_RATE_8KHZ:

	default:

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

		break;

	}

	pr_debug("%s: sample rate = %d", __func__,

		 slim_rx_cfg[SLIM_RX_7].sample_rate);



	return 0;

}



static int msm_bt_sample_rate_put(struct snd_kcontrol *kcontrol,

				  struct snd_ctl_elem_value *ucontrol)

{

	switch (ucontrol->value.integer.value[0]) {

	case 1:

		slim_rx_cfg[SLIM_RX_7].sample_rate = SAMPLING_RATE_16KHZ;

		slim_tx_cfg[SLIM_TX_7].sample_rate = SAMPLING_RATE_16KHZ;

		break;

	case 2:

		slim_rx_cfg[SLIM_RX_7].sample_rate = SAMPLING_RATE_48KHZ;

		slim_tx_cfg[SLIM_TX_7].sample_rate = SAMPLING_RATE_48KHZ;

		break;

	case 0:

	default:

		slim_rx_cfg[SLIM_RX_7].sample_rate = SAMPLING_RATE_8KHZ;

		slim_tx_cfg[SLIM_TX_7].sample_rate = SAMPLING_RATE_8KHZ;

		break;

	}

	pr_debug("%s: sample rates: slim7_rx = %d, slim7_tx = %d, value = %d\n",

		 __func__,

		 slim_rx_cfg[SLIM_RX_7].sample_rate,

		 slim_tx_cfg[SLIM_TX_7].sample_rate,

		 ucontrol->value.enumerated.item[0]);



	return 0;

}



static int slim_rx_sample_rate_get(struct snd_kcontrol *kcontrol,

				   struct snd_ctl_elem_value *ucontrol)

{
@@ -670,6 +725,9 @@ static const struct snd_kcontrol_new msm_snd_controls[] = { 
			slim_rx_sample_rate_get, slim_rx_sample_rate_put),

	SOC_ENUM_EXT("SLIM_6_RX SampleRate", slim_6_rx_sample_rate,

			slim_rx_sample_rate_get, slim_rx_sample_rate_put),

	SOC_ENUM_EXT("BT SampleRate", bt_sample_rate,

			msm_bt_sample_rate_get,

			msm_bt_sample_rate_put),

};



static int msm_slim_get_ch_from_beid(int32_t be_id)

sound/soc/msm/msmfalcon-internal.c

+519 −2

File changed.

Preview size limit exceeded, changes collapsed.