/* Copyright (c) 2014-2015, The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "../codecs/wcd9xxx-common.h" #include "../codecs/wcd9335.h" #include "../codecs/wsa881x.h" /* Spk control */ #define MDM_SPK_ON 1 #define MDM_HIFI_ON 1 #define WCD9XXX_MBHC_DEF_BUTTONS 8 #define WCD9XXX_MBHC_DEF_RLOADS 5 /* * MDM9650 run Tasha at 12.288 Mhz. * At present MDM supports 12.288mhz * only. Tasha supports 9.6 MHz also. */ #define MDM_MCLK_CLK_12P288MHZ 12288000 #define MDM_MCLK_CLK_9P6HZ 9600000 #define MDM_MI2S_RATE 48000 #define SAMPLE_RATE_8KHZ 8000 #define SAMPLE_RATE_16KHZ 16000 #define SAMPLE_RATE_48KHZ 48000 #define NO_OF_BITS_PER_SAMPLE 16 #define LPAIF_OFFSET 0x07700000 #define LPAIF_PRI_MODE_MUXSEL (LPAIF_OFFSET + 0x2008) #define LPAIF_SEC_MODE_MUXSEL (LPAIF_OFFSET + 0x200c) #define LPASS_CSR_GP_IO_MUX_SPKR_CTL (LPAIF_OFFSET + 0x2004) #define I2S_SEL 0 #define I2S_PCM_SEL 1 #define I2S_PCM_SEL_OFFSET 1 #define TLMM_SCLK_EN 0x4 #define CLOCK_ON 1 #define CLOCK_OFF 0 /* Machine driver Name*/ #define DRV_NAME "mdm9650-asoc-tasha" enum mi2s_pcm_mux { PRI_MI2S_PCM = 1, SEC_MI2S_PCM, }; struct mdm_machine_data { u32 mclk_freq; u32 prim_clk_usrs; int hph_en1_gpio; int hph_en0_gpio; struct snd_info_entry *codec_root; }; static const struct afe_clk_cfg lpass_default = { AFE_API_VERSION_I2S_CONFIG, Q6AFE_LPASS_IBIT_CLK_1_P536_MHZ, Q6AFE_LPASS_OSR_CLK_12_P288_MHZ, Q6AFE_LPASS_CLK_SRC_INTERNAL, Q6AFE_LPASS_CLK_ROOT_DEFAULT, Q6AFE_LPASS_MODE_BOTH_VALID, 0, }; static int mdm_auxpcm_rate = 8000; static void *lpaif_pri_muxsel_virt_addr; static void *lpass_gpio_mux_spkr_ctl_virt_addr; static struct mutex cdc_mclk_mutex; static int mdm_mi2s_rx_ch = 1; static int mdm_mi2s_tx_ch = 1; static int mdm_mi2s_rx_rate = SAMPLE_RATE_48KHZ; static int mdm_mi2s_tx_rate = SAMPLE_RATE_48KHZ; static int mdm_spk_control = 1; static int mdm_hifi_control; static atomic_t aux_ref_count; static atomic_t mi2s_ref_count; static int mdm_enable_codec_ext_clk(struct snd_soc_codec *codec, int enable, bool dapm); static void *def_tasha_mbhc_cal(void); static void *adsp_state_notifier; static struct wcd_mbhc_config wcd_mbhc_cfg = { .read_fw_bin = false, .calibration = NULL, .detect_extn_cable = true, .mono_stero_detection = false, .swap_gnd_mic = NULL, .hs_ext_micbias = true, }; static int mdm_mi2s_clk_ctl(struct snd_soc_pcm_runtime *rtd, bool enable) { struct snd_soc_card *card = rtd->card; struct mdm_machine_data *pdata = snd_soc_card_get_drvdata(card); struct afe_clk_cfg *lpass_clk = NULL; int ret = 0; if (pdata == NULL) { pr_err("%s:platform data is null\n", __func__); ret = -ENOMEM; goto done; } lpass_clk = kzalloc(sizeof(struct afe_clk_cfg), GFP_KERNEL); if (!lpass_clk) { ret = -ENOMEM; goto done; } memcpy(lpass_clk, &lpass_default, sizeof(struct afe_clk_cfg)); pr_debug("%s enable = %x\n", __func__, enable); if (enable) { lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_CLK1_VALID; ret = afe_set_lpass_clock(MI2S_RX, lpass_clk); if (ret < 0) pr_err("%s:afe_set_lpass_clock failed\n", __func__); } else { lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_CLK1_VALID; lpass_clk->clk_val1 = Q6AFE_LPASS_IBIT_CLK_DISABLE; ret = afe_set_lpass_clock(MI2S_RX, lpass_clk); if (ret < 0) pr_err("%s:afe_set_lpass_clock failed\n", __func__); } pr_debug("%s clk 1 = %x clk2 = %x mode = %x\n", __func__, lpass_clk->clk_val1, lpass_clk->clk_val2, lpass_clk->clk_set_mode); kfree(lpass_clk); done: return ret; } static void mdm_mi2s_shutdown(struct snd_pcm_substream *substream) { struct snd_soc_pcm_runtime *rtd = substream->private_data; int ret; if (atomic_dec_return(&mi2s_ref_count) == 0) { ret = mdm_mi2s_clk_ctl(rtd, false); if (ret < 0) pr_err("%s Clock disable failed\n", __func__); } } static int mdm_mi2s_startup(struct snd_pcm_substream *substream) { struct snd_soc_pcm_runtime *rtd = substream->private_data; struct snd_soc_dai *cpu_dai = rtd->cpu_dai; struct snd_soc_dai *codec_dai = rtd->codec_dai; int ret = 0; if (atomic_inc_return(&mi2s_ref_count) == 1) { if (lpaif_pri_muxsel_virt_addr != NULL) { ret = afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_ON); if (ret < 0) { ret = -EINVAL; goto done; } iowrite32(I2S_SEL << I2S_PCM_SEL_OFFSET, lpaif_pri_muxsel_virt_addr); if (lpass_gpio_mux_spkr_ctl_virt_addr != NULL) { iowrite32(TLMM_SCLK_EN, lpass_gpio_mux_spkr_ctl_virt_addr); afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); } else { pr_err("%s: mux spkr ctl virt addr is NULL\n", __func__); afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); ret = -EINVAL; goto done; } } else { pr_err("%s lpaif_pri_muxsel_virt_addr is NULL\n", __func__); ret = -EINVAL; goto done; } ret = mdm_mi2s_clk_ctl(rtd, true); if (ret < 0) { pr_err("%s clock enable failed\n", __func__); goto done; } /* * This sets the CONFIG PARAMETER WS_SRC. * 1 means internal clock master mode. * 0 means external clock slave mode. */ ret = snd_soc_dai_set_fmt(cpu_dai, SND_SOC_DAIFMT_CBS_CFS); if (ret < 0) { pr_err("%s Set fmt for cpu dai failed\n", __func__); goto done; } ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_CBS_CFS); if (ret < 0) pr_err("%s Set fmt for codec dai failed\n", __func__); } done: return ret; } static struct snd_soc_ops mdm_mi2s_be_ops = { .startup = mdm_mi2s_startup, .shutdown = mdm_mi2s_shutdown, }; static int mdm_mi2s_rx_rate_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: mdm_i2s_rate = %d", __func__, mdm_mi2s_rx_rate); ucontrol->value.integer.value[0] = mdm_mi2s_rx_rate; return 0; } static int mdm_mi2s_rx_rate_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { switch (ucontrol->value.integer.value[0]) { case 0: mdm_mi2s_rx_rate = SAMPLE_RATE_8KHZ; break; case 1: mdm_mi2s_rx_rate = SAMPLE_RATE_16KHZ; break; case 2: mdm_mi2s_rx_rate = SAMPLE_RATE_48KHZ; break; default: mdm_mi2s_rx_rate = SAMPLE_RATE_8KHZ; break; } pr_debug("%s: mdm_i2s_rx_rate = %d ucontrol->value = %d\n", __func__, mdm_mi2s_rx_rate, (int)ucontrol->value.integer.value[0]); return 0; } static int mdm_mi2s_tx_rate_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: mdm_i2s_rate = %d", __func__, mdm_mi2s_tx_rate); ucontrol->value.integer.value[0] = mdm_mi2s_tx_rate; return 0; } static int mdm_mi2s_tx_rate_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { switch (ucontrol->value.integer.value[0]) { case 0: mdm_mi2s_tx_rate = SAMPLE_RATE_8KHZ; break; case 1: mdm_mi2s_tx_rate = SAMPLE_RATE_16KHZ; break; case 2: mdm_mi2s_tx_rate = SAMPLE_RATE_48KHZ; break; default: mdm_mi2s_tx_rate = SAMPLE_RATE_8KHZ; break; } pr_debug("%s: mdm_i2s_tx_rate = %d ucontrol->value = %d\n", __func__, mdm_mi2s_tx_rate, (int)ucontrol->value.integer.value[0]); return 0; } static int mdm_mi2s_rx_be_hw_params_fixup(struct snd_soc_pcm_runtime *rt, struct snd_pcm_hw_params *params) { struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); struct snd_interval *channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); rate->min = rate->max = mdm_mi2s_rx_rate; channels->min = channels->max = mdm_mi2s_rx_ch; return 0; } static int mdm_mi2s_tx_be_hw_params_fixup(struct snd_soc_pcm_runtime *rt, struct snd_pcm_hw_params *params) { struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); struct snd_interval *channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); rate->min = rate->max = mdm_mi2s_tx_rate; channels->min = channels->max = mdm_mi2s_tx_ch; return 0; } static int mdm_be_hw_params_fixup(struct snd_soc_pcm_runtime *rt, struct snd_pcm_hw_params *params) { struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); rate->min = rate->max = MDM_MI2S_RATE; return 0; } static int mdm_mi2s_rx_ch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s mdm_mi2s_rx_ch %d\n", __func__, mdm_mi2s_rx_ch); ucontrol->value.integer.value[0] = mdm_mi2s_rx_ch - 1; return 0; } static int mdm_mi2s_rx_ch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { mdm_mi2s_rx_ch = ucontrol->value.integer.value[0] + 1; pr_debug("%s mdm_mi2s_rx_ch %d\n", __func__, mdm_mi2s_rx_ch); return 1; } static int mdm_mi2s_tx_ch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s mdm_mi2s_tx_ch %d\n", __func__, mdm_mi2s_tx_ch); ucontrol->value.integer.value[0] = mdm_mi2s_tx_ch - 1; return 0; } static int mdm_mi2s_tx_ch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { mdm_mi2s_tx_ch = ucontrol->value.integer.value[0] + 1; pr_debug("%s mdm_mi2s_tx_ch %d\n", __func__, mdm_mi2s_tx_ch); return 1; } static int mdm_mi2s_get_spk(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s mdm_spk_control %d", __func__, mdm_spk_control); ucontrol->value.integer.value[0] = mdm_spk_control; return 0; } static void mdm_ext_control(struct snd_soc_codec *codec) { struct snd_soc_dapm_context *dapm = &codec->dapm; pr_debug("%s mdm_spk_control %d", __func__, mdm_spk_control); mutex_lock(&codec->mutex); if (mdm_spk_control == MDM_SPK_ON) { snd_soc_dapm_enable_pin(dapm, "Lineout_1 amp"); snd_soc_dapm_enable_pin(dapm, "Lineout_2 amp"); } else { snd_soc_dapm_disable_pin(dapm, "Lineout_1 amp"); snd_soc_dapm_disable_pin(dapm, "Lineout_2 amp"); } mutex_unlock(&codec->mutex); snd_soc_dapm_sync(dapm); } static int mdm_mi2s_set_spk(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_kcontrol_chip(kcontrol); pr_debug("%s()\n", __func__); if (mdm_spk_control == ucontrol->value.integer.value[0]) return 0; mdm_spk_control = ucontrol->value.integer.value[0]; mdm_ext_control(codec); return 1; } static int mdm_hifi_ctrl(struct snd_soc_codec *codec) { struct snd_soc_dapm_context *dapm = &codec->dapm; struct snd_soc_card *card = codec->component.card; struct mdm_machine_data *pdata = snd_soc_card_get_drvdata(card); pr_debug("%s: mdm_hifi_control = %d", __func__, mdm_hifi_control); if (pdata->hph_en1_gpio < 0) { pr_err("%s: hph_en1_gpio is invalid\n", __func__); return -EINVAL; } mutex_lock(&codec->mutex); if (mdm_hifi_control == MDM_HIFI_ON) { gpio_direction_output(pdata->hph_en1_gpio, 1); /* 5msec delay needed as per HW requirement */ usleep_range(5000, 5010); } else { gpio_direction_output(pdata->hph_en1_gpio, 0); } mutex_unlock(&codec->mutex); snd_soc_dapm_sync(dapm); return 0; } static int mdm_hifi_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: mdm_hifi_control = %d\n", __func__, mdm_hifi_control); ucontrol->value.integer.value[0] = mdm_hifi_control; return 0; } static int mdm_hifi_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); pr_debug("%s() ucontrol->value.integer.value[0] = %ld\n", __func__, ucontrol->value.integer.value[0]); mdm_hifi_control = ucontrol->value.integer.value[0]; mdm_hifi_ctrl(codec); return 1; } static int mdm_enable_codec_ext_clk(struct snd_soc_codec *codec, int enable, bool dapm) { tasha_cdc_mclk_enable(codec, enable, dapm); return 0; } static int mdm_mclk_event(struct snd_soc_dapm_widget *w, struct snd_kcontrol *kcontrol, int event) { pr_debug("%s event %d\n", __func__, event); switch (event) { case SND_SOC_DAPM_PRE_PMU: return mdm_enable_codec_ext_clk(w->codec, 1, true); case SND_SOC_DAPM_POST_PMD: return mdm_enable_codec_ext_clk(w->codec, 0, true); } return 0; } static int mdm_auxpcm_startup(struct snd_pcm_substream *substream) { int ret = 0; if (atomic_inc_return(&aux_ref_count) == 1) { if (lpaif_pri_muxsel_virt_addr != NULL) { ret = afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_ON); if (ret < 0) { ret = -EINVAL; goto done; } iowrite32(I2S_PCM_SEL << I2S_PCM_SEL_OFFSET, lpaif_pri_muxsel_virt_addr); afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); } else { pr_err("%s lpaif_pri_muxsel_virt_addr is NULL\n", __func__); ret = -EINVAL; goto done; } } done: return ret; } static struct snd_soc_ops mdm_auxpcm_be_ops = { .startup = mdm_auxpcm_startup, }; static int mdm_auxpcm_rate_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = mdm_auxpcm_rate; return 0; } static int mdm_auxpcm_rate_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { switch (ucontrol->value.integer.value[0]) { case 0: mdm_auxpcm_rate = 8000; break; case 1: mdm_auxpcm_rate = 16000; break; default: mdm_auxpcm_rate = 8000; break; } return 0; } static int mdm_auxpcm_be_params_fixup(struct snd_soc_pcm_runtime *rtd, struct snd_pcm_hw_params *params) { struct snd_interval *rate = hw_param_interval(params, SNDRV_PCM_HW_PARAM_RATE); struct snd_interval *channels = hw_param_interval(params, SNDRV_PCM_HW_PARAM_CHANNELS); rate->min = rate->max = mdm_auxpcm_rate; channels->min = channels->max = 1; return 0; } static const struct snd_soc_dapm_widget mdm9650_dapm_widgets[] = { SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM, 0, 0, mdm_mclk_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_SPK("Lineout_1 amp", NULL), SND_SOC_DAPM_SPK("Lineout_3 amp", NULL), SND_SOC_DAPM_SPK("Lineout_2 amp", NULL), SND_SOC_DAPM_SPK("Lineout_4 amp", NULL), SND_SOC_DAPM_MIC("Handset Mic", NULL), SND_SOC_DAPM_MIC("Headset Mic", NULL), SND_SOC_DAPM_MIC("ANCRight Headset Mic", NULL), SND_SOC_DAPM_MIC("ANCLeft Headset Mic", NULL), SND_SOC_DAPM_MIC("Analog Mic4", NULL), SND_SOC_DAPM_MIC("Analog Mic6", NULL), SND_SOC_DAPM_MIC("Analog Mic7", NULL), SND_SOC_DAPM_MIC("Analog Mic8", NULL), SND_SOC_DAPM_MIC("Digital Mic1", NULL), SND_SOC_DAPM_MIC("Digital Mic2", NULL), SND_SOC_DAPM_MIC("Digital Mic3", NULL), SND_SOC_DAPM_MIC("Digital Mic4", NULL), SND_SOC_DAPM_MIC("Digital Mic5", NULL), SND_SOC_DAPM_MIC("Digital Mic6", NULL), }; static struct snd_soc_dapm_route wcd9335_audio_paths[] = { {"MIC BIAS1", NULL, "MCLK"}, {"MIC BIAS2", NULL, "MCLK"}, {"MIC BIAS3", NULL, "MCLK"}, {"MIC BIAS4", NULL, "MCLK"}, }; static const char *const spk_function[] = {"Off", "On"}; static const char *const hifi_function[] = {"Off", "On"}; static const char *const mi2s_rx_ch_text[] = {"One", "Two"}; static const char *const mi2s_tx_ch_text[] = {"One", "Two"}; static const char *const auxpcm_rate_text[] = {"rate_8000", "rate_16000"}; static const char *const mi2s_rx_rate_text[] = {"rate_8000", "rate_16000", "rate_48000"}; static const char *const mi2s_tx_rate_text[] = {"rate_8000", "rate_16000", "rate_48000"}; static const struct soc_enum mdm_enum[] = { SOC_ENUM_SINGLE_EXT(2, spk_function), SOC_ENUM_SINGLE_EXT(2, mi2s_rx_ch_text), SOC_ENUM_SINGLE_EXT(2, mi2s_tx_ch_text), SOC_ENUM_SINGLE_EXT(2, auxpcm_rate_text), SOC_ENUM_SINGLE_EXT(3, mi2s_rx_rate_text), SOC_ENUM_SINGLE_EXT(3, mi2s_tx_rate_text), SOC_ENUM_SINGLE_EXT(2, hifi_function), }; static const struct snd_kcontrol_new mdm_snd_controls[] = { SOC_ENUM_EXT("Speaker Function", mdm_enum[0], mdm_mi2s_get_spk, mdm_mi2s_set_spk), SOC_ENUM_EXT("MI2S_RX Channels", mdm_enum[1], mdm_mi2s_rx_ch_get, mdm_mi2s_rx_ch_put), SOC_ENUM_EXT("MI2S_TX Channels", mdm_enum[2], mdm_mi2s_tx_ch_get, mdm_mi2s_tx_ch_put), SOC_ENUM_EXT("AUX PCM SampleRate", mdm_enum[3], mdm_auxpcm_rate_get, mdm_auxpcm_rate_put), SOC_ENUM_EXT("MI2S Rx SampleRate", mdm_enum[4], mdm_mi2s_rx_rate_get, mdm_mi2s_rx_rate_put), SOC_ENUM_EXT("MI2S Tx SampleRate", mdm_enum[5], mdm_mi2s_tx_rate_get, mdm_mi2s_tx_rate_put), SOC_ENUM_EXT("HiFi Function", mdm_enum[6], mdm_hifi_get, mdm_hifi_put), }; static int mdm_mi2s_audrx_init(struct snd_soc_pcm_runtime *rtd) { int ret = 0; struct snd_soc_codec *codec = rtd->codec; struct snd_soc_dapm_context *dapm = &codec->dapm; struct snd_soc_dai *cpu_dai = rtd->cpu_dai; struct snd_card *card; struct snd_info_entry *entry; struct mdm_machine_data *pdata = snd_soc_card_get_drvdata(rtd->card); pr_debug("%s dev_name %s\n", __func__, dev_name(cpu_dai->dev)); rtd->pmdown_time = 0; ret = snd_soc_add_codec_controls(codec, mdm_snd_controls, ARRAY_SIZE(mdm_snd_controls)); if (ret < 0) { pr_err("%s: add_codec_controls failed, %d\n", __func__, ret); goto done; } snd_soc_dapm_new_controls(dapm, mdm9650_dapm_widgets, ARRAY_SIZE(mdm9650_dapm_widgets)); snd_soc_dapm_add_routes(dapm, wcd9335_audio_paths, ARRAY_SIZE(wcd9335_audio_paths)); /* * After DAPM Enable pins always * DAPM SYNC needs to be called. */ snd_soc_dapm_enable_pin(dapm, "Lineout_1 amp"); snd_soc_dapm_enable_pin(dapm, "Lineout_3 amp"); snd_soc_dapm_enable_pin(dapm, "Lineout_2 amp"); snd_soc_dapm_enable_pin(dapm, "Lineout_4 amp"); snd_soc_dapm_ignore_suspend(dapm, "Lineout_1 amp"); snd_soc_dapm_ignore_suspend(dapm, "Lineout_3 amp"); snd_soc_dapm_ignore_suspend(dapm, "Lineout_2 amp"); snd_soc_dapm_ignore_suspend(dapm, "Lineout_4 amp"); snd_soc_dapm_ignore_suspend(dapm, "ultrasound amp"); snd_soc_dapm_ignore_suspend(dapm, "Handset Mic"); snd_soc_dapm_ignore_suspend(dapm, "Headset Mic"); snd_soc_dapm_ignore_suspend(dapm, "ANCRight Headset Mic"); snd_soc_dapm_ignore_suspend(dapm, "ANCLeft Headset Mic"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic1"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic2"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic3"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic4"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic5"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic6"); snd_soc_dapm_ignore_suspend(dapm, "MADINPUT"); snd_soc_dapm_ignore_suspend(dapm, "MAD_CPE_INPUT"); snd_soc_dapm_ignore_suspend(dapm, "EAR"); snd_soc_dapm_ignore_suspend(dapm, "HEADPHONE"); snd_soc_dapm_ignore_suspend(dapm, "LINEOUT1"); snd_soc_dapm_ignore_suspend(dapm, "LINEOUT2"); snd_soc_dapm_ignore_suspend(dapm, "LINEOUT3"); snd_soc_dapm_ignore_suspend(dapm, "LINEOUT4"); snd_soc_dapm_ignore_suspend(dapm, "SPK_OUT"); snd_soc_dapm_ignore_suspend(dapm, "ANC HEADPHONE"); snd_soc_dapm_ignore_suspend(dapm, "ANC EAR"); 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_ignore_suspend(dapm, "AMIC5"); snd_soc_dapm_ignore_suspend(dapm, "AMIC6"); snd_soc_dapm_ignore_suspend(dapm, "DMIC1"); snd_soc_dapm_ignore_suspend(dapm, "DMIC2"); snd_soc_dapm_ignore_suspend(dapm, "DMIC3"); snd_soc_dapm_ignore_suspend(dapm, "DMIC4"); snd_soc_dapm_ignore_suspend(dapm, "DMIC5"); snd_soc_dapm_ignore_suspend(dapm, "Digital Mic0"); snd_soc_dapm_ignore_suspend(dapm, "DMIC0"); snd_soc_dapm_ignore_suspend(dapm, "SPK1 OUT"); snd_soc_dapm_ignore_suspend(dapm, "SPK2 OUT"); snd_soc_dapm_ignore_suspend(dapm, "AIF4 VI"); snd_soc_dapm_ignore_suspend(dapm, "VIINPUT"); snd_soc_dapm_ignore_suspend(dapm, "HPHL"); snd_soc_dapm_ignore_suspend(dapm, "HPHR"); snd_soc_dapm_ignore_suspend(dapm, "ANC HPHL"); snd_soc_dapm_ignore_suspend(dapm, "ANC HPHR"); snd_soc_dapm_ignore_suspend(dapm, "ANC LINEOUT1"); snd_soc_dapm_ignore_suspend(dapm, "ANC LINEOUT2"); snd_soc_dapm_sync(dapm); wcd_mbhc_cfg.calibration = def_tasha_mbhc_cal(); if (wcd_mbhc_cfg.calibration) ret = tasha_mbhc_hs_detect(codec, &wcd_mbhc_cfg); else ret = -ENOMEM; card = rtd->card->snd_card; entry = snd_register_module_info(card->module, "codecs", card->proc_root); if (!entry) { pr_debug("%s: Cannot create codecs module entry\n", __func__); ret = 0; goto done; } pdata->codec_root = entry; tasha_codec_info_create_codec_entry(pdata->codec_root, codec); done: return ret; } static void *def_tasha_mbhc_cal(void) { void *tasha_wcd_cal; struct wcd_mbhc_btn_detect_cfg *btn_cfg; u16 *btn_high; tasha_wcd_cal = kzalloc(WCD_MBHC_CAL_SIZE(WCD_MBHC_DEF_BUTTONS, WCD9XXX_MBHC_DEF_RLOADS), GFP_KERNEL); if (!tasha_wcd_cal) return NULL; #define S(X, Y) ((WCD_MBHC_CAL_PLUG_TYPE_PTR(tasha_wcd_cal)->X) = (Y)) S(v_hs_max, 1500); #undef S #define S(X, Y) ((WCD_MBHC_CAL_BTN_DET_PTR(tasha_wcd_cal)->X) = (Y)) S(num_btn, WCD_MBHC_DEF_BUTTONS); #undef S btn_cfg = WCD_MBHC_CAL_BTN_DET_PTR(tasha_wcd_cal); btn_high = ((void *)&btn_cfg->_v_btn_low) + (sizeof(btn_cfg->_v_btn_low[0]) * btn_cfg->num_btn); btn_high[0] = 75; btn_high[1] = 150; btn_high[2] = 237; btn_high[3] = 450; btn_high[4] = 500; btn_high[5] = 590; btn_high[6] = 675; btn_high[7] = 780; return tasha_wcd_cal; } /* Digital audio interface connects codec <---> CPU */ static struct snd_soc_dai_link mdm_dai[] = { /* FrontEnd DAI Links */ { .name = "MDM Media1", .stream_name = "MultiMedia1", .cpu_dai_name = "MultiMedia1", .platform_name = "msm-pcm-dsp.0", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .ignore_suspend = 1, /* This dainlink has playback support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_MULTIMEDIA1 }, { .name = "MSM VoIP", .stream_name = "VoIP", .cpu_dai_name = "VoIP", .platform_name = "msm-voip-dsp", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .ignore_suspend = 1, /* This dainlink has VOIP support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_VOIP, }, { .name = "Circuit-Switch Voice", .stream_name = "CS-Voice", .cpu_dai_name = "CS-VOICE", .platform_name = "msm-pcm-voice", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, /* This dainlink has Voice support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_CS_VOICE, }, { .name = "Primary MI2S RX Hostless", .stream_name = "Primary MI2S_RX Hostless Playback", .cpu_dai_name = "PRI_MI2S_RX_HOSTLESS", .platform_name = "msm-pcm-hostless", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, .ignore_pmdown_time = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", }, { .name = "VoLTE", .stream_name = "VoLTE", .cpu_dai_name = "VoLTE", .platform_name = "msm-pcm-voice", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, /* this dainlink has playback support */ .ignore_pmdown_time = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .be_id = MSM_FRONTEND_DAI_VOLTE, }, { .name = "MSM AFE-PCM RX", .stream_name = "AFE-PROXY RX", .cpu_dai_name = "msm-dai-q6-dev.241", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .platform_name = "msm-pcm-afe", .ignore_suspend = 1, /* this dainlink has playback support */ .ignore_pmdown_time = 1, }, { .name = "MSM AFE-PCM TX", .stream_name = "AFE-PROXY TX", .cpu_dai_name = "msm-dai-q6-dev.240", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-tx", .platform_name = "msm-pcm-afe", .ignore_suspend = 1, }, { .name = "DTMF RX Hostless", .stream_name = "DTMF RX Hostless", .cpu_dai_name = "DTMF_RX_HOSTLESS", .platform_name = "msm-pcm-dtmf", .dynamic = 1, .dpcm_playback = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .ignore_suspend = 1, .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_DTMF_RX, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, }, { .name = "DTMF TX", .stream_name = "DTMF TX", .cpu_dai_name = "msm-dai-stub-dev.4", .platform_name = "msm-pcm-dtmf", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-tx", .ignore_suspend = 1, }, { .name = "CS-VOICE HOST RX CAPTURE", .stream_name = "CS-VOICE HOST RX CAPTURE", .cpu_dai_name = "msm-dai-stub-dev.5", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-tx", .ignore_suspend = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, }, { .name = "CS-VOICE HOST RX PLAYBACK", .stream_name = "CS-VOICE HOST RX PLAYBACK", .cpu_dai_name = "msm-dai-stub-dev.6", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .ignore_suspend = 1, .ignore_pmdown_time = 1, }, { .name = "CS-VOICE HOST TX CAPTURE", .stream_name = "CS-VOICE HOST TX CAPTURE", .cpu_dai_name = "msm-dai-stub-dev.7", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-tx", .ignore_suspend = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, }, { .name = "CS-VOICE HOST TX PLAYBACK", .stream_name = "CS-VOICE HOST TX PLAYBACK", .cpu_dai_name = "msm-dai-stub-dev.8", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .ignore_suspend = 1, .ignore_pmdown_time = 1, }, { .name = "MDM Media2", .stream_name = "MultiMedia2", .cpu_dai_name = "MultiMedia2", .platform_name = "msm-pcm-dsp.0", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .ignore_suspend = 1, .ignore_pmdown_time = 1, /* this dainlink has playback support */ .be_id = MSM_FRONTEND_DAI_MULTIMEDIA2, }, { .name = "MDM Media6", .stream_name = "MultiMedia6", .cpu_dai_name = "MultiMedia6", .platform_name = "msm-pcm-loopback", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .ignore_suspend = 1, .ignore_pmdown_time = 1, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, /* this dainlink has playback support */ .be_id = MSM_FRONTEND_DAI_MULTIMEDIA6, }, { .name = "Primary MI2S TX Hostless", .stream_name = "Primary MI2S_TX Hostless Playback", .cpu_dai_name = "PRI_MI2S_TX_HOSTLESS", .platform_name = "msm-pcm-hostless", .dynamic = 1, .dpcm_capture = 1, .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, .ignore_pmdown_time = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", }, { .name = "MDM LowLatency", .stream_name = "MultiMedia5", .cpu_dai_name = "MultiMedia5", .platform_name = "msm-pcm-dsp.1", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .ignore_suspend = 1, /* this dainlink has playback support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_MULTIMEDIA5, }, { .name = "MDM VoiceMMode1", .stream_name = "VoiceMMode1", .cpu_dai_name = "VoiceMMode1", .platform_name = "msm-pcm-voice", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, /* This dainlink has Voice support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_VOICEMMODE1, }, { .name = "MDM VoiceMMode2", .stream_name = "VoiceMMode2", .cpu_dai_name = "VoiceMMode2", .platform_name = "msm-pcm-voice", .dynamic = 1, .dpcm_playback = 1, .dpcm_capture = 1, .codec_dai_name = "snd-soc-dummy-dai", .codec_name = "snd-soc-dummy", .trigger = {SND_SOC_DPCM_TRIGGER_POST, SND_SOC_DPCM_TRIGGER_POST}, .no_host_mode = SND_SOC_DAI_LINK_NO_HOST, .ignore_suspend = 1, /* This dainlink has Voice support */ .ignore_pmdown_time = 1, .be_id = MSM_FRONTEND_DAI_VOICEMMODE2, }, /* Backend DAI Links */ { .name = LPASS_BE_PRI_MI2S_RX, .stream_name = "Primary MI2S Playback", .cpu_dai_name = "msm-dai-q6-mi2s.0", .platform_name = "msm-pcm-routing", .codec_name = "tasha_codec", .codec_dai_name = "tasha_i2s_rx1", .no_pcm = 1, .dpcm_playback = 1, .be_id = MSM_BACKEND_DAI_PRI_MI2S_RX, .init = &mdm_mi2s_audrx_init, .be_hw_params_fixup = &mdm_mi2s_rx_be_hw_params_fixup, .ops = &mdm_mi2s_be_ops, .ignore_pmdown_time = 1, .ignore_suspend = 1, }, { .name = LPASS_BE_PRI_MI2S_TX, .stream_name = "Primary MI2S Capture", .cpu_dai_name = "msm-dai-q6-mi2s.0", .platform_name = "msm-pcm-routing", .codec_name = "tasha_codec", .codec_dai_name = "tasha_i2s_tx1", .no_pcm = 1, .dpcm_capture = 1, .be_id = MSM_BACKEND_DAI_PRI_MI2S_TX, .be_hw_params_fixup = &mdm_mi2s_tx_be_hw_params_fixup, .ops = &mdm_mi2s_be_ops, .ignore_pmdown_time = 1, .ignore_suspend = 1, }, { .name = LPASS_BE_AFE_PCM_RX, .stream_name = "AFE Playback", .cpu_dai_name = "msm-dai-q6-dev.224", .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_AFE_PCM_RX, .ignore_suspend = 1, }, { .name = LPASS_BE_AFE_PCM_TX, .stream_name = "AFE Capture", .cpu_dai_name = "msm-dai-q6-dev.225", .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_AFE_PCM_TX, .ignore_suspend = 1, }, { .name = LPASS_BE_AUXPCM_RX, .stream_name = "AUX PCM Playback", .cpu_dai_name = "msm-dai-q6-auxpcm.1", .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_AUXPCM_RX, .be_hw_params_fixup = mdm_auxpcm_be_params_fixup, .ops = &mdm_auxpcm_be_ops, .ignore_pmdown_time = 1, /* this dainlink has playback support */ .ignore_suspend = 1, }, { .name = LPASS_BE_AUXPCM_TX, .stream_name = "AUX PCM Capture", .cpu_dai_name = "msm-dai-q6-auxpcm.1", .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_AUXPCM_TX, .be_hw_params_fixup = mdm_auxpcm_be_params_fixup, .ops = &mdm_auxpcm_be_ops, .ignore_suspend = 1, }, /* Incall Record Uplink BACK END DAI Link */ { .name = LPASS_BE_INCALL_RECORD_TX, .stream_name = "Voice Uplink Capture", .cpu_dai_name = "msm-dai-q6-dev.32772", .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_INCALL_RECORD_TX, .be_hw_params_fixup = mdm_be_hw_params_fixup, .ignore_suspend = 1, }, /* Incall Record Downlink BACK END DAI Link */ { .name = LPASS_BE_INCALL_RECORD_RX, .stream_name = "Voice Downlink Capture", .cpu_dai_name = "msm-dai-q6-dev.32771", .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_INCALL_RECORD_RX, .be_hw_params_fixup = mdm_be_hw_params_fixup, .ignore_suspend = 1, }, /* Incall Music BACK END DAI Link */ { .name = LPASS_BE_VOICE_PLAYBACK_TX, .stream_name = "Voice Farend Playback", .cpu_dai_name = "msm-dai-q6-dev.32773", .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_VOICE_PLAYBACK_TX, .be_hw_params_fixup = mdm_be_hw_params_fixup, .ignore_suspend = 1, }, }; static struct snd_soc_card snd_soc_card_mdm = { .name = "mdm-tasha-i2s-snd-card", .dai_link = mdm_dai, .num_links = ARRAY_SIZE(mdm_dai), }; static int mdm_populate_dai_link_component_of_node( struct snd_soc_card *card) { int i, index, ret = 0; struct device *cdev = card->dev; struct snd_soc_dai_link *dai_link = card->dai_link; struct device_node *np; if (!cdev) { pr_err("%s: Sound card device memory NULL\n", __func__); return -ENODEV; } for (i = 0; i < card->num_links; i++) { if (dai_link[i].platform_of_node && dai_link[i].cpu_of_node) continue; /* populate platform_of_node for snd card dai links */ if (dai_link[i].platform_name && !dai_link[i].platform_of_node) { index = of_property_match_string(cdev->of_node, "asoc-platform-names", dai_link[i].platform_name); if (index < 0) { pr_debug("%s: No match found for platform name: %s\n", __func__, dai_link[i].platform_name); ret = index; goto err; } np = of_parse_phandle(cdev->of_node, "asoc-platform", index); if (!np) { pr_err("%s: retrieving phandle for platform %s, index %d failed\n", __func__, dai_link[i].platform_name, index); ret = -ENODEV; goto err; } dai_link[i].platform_of_node = np; dai_link[i].platform_name = NULL; } /* populate cpu_of_node for snd card dai links */ if (dai_link[i].cpu_dai_name && !dai_link[i].cpu_of_node) { index = of_property_match_string(cdev->of_node, "asoc-cpu-names", dai_link[i].cpu_dai_name); if (index >= 0) { np = of_parse_phandle(cdev->of_node, "asoc-cpu", index); if (!np) { pr_err("%s: retrieving phandle for cpu dai %s failed\n", __func__, dai_link[i].cpu_dai_name); ret = -ENODEV; goto err; } dai_link[i].cpu_of_node = np; dai_link[i].cpu_dai_name = NULL; } } /* populate codec_of_node for snd card dai links */ if (dai_link[i].codec_name && !dai_link[i].codec_of_node) { index = of_property_match_string(cdev->of_node, "asoc-codec-names", dai_link[i].codec_name); if (index < 0) continue; np = of_parse_phandle(cdev->of_node, "asoc-codec", index); if (!np) { pr_err("%s: retrieving phandle for codec %s failed\n", __func__, dai_link[i].codec_name); ret = -ENODEV; goto err; } dai_link[i].codec_of_node = np; dai_link[i].codec_name = NULL; } } err: return ret; } static int mdm_asoc_machine_probe(struct platform_device *pdev) { int ret; struct mdm_machine_data *pdata; struct snd_soc_card *card = &snd_soc_card_mdm; if (!pdev->dev.of_node) { dev_err(&pdev->dev, "%s No platform supplied from device tree\n", __func__); return -EINVAL; } pdata = devm_kzalloc(&pdev->dev, sizeof(struct mdm_machine_data), GFP_KERNEL); if (!pdata) return -ENOMEM; ret = of_property_read_u32(pdev->dev.of_node, "qcom,tasha-mclk-clk-freq", &pdata->mclk_freq); if (ret) { dev_err(&pdev->dev, "%s Looking up %s property in node %s failed", __func__, "qcom,tasha-mclk-clk-freq", pdev->dev.of_node->full_name); goto err; } /* At present only 12.288MHz is supported on MDM. */ if (q6afe_check_osr_clk_freq(pdata->mclk_freq)) { dev_err(&pdev->dev, "%s Unsupported tasha mclk freq %u\n", __func__, pdata->mclk_freq); ret = -EINVAL; goto err; } mutex_init(&cdc_mclk_mutex); atomic_set(&aux_ref_count, 0); atomic_set(&mi2s_ref_count, 0); pdata->prim_clk_usrs = 0; card->dev = &pdev->dev; platform_set_drvdata(pdev, card); snd_soc_card_set_drvdata(card, pdata); ret = snd_soc_of_parse_card_name(card, "qcom,model"); if (ret) goto err; ret = snd_soc_of_parse_audio_routing(card, "qcom,audio-routing"); if (ret) goto err; ret = mdm_populate_dai_link_component_of_node(card); if (ret) { ret = -EPROBE_DEFER; goto err; } ret = snd_soc_register_card(card); if (ret == -EPROBE_DEFER) { goto err; } else if (ret) { dev_err(&pdev->dev, "snd_soc_register_card failed (%d)\n", ret); goto err; } lpaif_pri_muxsel_virt_addr = ioremap(LPAIF_PRI_MODE_MUXSEL, 4); if (lpaif_pri_muxsel_virt_addr == NULL) { pr_err("%s Pri muxsel virt addr is null\n", __func__); ret = -EINVAL; goto err; } lpass_gpio_mux_spkr_ctl_virt_addr = ioremap(LPASS_CSR_GP_IO_MUX_SPKR_CTL, 4); if (lpass_gpio_mux_spkr_ctl_virt_addr == NULL) { pr_err("%s lpass spkr ctl virt addr is null\n", __func__); ret = -EINVAL; goto err1; } return 0; err1: iounmap(lpaif_pri_muxsel_virt_addr); err: devm_kfree(&pdev->dev, pdata); return ret; } static int mdm_asoc_machine_remove(struct platform_device *pdev) { struct snd_soc_card *card = platform_get_drvdata(pdev); struct mdm_machine_data *pdata = snd_soc_card_get_drvdata(card); pdata->mclk_freq = 0; gpio_free(pdata->hph_en1_gpio); gpio_free(pdata->hph_en0_gpio); iounmap(lpaif_pri_muxsel_virt_addr); iounmap(lpass_gpio_mux_spkr_ctl_virt_addr); snd_soc_unregister_card(card); return 0; } static const struct of_device_id mdm_asoc_machine_of_match[] = { { .compatible = "qcom,mdm-audio-tasha", }, {}, }; static struct platform_driver mdm_asoc_machine_driver = { .driver = { .name = DRV_NAME, .owner = THIS_MODULE, .pm = &snd_soc_pm_ops, .of_match_table = mdm_asoc_machine_of_match, }, .probe = mdm_asoc_machine_probe, .remove = mdm_asoc_machine_remove, }; static int mdm_adsp_state_callback(struct notifier_block *nb, unsigned long value, void *priv) { if (SUBSYS_AFTER_POWERUP == value) platform_driver_register(&mdm_asoc_machine_driver); return NOTIFY_OK; } static struct notifier_block adsp_state_notifier_block = { .notifier_call = mdm_adsp_state_callback, .priority = -INT_MAX, }; static int __init mdm_soc_platform_init(void) { adsp_state_notifier = subsys_notif_register_notifier("modem", &adsp_state_notifier_block); return 0; } module_init(mdm_soc_platform_init); MODULE_DESCRIPTION("ALSA SoC msm"); MODULE_LICENSE("GPL v2"); MODULE_ALIAS("platform:" MDM9650_MACHINE_DRV_NAME); MODULE_DEVICE_TABLE(of, mdm9650_asoc_machine_of_match);