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

Commit c0ccfd3b authored by Shuai Zhang's avatar Shuai Zhang
Browse files

ASOC: update sm6150 machine driver 



Update machine driver for wcd937x.
Add msm_wcd937x_wsa881x_init for wcd937x.
Add msm_snd_card_late_probe for wcd937x.

Change-Id: Ic4c32e2f4c894c0bd250d1ae1c44ac1d8a28f6d1
Signed-off-by: default avatarShuai Zhang <quic_shuzhan@quicinc.com>
parent f374586d

asoc/sm6150.c

+126 −8
Original line number Diff line number Diff line
@@ -31,6 +31,7 @@ 
#include <asoc/msm-cdc-pinctrl.h>

#include "codecs/wcd934x/wcd934x.h"

#include "codecs/wcd9335.h"

#include "asoc/wcd-mbhc-v2.h"

#include "codecs/wcd934x/wcd934x-mbhc.h"

#include "codecs/wcd937x/wcd937x-mbhc.h"

#include "codecs/wsa881x.h"
@@ -40,6 +41,7 @@ 
#include "codecs/wcd937x/wcd937x.h"

#include "msm_talos_dailink.h"

#include "talos-port-config.h"

#include <soc/soundwire.h>



#define DRV_NAME "sm6150-asoc-snd"
@@ -629,7 +631,9 @@ static int dmic_2_3_gpio_cnt; 
static void *def_wcd_mbhc_cal(void);

static int msm_snd_enable_codec_ext_clk(struct snd_soc_component *component,

					int enable, bool dapm);

static int msm_rx_tx_codec_init(struct snd_soc_pcm_runtime*);

static int msm_wsa881x_init(struct snd_soc_pcm_runtime *rtd);

static int msm_wcd937x_wsa881x_init(struct snd_soc_pcm_runtime *rtd);



/*

 * Need to report LINEIN
@@ -5137,15 +5141,23 @@ static int msm_rx_tx_codec_init(struct snd_soc_pcm_runtime *rtd) 


	snd_soc_dapm_sync(dapm);



	snd_soc_dapm_ignore_suspend(dapm, "EAR");

	snd_soc_dapm_ignore_suspend(dapm, "AUX");

	snd_soc_dapm_ignore_suspend(dapm, "HPHL");

	snd_soc_dapm_ignore_suspend(dapm, "HPHR");

	snd_soc_dapm_ignore_suspend(dapm, "AMIC1");

	snd_soc_dapm_ignore_suspend(dapm, "AMIC2");

	snd_soc_dapm_ignore_suspend(dapm, "AMIC3");

	snd_soc_dapm_ignore_suspend(dapm, "AMIC4");

	snd_soc_dapm_sync(dapm);



	/*

	 * Send speaker configuration only for WSA8810.

	 * Default configuration is for WSA8815.

	 */



	wsa_macro_set_spkr_mode(component,

			WSA_MACRO_SPKR_MODE_1);

	wsa_macro_set_spkr_gain_offset(component,

			WSA_MACRO_GAIN_OFFSET_M1P5_DB);

			WSA_MACRO_SPKR_MODE_DEFAULT);



	card = rtd->card->snd_card;

	if (!pdata->codec_root) {
@@ -5170,7 +5182,7 @@ static int msm_rx_tx_codec_init(struct snd_soc_pcm_runtime *rtd) 
	bolero_register_wake_irq(component, false);



	bolero_set_port_map(bolero_component,

				ARRAY_SIZE(sm_port_map), sm_port_map);

				ARRAY_SIZE(sm_port_map_wcd937x), sm_port_map_wcd937x);



	codec_reg_done = true;

	return 0;
@@ -7492,7 +7504,7 @@ static struct snd_soc_dai_link msm_wsa_cdc_dma_be_dai_links[] = { 
		.stream_name = "WSA CDC DMA0 Playback",

		.no_pcm = 1,

		.dpcm_playback = 1,

		.init = &msm_wsa881x_init,

		.init = &msm_wcd937x_wsa881x_init,

		.id = MSM_BACKEND_DAI_WSA_CDC_DMA_RX_0,

		.be_hw_params_fixup = msm_be_hw_params_fixup,

		.ignore_pmdown_time = 1,
@@ -7720,6 +7732,46 @@ static int msm_snd_card_tasha_late_probe(struct snd_soc_card *card) 
	return ret;

}



static int msm_snd_card_late_probe(struct snd_soc_card *card)

{

	struct snd_soc_component *component = NULL;

	const char *be_dl_name = LPASS_BE_RX_CDC_DMA_RX_0;

	struct snd_soc_pcm_runtime *rtd;

	int ret = 0;

	void *mbhc_calibration;



	rtd = snd_soc_get_pcm_runtime(card, be_dl_name);

	if (!rtd) {

		dev_err(card->dev,

			"%s: snd_soc_get_pcm_runtime for %s failed!\n",

			__func__, be_dl_name);

		ret = -EINVAL;

	}



	component = snd_soc_rtdcom_lookup(rtd, WCD937X_DRV_NAME);

	if (!component) {

		pr_err("%s: component is NULL\n", __func__);

		ret = -EINVAL;

	}



	mbhc_calibration = def_wcd_mbhc_cal();

	if (!mbhc_calibration) {

		ret = -ENOMEM;

	}

	wcd_mbhc_cfg.calibration = mbhc_calibration;

	ret = wcd937x_mbhc_hs_detect(component, &wcd_mbhc_cfg);

	if (ret) {

		dev_err(card->dev, "%s: mbhc hs detect failed, err:%d\n",

			__func__, ret);

		goto err_hs_detect;

	}

	return 0;



err_hs_detect:

	kfree(mbhc_calibration);

	return ret;

}



