Merge "ASoC: sdm845: Add mixer controls for MI2S bit format" (4a9a5655) · Commits · e / devices / android_kernel_fairphone_FP3

sound/soc/msm/sdm845.c

+155 −0

Original line number	Diff line number	Diff line
		@@ -493,6 +493,8 @@ static SOC_ENUM_SINGLE_EXT_DECL(tert_mi2s_rx_chs, mi2s_ch_text);
		static SOC_ENUM_SINGLE_EXT_DECL(tert_mi2s_tx_chs, mi2s_ch_text);
		static SOC_ENUM_SINGLE_EXT_DECL(quat_mi2s_rx_chs, mi2s_ch_text);
		static SOC_ENUM_SINGLE_EXT_DECL(quat_mi2s_tx_chs, mi2s_ch_text);
		static SOC_ENUM_SINGLE_EXT_DECL(mi2s_rx_format, bit_format_text);
		static SOC_ENUM_SINGLE_EXT_DECL(mi2s_tx_format, bit_format_text);
		static SOC_ENUM_SINGLE_EXT_DECL(hifi_function, hifi_text);

		static struct platform_device *spdev;
		@@ -2250,6 +2252,54 @@ static int mi2s_get_sample_rate(int value)
		return sample_rate;
		}

		static int mi2s_get_format(int value)
		{
		int format;

		switch (value) {
		case 0:
		format = SNDRV_PCM_FORMAT_S16_LE;
		break;
		case 1:
		format = SNDRV_PCM_FORMAT_S24_LE;
		break;
		case 2:
		format = SNDRV_PCM_FORMAT_S24_3LE;
		break;
		case 3:
		format = SNDRV_PCM_FORMAT_S32_LE;
		break;
		default:
		format = SNDRV_PCM_FORMAT_S16_LE;
		break;
		}
		return format;
		}

		static int mi2s_get_format_value(int format)
		{
		int value;

		switch (format) {
		case SNDRV_PCM_FORMAT_S16_LE:
		value = 0;
		break;
		case SNDRV_PCM_FORMAT_S24_LE:
		value = 1;
		break;
		case SNDRV_PCM_FORMAT_S24_3LE:
		value = 2;
		break;
		case SNDRV_PCM_FORMAT_S32_LE:
		value = 3;
		break;
		default:
		value = 0;
		break;
		}
		return value;
		}

		static int mi2s_rx_sample_rate_put(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		@@ -2382,6 +2432,78 @@ static int msm_mi2s_tx_ch_put(struct snd_kcontrol *kcontrol,
		return 1;
		}

		static int msm_mi2s_rx_format_get(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		int idx = mi2s_get_port_idx(kcontrol);

		if (idx < 0)
		return idx;

		ucontrol->value.enumerated.item[0] =
		mi2s_get_format_value(mi2s_rx_cfg[idx].bit_format);

		pr_debug("%s: idx[%d]_rx_format = %d, item = %d\n", __func__,
		idx, mi2s_rx_cfg[idx].bit_format,
		ucontrol->value.enumerated.item[0]);

		return 0;
		}

		static int msm_mi2s_rx_format_put(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		int idx = mi2s_get_port_idx(kcontrol);

		if (idx < 0)
		return idx;

		mi2s_rx_cfg[idx].bit_format =
		mi2s_get_format(ucontrol->value.enumerated.item[0]);

		pr_debug("%s: idx[%d]_rx_format = %d, item = %d\n", __func__,
		idx, mi2s_rx_cfg[idx].bit_format,
		ucontrol->value.enumerated.item[0]);

		return 0;
		}

		static int msm_mi2s_tx_format_get(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		int idx = mi2s_get_port_idx(kcontrol);

		if (idx < 0)
		return idx;

		ucontrol->value.enumerated.item[0] =
		mi2s_get_format_value(mi2s_tx_cfg[idx].bit_format);

		pr_debug("%s: idx[%d]_tx_format = %d, item = %d\n", __func__,
		idx, mi2s_tx_cfg[idx].bit_format,
		ucontrol->value.enumerated.item[0]);

		return 0;
		}

		static int msm_mi2s_tx_format_put(struct snd_kcontrol *kcontrol,
		struct snd_ctl_elem_value *ucontrol)
		{
		int idx = mi2s_get_port_idx(kcontrol);

		if (idx < 0)
		return idx;

		mi2s_tx_cfg[idx].bit_format =
		mi2s_get_format(ucontrol->value.enumerated.item[0]);

		pr_debug("%s: idx[%d]_tx_format = %d, item = %d\n", __func__,
		idx, mi2s_tx_cfg[idx].bit_format,
		ucontrol->value.enumerated.item[0]);

		return 0;
		}

		static int msm_hifi_ctrl(struct snd_soc_codec *codec)
		{
		struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec);
		@@ -2627,6 +2749,22 @@ static const struct snd_kcontrol_new msm_snd_controls[] = {
		msm_mi2s_rx_ch_get, msm_mi2s_rx_ch_put),
		SOC_ENUM_EXT("QUAT_MI2S_TX Channels", quat_mi2s_tx_chs,
		msm_mi2s_tx_ch_get, msm_mi2s_tx_ch_put),
		SOC_ENUM_EXT("PRIM_MI2S_RX Format", mi2s_rx_format,
		msm_mi2s_rx_format_get, msm_mi2s_rx_format_put),
		SOC_ENUM_EXT("PRIM_MI2S_TX Format", mi2s_tx_format,
		msm_mi2s_tx_format_get, msm_mi2s_tx_format_put),
		SOC_ENUM_EXT("SEC_MI2S_RX Format", mi2s_rx_format,
		msm_mi2s_rx_format_get, msm_mi2s_rx_format_put),
		SOC_ENUM_EXT("SEC_MI2S_TX Format", mi2s_tx_format,
		msm_mi2s_tx_format_get, msm_mi2s_tx_format_put),
		SOC_ENUM_EXT("TERT_MI2S_RX Format", mi2s_rx_format,
		msm_mi2s_rx_format_get, msm_mi2s_rx_format_put),
		SOC_ENUM_EXT("TERT_MI2S_TX Format", mi2s_tx_format,
		msm_mi2s_tx_format_get, msm_mi2s_tx_format_put),
		SOC_ENUM_EXT("QUAT_MI2S_RX Format", mi2s_rx_format,
		msm_mi2s_rx_format_get, msm_mi2s_rx_format_put),
		SOC_ENUM_EXT("QUAT_MI2S_TX Format", mi2s_tx_format,
		msm_mi2s_tx_format_get, msm_mi2s_tx_format_put),
		SOC_ENUM_EXT("HiFi Function", hifi_function, msm_hifi_get,
		msm_hifi_put),
		};
		@@ -3052,48 +3190,64 @@ static int msm_be_hw_params_fixup(struct snd_soc_pcm_runtime *rtd,
		break;

		case MSM_BACKEND_DAI_PRI_MI2S_RX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_rx_cfg[PRIM_MI2S].bit_format);
		rate->min = rate->max = mi2s_rx_cfg[PRIM_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_rx_cfg[PRIM_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_PRI_MI2S_TX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_tx_cfg[PRIM_MI2S].bit_format);
		rate->min = rate->max = mi2s_tx_cfg[PRIM_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_tx_cfg[PRIM_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_SECONDARY_MI2S_RX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_rx_cfg[SEC_MI2S].bit_format);
		rate->min = rate->max = mi2s_rx_cfg[SEC_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_rx_cfg[SEC_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_SECONDARY_MI2S_TX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_tx_cfg[SEC_MI2S].bit_format);
		rate->min = rate->max = mi2s_tx_cfg[SEC_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_tx_cfg[SEC_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_TERTIARY_MI2S_RX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_rx_cfg[TERT_MI2S].bit_format);
		rate->min = rate->max = mi2s_rx_cfg[TERT_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_rx_cfg[TERT_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_TERTIARY_MI2S_TX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_tx_cfg[TERT_MI2S].bit_format);
		rate->min = rate->max = mi2s_tx_cfg[TERT_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_tx_cfg[TERT_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_QUATERNARY_MI2S_RX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_rx_cfg[QUAT_MI2S].bit_format);
		rate->min = rate->max = mi2s_rx_cfg[QUAT_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_rx_cfg[QUAT_MI2S].channels;
		break;

		case MSM_BACKEND_DAI_QUATERNARY_MI2S_TX:
		param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT,
		mi2s_tx_cfg[QUAT_MI2S].bit_format);
		rate->min = rate->max = mi2s_tx_cfg[QUAT_MI2S].sample_rate;
		channels->min = channels->max =
		mi2s_tx_cfg[QUAT_MI2S].channels;
		@@ -3855,6 +4009,7 @@ static u32 get_mi2s_bits_per_sample(u32 bit_format)
		u32 bit_per_sample;

		switch (bit_format) {
		case SNDRV_PCM_FORMAT_S32_LE:
		case SNDRV_PCM_FORMAT_S24_3LE:
		case SNDRV_PCM_FORMAT_S24_LE:
		bit_per_sample = 32;