static int msm_populate_dai_link_component_of_node(

					struct snd_soc_card *card)

{
@@ -8045,6 +8097,8 @@ static struct snd_soc_card *populate_snd_card_dailinks(struct device *dev) 
			total_links +=

				ARRAY_SIZE(msm_tasha_fe_dai_links);

		} else {

			card->late_probe =

				msm_snd_card_late_probe;

			memcpy(msm_sm6150_dai_links + total_links,

				msm_bolero_fe_dai_links,

				sizeof(msm_bolero_fe_dai_links));
@@ -8186,7 +8240,8 @@ static int msm_wsa881x_init(struct snd_soc_pcm_runtime *rtd) 
						SPKR_L_BOOST, SPKR_L_VI};

	u8 spkright_port_types[WSA881X_MAX_SWR_PORTS] = {SPKR_R, SPKR_R_COMP,

						SPKR_R_BOOST, SPKR_R_VI};

	unsigned int ch_rate[WSA881X_MAX_SWR_PORTS] = {2400, 600, 300, 1200};

	unsigned int ch_rate[WSA881X_MAX_SWR_PORTS] = {SWR_CLK_RATE_2P4MHZ, SWR_CLK_RATE_0P6MHZ,

							SWR_CLK_RATE_0P3MHZ, SWR_CLK_RATE_1P2MHZ};

	unsigned int ch_mask[WSA881X_MAX_SWR_PORTS] = {0x1, 0xF, 0x3, 0x3};

	struct snd_soc_component *component = NULL;

	struct msm_asoc_mach_data *pdata =
@@ -8237,6 +8292,69 @@ static int msm_wsa881x_init(struct snd_soc_pcm_runtime *rtd) 


	return 0;

}



static int msm_wcd937x_wsa881x_init(struct snd_soc_pcm_runtime *rtd)

{

	u8 spkleft_ports[WSA881X_MAX_SWR_PORTS] = {0, 1, 2, 3};

	u8 spkright_ports[WSA881X_MAX_SWR_PORTS] = {0, 1, 2, 3};

	u8 spkleft_port_types[WSA881X_MAX_SWR_PORTS] = {SPKR_L, SPKR_L_COMP,

						SPKR_L_BOOST, SPKR_L_VI};

	u8 spkright_port_types[WSA881X_MAX_SWR_PORTS] = {SPKR_R, SPKR_R_COMP,

						SPKR_R_BOOST, SPKR_R_VI};

	unsigned int ch_rate[WSA881X_MAX_SWR_PORTS] = {SWR_CLK_RATE_2P4MHZ, SWR_CLK_RATE_0P6MHZ,

							SWR_CLK_RATE_0P3MHZ, SWR_CLK_RATE_1P2MHZ};

	unsigned int ch_mask[WSA881X_MAX_SWR_PORTS] = {0x1, 0xF, 0x3, 0x3};

	struct snd_soc_component *component = NULL;

	struct msm_asoc_mach_data *pdata =

					snd_soc_card_get_drvdata(rtd->card);

	struct snd_soc_dapm_context *dapm = NULL;





	if (pdata->wsa_max_devs > 0) {

			component = snd_soc_rtdcom_lookup(rtd, "wsa-codec.3");

		if (!component) {

			pr_err("%s: wsa-codec.3 component is NULL\n", __func__);

			return -EINVAL;

		}



		dapm = snd_soc_component_get_dapm(component);



		wsa881x_set_channel_map(component, &spkleft_ports[0],

				WSA881X_MAX_SWR_PORTS, &ch_mask[0],

				&ch_rate[0], &spkleft_port_types[0]);

		if (dapm->component) {

			snd_soc_dapm_ignore_suspend(dapm, "SpkrLeft IN");

			snd_soc_dapm_ignore_suspend(dapm, "SpkrLeft SPKR");

		}

		wsa881x_codec_info_create_codec_entry(pdata->codec_root,

						      component);

	}



	/* If current platform has more than one WSA */

	if (pdata->wsa_max_devs > 1) {

			component = snd_soc_rtdcom_lookup(rtd, "wsa-codec.4");

		if (!component) {

			pr_err("%s: wsa-codec.4 component is NULL\n", __func__);

			return -EINVAL;

		}



		dapm = snd_soc_component_get_dapm(component);



		wsa881x_set_channel_map(component, &spkright_ports[0],

				WSA881X_MAX_SWR_PORTS, &ch_mask[0],

				&ch_rate[0], &spkright_port_types[0]);

		if (dapm->component) {

			snd_soc_dapm_ignore_suspend(dapm, "SpkrRight IN");

			snd_soc_dapm_ignore_suspend(dapm, "SpkrRight SPKR");

		}

		wsa881x_codec_info_create_codec_entry(pdata->codec_root,

						      component);

	}



	return 0;

}





static void msm_i2s_auxpcm_init(struct platform_device *pdev)

{

	int count;