| /* Copyright (c) 2014-2018, 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 <linux/clk.h> |
| #include <linux/delay.h> |
| #include <linux/gpio.h> |
| #include <linux/of_gpio.h> |
| #include <linux/platform_device.h> |
| #include <linux/slab.h> |
| #include <linux/io.h> |
| #include <linux/module.h> |
| #include <linux/input.h> |
| #include <linux/of_device.h> |
| #include <sound/core.h> |
| #include <sound/soc.h> |
| #include <sound/soc-dapm.h> |
| #include <sound/pcm.h> |
| #include <sound/jack.h> |
| #include <sound/pcm_params.h> |
| #include <sound/info.h> |
| #include <device_event.h> |
| #include <dsp/audio_notifier.h> |
| #include <dsp/q6afe-v2.h> |
| #include <dsp/q6core.h> |
| #include "msm-pcm-routing-v2.h" |
| #include "codecs/msm-cdc-pinctrl.h" |
| #include "codecs/wcd934x/wcd934x.h" |
| #include "codecs/wcd934x/wcd934x-mbhc.h" |
| #include "codecs/wsa881x.h" |
| |
| /* Machine driver Name */ |
| #define DRV_NAME "sdx-asoc-tavil" |
| |
| #define __CHIPSET__ "SDX " |
| #define SDX_DAILINK_NAME(name) (__CHIPSET__#name) |
| |
| #define SAMPLE_RATE_8KHZ 8000 |
| #define SAMPLE_RATE_16KHZ 16000 |
| #define SAMPLE_RATE_48KHZ 48000 |
| #define NUM_OF_BITS_PER_SAMPLE 16 |
| #define DEV_NAME_STR_LEN 32 |
| |
| #define LPAIF_OFFSET 0x01a00000 |
| #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 LPASS_CSR_GP_IO_MUX_MIC_CTL (LPAIF_OFFSET + 0x2000) |
| |
| #define I2S_SEL 0 |
| #define PCM_SEL 1 |
| #define I2S_PCM_SEL_OFFSET 0 |
| #define I2S_PCM_MASTER_MODE 1 |
| #define I2S_PCM_SLAVE_MODE 0 |
| |
| #define PRI_TLMM_CLKS_EN_MASTER 0x4 |
| #define SEC_TLMM_CLKS_EN_MASTER 0x2 |
| #define PRI_TLMM_CLKS_EN_SLAVE 0x100000 |
| #define SEC_TLMM_CLKS_EN_SLAVE 0x800000 |
| #define CLOCK_ON 1 |
| #define CLOCK_OFF 0 |
| |
| #define WCD9XXX_MBHC_DEF_BUTTONS 8 |
| #define WCD9XXX_MBHC_DEF_RLOADS 5 |
| |
| /* Spk control */ |
| #define SDX_SPK_ON 1 |
| #define SDX_HIFI_ON 1 |
| |
| enum mi2s_types { |
| PRI_MI2S, |
| SEC_MI2S, |
| }; |
| |
| struct sdx_machine_data { |
| u32 mclk_freq; |
| u16 prim_mi2s_mode; |
| u16 sec_mi2s_mode; |
| u16 prim_auxpcm_mode; |
| struct device_node *prim_master_p; |
| struct device_node *prim_slave_p; |
| u16 sec_auxpcm_mode; |
| struct device_node *sec_master_p; |
| struct device_node *sec_slave_p; |
| u32 prim_clk_usrs; |
| int hph_en1_gpio; |
| int hph_en0_gpio; |
| struct snd_info_entry *codec_root; |
| void __iomem *lpaif_pri_muxsel_virt_addr; |
| void __iomem *lpaif_sec_muxsel_virt_addr; |
| void __iomem *lpass_mux_spkr_ctl_virt_addr; |
| void __iomem *lpass_mux_mic_ctl_virt_addr; |
| }; |
| |
| struct sdx_wsa881x_dev_info { |
| struct device_node *of_node; |
| u32 index; |
| }; |
| |
| static void *def_tavil_mbhc_cal(void); |
| static void *adsp_state_notifier; |
| static bool dummy_device_registered; |
| |
| 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 const struct afe_clk_set lpass_default_v2 = { |
| AFE_API_VERSION_I2S_CONFIG, |
| Q6AFE_LPASS_CLK_ID_PRI_MI2S_IBIT, |
| Q6AFE_LPASS_IBIT_CLK_1_P536_MHZ, |
| Q6AFE_LPASS_CLK_ATTRIBUTE_COUPLE_NO, |
| Q6AFE_LPASS_CLK_ROOT_DEFAULT, |
| 0, |
| }; |
| |
| static struct snd_soc_aux_dev *sdx_aux_dev; |
| static struct snd_soc_codec_conf *sdx_codec_conf; |
| |
| static int sdx_auxpcm_rate = 8000; |
| |
| static struct mutex cdc_mclk_mutex; |
| static int sdx_mi2s_rx_ch = 1; |
| static int sdx_mi2s_tx_ch = 1; |
| static int sdx_sec_mi2s_rx_ch = 1; |
| static int sdx_sec_mi2s_tx_ch = 1; |
| static int sdx_mi2s_rate = SAMPLE_RATE_48KHZ; |
| static int sdx_sec_mi2s_rate = SAMPLE_RATE_48KHZ; |
| |
| static int sdx_mi2s_mode = I2S_PCM_MASTER_MODE; |
| static int sdx_sec_mi2s_mode = I2S_PCM_MASTER_MODE; |
| static int sdx_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| static int sdx_sec_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| |
| static int sdx_spk_control = 1; |
| static int sdx_hifi_control; |
| static atomic_t mi2s_ref_count; |
| static atomic_t sec_mi2s_ref_count; |
| |
| static int sdx_wsa881x_init(struct snd_soc_component *component) |
| { |
| u8 spkleft_ports[WSA881X_MAX_SWR_PORTS] = {100, 101, 102, 106}; |
| u8 spkright_ports[WSA881X_MAX_SWR_PORTS] = {103, 104, 105, 107}; |
| unsigned int ch_rate[WSA881X_MAX_SWR_PORTS] = {2400, 600, 300, 1200}; |
| unsigned int ch_mask[WSA881X_MAX_SWR_PORTS] = {0x1, 0xF, 0x3, 0x3}; |
| struct snd_soc_codec *codec = snd_soc_component_to_codec(component); |
| struct sdx_machine_data *pdata; |
| struct snd_soc_dapm_context *dapm; |
| |
| if (!codec) { |
| pr_err("%s codec is NULL\n", __func__); |
| return -EINVAL; |
| } |
| |
| dapm = snd_soc_codec_get_dapm(codec); |
| |
| if (!strcmp(component->name_prefix, "SpkrLeft")) { |
| dev_dbg(codec->dev, "%s: setting left ch map to codec %s\n", |
| __func__, codec->component.name); |
| wsa881x_set_channel_map(codec, &spkleft_ports[0], |
| WSA881X_MAX_SWR_PORTS, &ch_mask[0], |
| &ch_rate[0]); |
| if (dapm->component) { |
| snd_soc_dapm_ignore_suspend(dapm, "SpkrLeft IN"); |
| snd_soc_dapm_ignore_suspend(dapm, "SpkrLeft SPKR"); |
| } |
| } else if (!strcmp(component->name_prefix, "SpkrRight")) { |
| dev_dbg(codec->dev, "%s: setting right ch map to codec %s\n", |
| __func__, codec->component.name); |
| wsa881x_set_channel_map(codec, &spkright_ports[0], |
| WSA881X_MAX_SWR_PORTS, &ch_mask[0], |
| &ch_rate[0]); |
| if (dapm->component) { |
| snd_soc_dapm_ignore_suspend(dapm, "SpkrRight IN"); |
| snd_soc_dapm_ignore_suspend(dapm, "SpkrRight SPKR"); |
| } |
| } else { |
| dev_err(codec->dev, "%s: wrong codec name %s\n", __func__, |
| codec->component.name); |
| return -EINVAL; |
| } |
| pdata = snd_soc_card_get_drvdata(component->card); |
| if (pdata && pdata->codec_root) |
| wsa881x_codec_info_create_codec_entry(pdata->codec_root, |
| codec); |
| |
| return 0; |
| } |
| |
| static int sdx_mi2s_clk_ctl(struct snd_soc_pcm_runtime *rtd, bool enable, |
| enum mi2s_types mi2s_type, int rate, u16 mode) |
| { |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| struct afe_clk_set m_clk = lpass_default_v2; |
| struct afe_clk_set ibit_clk = lpass_default_v2; |
| u16 mi2s_port; |
| u16 ibit_clk_id; |
| int bit_clk_freq = (rate * 2 * NUM_OF_BITS_PER_SAMPLE); |
| int ret = 0; |
| |
| dev_dbg(card->dev, "%s: setting lpass clock using v2\n", __func__); |
| |
| if (pdata == NULL) { |
| dev_err(card->dev, "%s: platform data is null\n", __func__); |
| ret = -ENOMEM; |
| goto done; |
| } |
| |
| if (mi2s_type == PRI_MI2S) { |
| mi2s_port = AFE_PORT_ID_PRIMARY_MI2S_RX; |
| ibit_clk_id = Q6AFE_LPASS_CLK_ID_PRI_MI2S_IBIT; |
| } else { |
| mi2s_port = AFE_PORT_ID_SECONDARY_MI2S_RX; |
| ibit_clk_id = Q6AFE_LPASS_CLK_ID_SEC_MI2S_IBIT; |
| } |
| |
| /* Set both mclk and ibit clocks when using LPASS_CLK_VER_2 */ |
| m_clk.clk_id = Q6AFE_LPASS_CLK_ID_MCLK_3; |
| m_clk.clk_freq_in_hz = pdata->mclk_freq; |
| m_clk.enable = enable; |
| ret = afe_set_lpass_clock_v2(mi2s_port, &m_clk); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "%s: afe_set_lpass_clock_v2 failed for mclk_3 with ret %d\n", |
| __func__, ret); |
| goto done; |
| } |
| |
| if (mode) { |
| ibit_clk.clk_id = ibit_clk_id; |
| ibit_clk.clk_freq_in_hz = bit_clk_freq; |
| ibit_clk.enable = enable; |
| ret = afe_set_lpass_clock_v2(mi2s_port, &ibit_clk); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "%s: afe_set_lpass_clock_v2 failed for ibit with ret %d\n", |
| __func__, ret); |
| goto err_ibit_clk_set; |
| } |
| } |
| ret = 0; |
| |
| done: |
| return ret; |
| |
| err_ibit_clk_set: |
| m_clk.enable = false; |
| if (afe_set_lpass_clock_v2(mi2s_port, &m_clk)) |
| dev_err(card->dev, "%s: afe_set_lpass_clock_v2 failed for mclk_3\n", |
| __func__); |
| |
| return ret; |
| } |
| |
| static void sdx_mi2s_shutdown(struct snd_pcm_substream *substream) |
| { |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| int ret; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| if (atomic_dec_return(&mi2s_ref_count) == 0) { |
| ret = sdx_mi2s_clk_ctl(rtd, false, PRI_MI2S, 0, |
| pdata->prim_mi2s_mode); |
| if (ret < 0) |
| pr_err("%s Clock disable failed\n", __func__); |
| |
| if (pdata->prim_mi2s_mode == 1) |
| ret = msm_cdc_pinctrl_select_sleep_state |
| (pdata->prim_master_p); |
| else |
| ret = msm_cdc_pinctrl_select_sleep_state |
| (pdata->prim_slave_p); |
| if (ret) |
| pr_err("%s: failed to set pri gpios to sleep: %d\n", |
| __func__, ret); |
| } |
| } |
| |
| static int sdx_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; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| int ret = 0; |
| |
| pdata->prim_mi2s_mode = sdx_mi2s_mode; |
| if (atomic_inc_return(&mi2s_ref_count) == 1) { |
| if (pdata->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, |
| pdata->lpaif_pri_muxsel_virt_addr); |
| if (pdata->lpass_mux_spkr_ctl_virt_addr != NULL) { |
| if (pdata->prim_mi2s_mode == 1) |
| iowrite32(PRI_TLMM_CLKS_EN_MASTER, |
| pdata->lpass_mux_spkr_ctl_virt_addr); |
| else |
| iowrite32(PRI_TLMM_CLKS_EN_SLAVE, |
| pdata->lpass_mux_spkr_ctl_virt_addr); |
| } else { |
| dev_err(card->dev, "%s: mux spkr ctl virt addr is NULL\n", |
| __func__); |
| |
| ret = -EINVAL; |
| goto err; |
| } |
| } else { |
| dev_err(card->dev, "%s lpaif_pri_muxsel_virt_addr is NULL\n", |
| __func__); |
| |
| ret = -EINVAL; |
| goto done; |
| } |
| /* |
| * This sets the CONFIG PARAMETER WS_SRC. |
| * 1 means internal clock master mode. |
| * 0 means external clock slave mode. |
| */ |
| if (pdata->prim_mi2s_mode == 1) { |
| ret = msm_cdc_pinctrl_select_active_state |
| (pdata->prim_master_p); |
| if (ret < 0) { |
| pr_err("%s pinctrl set failed\n", __func__); |
| goto err; |
| } |
| ret = sdx_mi2s_clk_ctl(rtd, true, PRI_MI2S, |
| sdx_mi2s_rate, |
| pdata->prim_mi2s_mode); |
| if (ret < 0) { |
| dev_err(card->dev, "%s clock enable failed\n", |
| __func__); |
| goto err; |
| } |
| ret = snd_soc_dai_set_fmt(cpu_dai, |
| SND_SOC_DAIFMT_CBS_CFS); |
| if (ret < 0) { |
| sdx_mi2s_clk_ctl(rtd, false, PRI_MI2S, |
| 0, pdata->prim_mi2s_mode); |
| dev_err(card->dev, |
| "%s Set fmt for cpu dai failed\n", |
| __func__); |
| goto err; |
| } |
| ret = snd_soc_dai_set_fmt(codec_dai, |
| SND_SOC_DAIFMT_CBS_CFS); |
| if (ret < 0) { |
| sdx_mi2s_clk_ctl(rtd, false, PRI_MI2S, |
| 0, pdata->prim_mi2s_mode); |
| dev_err(card->dev, |
| "%s Set fmt for codec dai failed\n", |
| __func__); |
| } |
| } else { |
| /* |
| * Disable bit clk in slave mode for QC codec. |
| * Enable only mclk. |
| */ |
| ret = msm_cdc_pinctrl_select_active_state |
| (pdata->prim_slave_p); |
| if (ret < 0) { |
| pr_err("%s pinctrl set failed\n", __func__); |
| goto err; |
| } |
| ret = sdx_mi2s_clk_ctl(rtd, false, PRI_MI2S, 0, |
| pdata->prim_mi2s_mode); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "%s clock enable failed\n", __func__); |
| goto err; |
| } |
| ret = snd_soc_dai_set_fmt(cpu_dai, |
| SND_SOC_DAIFMT_CBM_CFM); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "%s Set fmt for cpu dai failed\n", |
| __func__); |
| goto err; |
| } |
| } |
| err: |
| afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); |
| } |
| done: |
| if (ret) |
| atomic_dec_return(&mi2s_ref_count); |
| return ret; |
| } |
| |
| static void sdx_sec_mi2s_shutdown(struct snd_pcm_substream *substream) |
| { |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| int ret; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| if (atomic_dec_return(&sec_mi2s_ref_count) == 0) { |
| ret = sdx_mi2s_clk_ctl(rtd, false, SEC_MI2S, |
| 0, pdata->sec_mi2s_mode); |
| if (ret < 0) |
| pr_err("%s Clock disable failed\n", __func__); |
| |
| if (pdata->sec_mi2s_mode == 1) |
| ret = msm_cdc_pinctrl_select_sleep_state |
| (pdata->sec_master_p); |
| else |
| ret = msm_cdc_pinctrl_select_sleep_state |
| (pdata->sec_slave_p); |
| if (ret) |
| pr_err("%s: failed to set sec gpios to sleep: %d\n", |
| __func__, ret); |
| } |
| } |
| |
| static int sdx_sec_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_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| int ret = 0; |
| |
| pdata->sec_mi2s_mode = sdx_sec_mi2s_mode; |
| if (atomic_inc_return(&sec_mi2s_ref_count) == 1) { |
| if (pdata->lpaif_sec_muxsel_virt_addr != NULL) { |
| ret = afe_enable_lpass_core_shared_clock( |
| SECONDARY_I2S_RX, CLOCK_ON); |
| if (ret < 0) { |
| ret = -EINVAL; |
| goto done; |
| } |
| iowrite32(I2S_SEL << I2S_PCM_SEL_OFFSET, |
| pdata->lpaif_sec_muxsel_virt_addr); |
| |
| if (pdata->lpass_mux_mic_ctl_virt_addr != NULL) { |
| if (pdata->sec_mi2s_mode == 1) |
| iowrite32(SEC_TLMM_CLKS_EN_MASTER, |
| pdata->lpass_mux_mic_ctl_virt_addr); |
| else |
| iowrite32(SEC_TLMM_CLKS_EN_SLAVE, |
| pdata->lpass_mux_mic_ctl_virt_addr); |
| } else { |
| dev_err(card->dev, |
| "%s: mux spkr ctl virt addr is NULL\n", |
| __func__); |
| ret = -EINVAL; |
| goto err; |
| } |
| } else { |
| dev_err(card->dev, "%s lpaif_sec_muxsel_virt_addr is NULL\n", |
| __func__); |
| ret = -EINVAL; |
| goto done; |
| } |
| /* |
| * This sets the CONFIG PARAMETER WS_SRC. |
| * 1 means internal clock master mode. |
| * 0 means external clock slave mode. |
| */ |
| if (pdata->sec_mi2s_mode == 1) { |
| ret = msm_cdc_pinctrl_select_active_state |
| (pdata->sec_master_p); |
| if (ret < 0) { |
| pr_err("%s pinctrl set failed\n", __func__); |
| goto err; |
| } |
| ret = sdx_mi2s_clk_ctl(rtd, true, SEC_MI2S, |
| sdx_sec_mi2s_rate, |
| pdata->sec_mi2s_mode); |
| if (ret < 0) { |
| dev_err(card->dev, "%s clock enable failed\n", |
| __func__); |
| goto err; |
| } |
| ret = snd_soc_dai_set_fmt(cpu_dai, |
| SND_SOC_DAIFMT_CBS_CFS); |
| if (ret < 0) { |
| ret = sdx_mi2s_clk_ctl(rtd, false, SEC_MI2S, |
| 0, |
| pdata->sec_mi2s_mode); |
| dev_err(card->dev, "%s Set fmt for cpu dai failed\n", |
| __func__); |
| } |
| } else { |
| /* |
| * Enable mclk here, if needed for external codecs. |
| * Optional. Refer primary mi2s slave interface. |
| */ |
| ret = msm_cdc_pinctrl_select_active_state |
| (pdata->sec_slave_p); |
| if (ret < 0) { |
| pr_err("%s pinctrl set failed\n", __func__); |
| goto err; |
| } |
| ret = sdx_mi2s_clk_ctl(rtd, false, SEC_MI2S, 0, |
| pdata->sec_mi2s_mode); |
| if (ret < 0) { |
| dev_err(card->dev, |
| "%s clock enable failed\n", __func__); |
| goto err; |
| } |
| ret = snd_soc_dai_set_fmt(cpu_dai, |
| SND_SOC_DAIFMT_CBM_CFM); |
| if (ret < 0) |
| dev_err(card->dev, "%s Set fmt for cpu dai failed\n", |
| __func__); |
| } |
| err: |
| afe_enable_lpass_core_shared_clock(SECONDARY_I2S_RX, |
| CLOCK_OFF); |
| } |
| done: |
| if (ret) |
| atomic_dec_return(&sec_mi2s_ref_count); |
| return ret; |
| } |
| |
| static struct snd_soc_ops sdx_mi2s_be_ops = { |
| .startup = sdx_mi2s_startup, |
| .shutdown = sdx_mi2s_shutdown, |
| }; |
| |
| static struct snd_soc_ops sdx_sec_mi2s_be_ops = { |
| .startup = sdx_sec_mi2s_startup, |
| .shutdown = sdx_sec_mi2s_shutdown, |
| }; |
| |
| static int sdx_mi2s_rate_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s: sdx_i2s_rate = %d", __func__, sdx_mi2s_rate); |
| ucontrol->value.integer.value[0] = sdx_mi2s_rate; |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_rate_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s: sdx_sec_i2s_rate = %d", __func__, sdx_sec_mi2s_rate); |
| ucontrol->value.integer.value[0] = sdx_sec_mi2s_rate; |
| return 0; |
| } |
| |
| static int sdx_mi2s_rate_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_mi2s_rate = SAMPLE_RATE_8KHZ; |
| break; |
| case 1: |
| sdx_mi2s_rate = SAMPLE_RATE_16KHZ; |
| break; |
| case 2: |
| default: |
| sdx_mi2s_rate = SAMPLE_RATE_48KHZ; |
| break; |
| } |
| pr_debug("%s: sdx_i2s_rate = %d ucontrol->value = %d\n", |
| __func__, sdx_mi2s_rate, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_rate_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_sec_mi2s_rate = SAMPLE_RATE_8KHZ; |
| break; |
| case 1: |
| sdx_sec_mi2s_rate = SAMPLE_RATE_16KHZ; |
| break; |
| case 2: |
| default: |
| sdx_sec_mi2s_rate = SAMPLE_RATE_48KHZ; |
| break; |
| } |
| pr_debug("%s: sdx_sec_mi2s_rate = %d ucontrol->value = %d\n", |
| __func__, sdx_sec_mi2s_rate, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static void param_set_mask(struct snd_pcm_hw_params *p, int n, |
| unsigned int bit) |
| { |
| struct snd_mask *m = NULL; |
| |
| if (bit >= SNDRV_MASK_MAX) |
| return; |
| if ((n >= SNDRV_PCM_HW_PARAM_FIRST_MASK) && |
| (n <= SNDRV_PCM_HW_PARAM_LAST_MASK)) { |
| m = &(p->masks[n - SNDRV_PCM_HW_PARAM_FIRST_MASK]); |
| |
| m->bits[0] = 0; |
| m->bits[1] = 0; |
| m->bits[bit >> 5] |= (1 << (bit & 31)); |
| } |
| } |
| |
| static int sdx_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); |
| param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| SNDRV_PCM_FORMAT_S16_LE); |
| rate->min = rate->max = sdx_mi2s_rate; |
| channels->min = channels->max = sdx_mi2s_rx_ch; |
| return 0; |
| } |
| |
| static int sdx_sec_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); |
| param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| SNDRV_PCM_FORMAT_S16_LE); |
| rate->min = rate->max = sdx_sec_mi2s_rate; |
| channels->min = channels->max = sdx_sec_mi2s_rx_ch; |
| return 0; |
| } |
| |
| static int sdx_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); |
| param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| SNDRV_PCM_FORMAT_S16_LE); |
| rate->min = rate->max = sdx_mi2s_rate; |
| channels->min = channels->max = sdx_mi2s_tx_ch; |
| return 0; |
| } |
| |
| static int sdx_sec_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); |
| param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| SNDRV_PCM_FORMAT_S16_LE); |
| rate->min = rate->max = sdx_sec_mi2s_rate; |
| channels->min = channels->max = sdx_sec_mi2s_tx_ch; |
| return 0; |
| } |
| |
| static int sdx_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); |
| param_set_mask(params, SNDRV_PCM_HW_PARAM_FORMAT, |
| SNDRV_PCM_FORMAT_S16_LE); |
| rate->min = rate->max = sdx_mi2s_rate; |
| return 0; |
| } |
| |
| static int sdx_mi2s_rx_ch_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_mi2s_rx_ch %d\n", __func__, sdx_mi2s_rx_ch); |
| ucontrol->value.integer.value[0] = sdx_mi2s_rx_ch - 1; |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_rx_ch_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_sec_mi2s_rx_ch %d\n", __func__, sdx_mi2s_rx_ch); |
| ucontrol->value.integer.value[0] = sdx_sec_mi2s_rx_ch - 1; |
| return 0; |
| } |
| |
| static int sdx_mi2s_rx_ch_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| sdx_mi2s_rx_ch = ucontrol->value.integer.value[0] + 1; |
| pr_debug("%s sdx_mi2s_rx_ch %d\n", __func__, sdx_mi2s_rx_ch); |
| return 1; |
| } |
| |
| static int sdx_sec_mi2s_rx_ch_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| sdx_mi2s_rx_ch = ucontrol->value.integer.value[0] + 1; |
| pr_debug("%s sdx_sec_mi2s_rx_ch %d\n", __func__, sdx_sec_mi2s_rx_ch); |
| return 1; |
| } |
| |
| static int sdx_mi2s_tx_ch_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_mi2s_tx_ch %d\n", __func__, sdx_mi2s_tx_ch); |
| ucontrol->value.integer.value[0] = sdx_mi2s_tx_ch - 1; |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_tx_ch_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_sec_mi2s_tx_ch %d\n", __func__, sdx_mi2s_tx_ch); |
| ucontrol->value.integer.value[0] = sdx_sec_mi2s_tx_ch - 1; |
| return 0; |
| } |
| |
| static int sdx_mi2s_tx_ch_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| sdx_mi2s_tx_ch = ucontrol->value.integer.value[0] + 1; |
| pr_debug("%s sdx_mi2s_tx_ch %d\n", __func__, sdx_mi2s_tx_ch); |
| return 1; |
| } |
| |
| static int sdx_sec_mi2s_tx_ch_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| sdx_mi2s_tx_ch = ucontrol->value.integer.value[0] + 1; |
| pr_debug("%s sdx_sec_mi2s_tx_ch %d\n", __func__, sdx_sec_mi2s_tx_ch); |
| return 1; |
| } |
| |
| static int sdx_mi2s_mode_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_mi2s_mode %d\n", __func__, sdx_mi2s_mode); |
| ucontrol->value.integer.value[0] = sdx_mi2s_mode; |
| return 0; |
| } |
| |
| static int sdx_mi2s_mode_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_mi2s_mode = I2S_PCM_MASTER_MODE; |
| break; |
| case 1: |
| sdx_mi2s_mode = I2S_PCM_SLAVE_MODE; |
| break; |
| default: |
| sdx_mi2s_mode = I2S_PCM_MASTER_MODE; |
| break; |
| } |
| pr_debug("%s: sdx_mi2s_mode = %d ucontrol->value = %d\n", |
| __func__, sdx_mi2s_mode, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_mode_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_sec_mi2s_mode %d\n", __func__, sdx_sec_mi2s_mode); |
| ucontrol->value.integer.value[0] = sdx_sec_mi2s_mode; |
| return 0; |
| } |
| |
| static int sdx_sec_mi2s_mode_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_sec_mi2s_mode = I2S_PCM_MASTER_MODE; |
| break; |
| case 1: |
| sdx_sec_mi2s_mode = I2S_PCM_SLAVE_MODE; |
| break; |
| default: |
| sdx_sec_mi2s_mode = I2S_PCM_MASTER_MODE; |
| break; |
| } |
| pr_debug("%s: sdx_sec_mi2s_mode = %d ucontrol->value = %d\n", |
| __func__, sdx_sec_mi2s_mode, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int sdx_auxpcm_mode_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_auxpcm_mode %d\n", __func__, sdx_auxpcm_mode); |
| ucontrol->value.integer.value[0] = sdx_auxpcm_mode; |
| return 0; |
| } |
| |
| static int sdx_auxpcm_mode_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| break; |
| case 1: |
| sdx_auxpcm_mode = I2S_PCM_SLAVE_MODE; |
| break; |
| default: |
| sdx_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| break; |
| } |
| pr_debug("%s: sdx_auxpcm_mode = %d ucontrol->value = %d\n", |
| __func__, sdx_auxpcm_mode, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int sdx_sec_auxpcm_mode_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_sec_auxpcm_mode %d\n", __func__, sdx_sec_auxpcm_mode); |
| ucontrol->value.integer.value[0] = sdx_sec_auxpcm_mode; |
| return 0; |
| } |
| |
| static int sdx_sec_auxpcm_mode_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 0: |
| sdx_sec_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| break; |
| case 1: |
| sdx_sec_auxpcm_mode = I2S_PCM_SLAVE_MODE; |
| break; |
| default: |
| sdx_sec_auxpcm_mode = I2S_PCM_MASTER_MODE; |
| break; |
| } |
| pr_debug("%s: sdx_sec_auxpcm_mode = %d ucontrol->value = %d\n", |
| __func__, sdx_sec_auxpcm_mode, |
| (int)ucontrol->value.integer.value[0]); |
| return 0; |
| } |
| |
| static int sdx_mi2s_get_spk(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s sdx_spk_control %d", __func__, sdx_spk_control); |
| ucontrol->value.integer.value[0] = sdx_spk_control; |
| return 0; |
| } |
| |
| static void sdx_ext_control(struct snd_soc_codec *codec) |
| { |
| struct snd_soc_dapm_context *dapm = snd_soc_codec_get_dapm(codec); |
| |
| pr_debug("%s sdx_spk_control %d", __func__, sdx_spk_control); |
| |
| if (sdx_spk_control == SDX_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"); |
| } |
| snd_soc_dapm_sync(dapm); |
| } |
| |
| static int sdx_mi2s_set_spk(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct snd_soc_codec *codec = snd_soc_kcontrol_codec(kcontrol); |
| |
| pr_debug("%s()\n", __func__); |
| |
| if (sdx_spk_control == ucontrol->value.integer.value[0]) |
| return 0; |
| sdx_spk_control = ucontrol->value.integer.value[0]; |
| sdx_ext_control(codec); |
| return 1; |
| } |
| |
| static int sdx_hifi_ctrl(struct snd_soc_codec *codec) |
| { |
| struct snd_soc_dapm_context *dapm = |
| snd_soc_codec_get_dapm(codec); |
| struct snd_soc_card *card = codec->component.card; |
| struct sdx_machine_data *pdata = |
| snd_soc_card_get_drvdata(card); |
| |
| pr_debug("%s: sdx_hifi_control = %d", __func__, sdx_hifi_control); |
| if (pdata->hph_en1_gpio < 0) { |
| pr_err("%s: hph_en1_gpio is invalid\n", __func__); |
| return -EINVAL; |
| } |
| |
| if (sdx_hifi_control == SDX_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); |
| |
| snd_soc_dapm_sync(dapm); |
| return 0; |
| } |
| |
| static int sdx_hifi_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| pr_debug("%s: sdx_hifi_control = %d\n", |
| __func__, sdx_hifi_control); |
| ucontrol->value.integer.value[0] = sdx_hifi_control; |
| return 0; |
| } |
| |
| static int sdx_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]); |
| sdx_hifi_control = ucontrol->value.integer.value[0]; |
| sdx_hifi_ctrl(codec); |
| return 1; |
| } |
| |
| static int sdx_mclk_event(struct snd_soc_dapm_widget *w, |
| struct snd_kcontrol *kcontrol, int event) |
| { |
| struct snd_soc_codec *codec = snd_soc_dapm_to_codec(w->dapm); |
| |
| pr_debug("%s event %d\n", __func__, event); |
| |
| switch (event) { |
| case SND_SOC_DAPM_PRE_PMU: |
| tavil_cdc_mclk_enable(codec, 1); |
| break; |
| case SND_SOC_DAPM_POST_PMD: |
| tavil_cdc_mclk_enable(codec, 0); |
| break; |
| } |
| return 0; |
| } |
| |
| static void sdx_auxpcm_shutdown(struct snd_pcm_substream *substream) |
| { |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| int ret; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| if (pdata->prim_auxpcm_mode == 1) |
| ret = msm_cdc_pinctrl_select_sleep_state(pdata->prim_master_p); |
| else |
| ret = msm_cdc_pinctrl_select_sleep_state(pdata->prim_slave_p); |
| if (ret) |
| pr_err("%s: failed to set prim gpios to sleep: %d\n", |
| __func__, ret); |
| } |
| |
| static int sdx_auxpcm_startup(struct snd_pcm_substream *substream) |
| { |
| int ret = 0; |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| pdata->prim_auxpcm_mode = sdx_auxpcm_mode; |
| if (pdata->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(PCM_SEL << I2S_PCM_SEL_OFFSET, |
| pdata->lpaif_pri_muxsel_virt_addr); |
| if (pdata->lpass_mux_spkr_ctl_virt_addr != NULL) { |
| if (pdata->prim_auxpcm_mode == 1) |
| iowrite32(PRI_TLMM_CLKS_EN_MASTER, |
| pdata->lpass_mux_spkr_ctl_virt_addr); |
| else |
| iowrite32(PRI_TLMM_CLKS_EN_SLAVE, |
| pdata->lpass_mux_spkr_ctl_virt_addr); |
| } else { |
| dev_err(card->dev, "%s lpass_mux_spkr_ctl_virt_addr is NULL\n", |
| __func__); |
| ret = -EINVAL; |
| } |
| } else { |
| dev_err(card->dev, "%s lpaif_pri_muxsel_virt_addr is NULL\n", |
| __func__); |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| if (pdata->prim_auxpcm_mode == 1) { |
| ret = msm_cdc_pinctrl_select_active_state |
| (pdata->prim_master_p); |
| if (ret < 0) |
| pr_err("%s pinctrl set failed\n", __func__); |
| } else { |
| ret = msm_cdc_pinctrl_select_active_state(pdata->prim_slave_p); |
| if (ret < 0) |
| pr_err("%s pinctrl set failed\n", __func__); |
| } |
| afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); |
| done: |
| return ret; |
| } |
| |
| static struct snd_soc_ops sdx_auxpcm_be_ops = { |
| .startup = sdx_auxpcm_startup, |
| .shutdown = sdx_auxpcm_shutdown, |
| }; |
| |
| static void sdx_sec_auxpcm_shutdown(struct snd_pcm_substream *substream) |
| { |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| int ret; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| if (pdata->sec_auxpcm_mode == 1) |
| ret = msm_cdc_pinctrl_select_sleep_state(pdata->sec_master_p); |
| else |
| ret = msm_cdc_pinctrl_select_sleep_state(pdata->sec_slave_p); |
| if (ret) |
| pr_err("%s: failed to set sec gpios to sleep: %d\n", |
| __func__, ret); |
| } |
| |
| static int sdx_sec_auxpcm_startup(struct snd_pcm_substream *substream) |
| { |
| int ret = 0; |
| struct snd_soc_pcm_runtime *rtd = substream->private_data; |
| struct snd_soc_card *card = rtd->card; |
| struct sdx_machine_data *pdata = snd_soc_card_get_drvdata(card); |
| |
| pdata->sec_auxpcm_mode = sdx_sec_auxpcm_mode; |
| if (pdata->lpaif_sec_muxsel_virt_addr != NULL) { |
| ret = afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_ON); |
| if (ret < 0) { |
| ret = -EINVAL; |
| goto done; |
| } |
| iowrite32(PCM_SEL << I2S_PCM_SEL_OFFSET, |
| pdata->lpaif_sec_muxsel_virt_addr); |
| if (pdata->lpass_mux_mic_ctl_virt_addr != NULL) { |
| if (pdata->sec_auxpcm_mode == 1) |
| iowrite32(SEC_TLMM_CLKS_EN_MASTER, |
| pdata->lpass_mux_mic_ctl_virt_addr); |
| else |
| iowrite32(SEC_TLMM_CLKS_EN_SLAVE, |
| pdata->lpass_mux_mic_ctl_virt_addr); |
| } else { |
| dev_err(card->dev, |
| "%s lpass_mux_mic_ctl_virt_addr is NULL\n", |
| __func__); |
| ret = -EINVAL; |
| } |
| } else { |
| dev_err(card->dev, |
| "%s lpaif_sec_muxsel_virt_addr is NULL\n", __func__); |
| ret = -EINVAL; |
| goto done; |
| } |
| |
| if (pdata->sec_auxpcm_mode == 1) { |
| ret = msm_cdc_pinctrl_select_active_state(pdata->sec_master_p); |
| if (ret < 0) |
| pr_err("%s pinctrl set failed\n", __func__); |
| } else { |
| ret = msm_cdc_pinctrl_select_active_state(pdata->sec_slave_p); |
| if (ret < 0) |
| pr_err("%s pinctrl set failed\n", __func__); |
| } |
| afe_enable_lpass_core_shared_clock(MI2S_RX, CLOCK_OFF); |
| done: |
| return ret; |
| } |
| |
| static struct snd_soc_ops sdx_sec_auxpcm_be_ops = { |
| .startup = sdx_sec_auxpcm_startup, |
| .shutdown = sdx_sec_auxpcm_shutdown, |
| }; |
| |
| static int sdx_auxpcm_rate_get(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| ucontrol->value.integer.value[0] = sdx_auxpcm_rate; |
| return 0; |
| } |
| |
| static int sdx_auxpcm_rate_put(struct snd_kcontrol *kcontrol, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| switch (ucontrol->value.integer.value[0]) { |
| case 1: |
| sdx_auxpcm_rate = 16000; |
| break; |
| case 0: |
| default: |
| sdx_auxpcm_rate = 8000; |
| break; |
| } |
| return 0; |
| } |
| |
| static int sdx_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 = sdx_auxpcm_rate; |
| channels->min = channels->max = 1; |
| |
| return 0; |
| } |
| |
| static const struct snd_soc_dapm_widget sdx_dapm_widgets[] = { |
| |
| SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM, 0, 0, |
| sdx_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 wcd_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_rate_text[] = {"rate_8000", |
| "rate_16000", "rate_48000"}; |
| static const char *const mode_text[] = {"master", "slave"}; |
| |
| static const struct soc_enum sdx_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_rate_text), |
| SOC_ENUM_SINGLE_EXT(2, hifi_function), |
| SOC_ENUM_SINGLE_EXT(2, mode_text), |
| }; |
| |
| static const struct snd_kcontrol_new sdx_snd_controls[] = { |
| SOC_ENUM_EXT("Speaker Function", sdx_enum[0], |
| sdx_mi2s_get_spk, |
| sdx_mi2s_set_spk), |
| SOC_ENUM_EXT("MI2S_RX Channels", sdx_enum[1], |
| sdx_mi2s_rx_ch_get, |
| sdx_mi2s_rx_ch_put), |
| SOC_ENUM_EXT("MI2S_TX Channels", sdx_enum[2], |
| sdx_mi2s_tx_ch_get, |
| sdx_mi2s_tx_ch_put), |
| SOC_ENUM_EXT("AUX PCM SampleRate", sdx_enum[3], |
| sdx_auxpcm_rate_get, |
| sdx_auxpcm_rate_put), |
| SOC_ENUM_EXT("MI2S SampleRate", sdx_enum[4], |
| sdx_mi2s_rate_get, |
| sdx_mi2s_rate_put), |
| SOC_ENUM_EXT("SEC_MI2S_RX Channels", sdx_enum[1], |
| sdx_sec_mi2s_rx_ch_get, |
| sdx_sec_mi2s_rx_ch_put), |
| SOC_ENUM_EXT("SEC_MI2S_TX Channels", sdx_enum[2], |
| sdx_sec_mi2s_tx_ch_get, |
| sdx_sec_mi2s_tx_ch_put), |
| SOC_ENUM_EXT("SEC MI2S SampleRate", sdx_enum[4], |
| sdx_sec_mi2s_rate_get, |
| sdx_sec_mi2s_rate_put), |
| SOC_ENUM_EXT("HiFi Function", sdx_enum[5], |
| sdx_hifi_get, |
| sdx_hifi_put), |
| SOC_ENUM_EXT("MI2S Mode", sdx_enum[6], |
| sdx_mi2s_mode_get, |
| sdx_mi2s_mode_put), |
| SOC_ENUM_EXT("SEC_MI2S Mode", sdx_enum[6], |
| sdx_sec_mi2s_mode_get, |
| sdx_sec_mi2s_mode_put), |
| SOC_ENUM_EXT("AUXPCM Mode", sdx_enum[6], |
| sdx_auxpcm_mode_get, |
| sdx_auxpcm_mode_put), |
| SOC_ENUM_EXT("SEC_AUXPCM Mode", sdx_enum[6], |
| sdx_sec_auxpcm_mode_get, |
| sdx_sec_auxpcm_mode_put), |
| }; |
| |
| static int sdx_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 = |
| snd_soc_codec_get_dapm(codec); |
| struct snd_soc_dai *cpu_dai = rtd->cpu_dai; |
| struct snd_card *card; |
| struct snd_info_entry *entry; |
| struct sdx_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, sdx_snd_controls, |
| ARRAY_SIZE(sdx_snd_controls)); |
| if (ret < 0) { |
| pr_err("%s: add_codec_controls failed, %d\n", |
| __func__, ret); |
| goto done; |
| } |
| |
| snd_soc_dapm_new_controls(dapm, sdx_dapm_widgets, |
| ARRAY_SIZE(sdx_dapm_widgets)); |
| |
| snd_soc_dapm_add_routes(dapm, wcd_audio_paths, |
| ARRAY_SIZE(wcd_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, "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, "LINEOUT1"); |
| snd_soc_dapm_ignore_suspend(dapm, "LINEOUT2"); |
| 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, "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, "DMIC0"); |
| snd_soc_dapm_ignore_suspend(dapm, "SPK1 OUT"); |
| snd_soc_dapm_ignore_suspend(dapm, "SPK2 OUT"); |
| 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_sync(dapm); |
| |
| wcd_mbhc_cfg.calibration = def_tavil_mbhc_cal(); |
| if (wcd_mbhc_cfg.calibration) |
| ret = tavil_mbhc_hs_detect(codec, &wcd_mbhc_cfg); |
| else |
| ret = -ENOMEM; |
| |
| card = rtd->card->snd_card; |
| entry = snd_info_create_subdir(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; |
| tavil_codec_info_create_codec_entry(pdata->codec_root, codec); |
| done: |
| return ret; |
| } |
| |
| static void *def_tavil_mbhc_cal(void) |
| { |
| void *tavil_wcd_cal; |
| struct wcd_mbhc_btn_detect_cfg *btn_cfg; |
| u16 *btn_high; |
| |
| tavil_wcd_cal = kzalloc(WCD_MBHC_CAL_SIZE(WCD_MBHC_DEF_BUTTONS, |
| WCD9XXX_MBHC_DEF_RLOADS), GFP_KERNEL); |
| if (!tavil_wcd_cal) |
| return NULL; |
| |
| #define S(X, Y) ((WCD_MBHC_CAL_PLUG_TYPE_PTR(tavil_wcd_cal)->X) = (Y)) |
| S(v_hs_max, 1600); |
| #undef S |
| #define S(X, Y) ((WCD_MBHC_CAL_BTN_DET_PTR(tavil_wcd_cal)->X) = (Y)) |
| S(num_btn, WCD_MBHC_DEF_BUTTONS); |
| #undef S |
| |
| btn_cfg = WCD_MBHC_CAL_BTN_DET_PTR(tavil_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] = 500; |
| btn_high[4] = 500; |
| btn_high[5] = 500; |
| btn_high[6] = 500; |
| btn_high[7] = 500; |
| |
| return tavil_wcd_cal; |
| } |
| |
| /* Digital audio interface connects codec <---> CPU */ |
| static struct snd_soc_dai_link sdx_common_dai_links[] = { |
| /* FrontEnd DAI Links */ |
| { |
| .name = SDX_DAILINK_NAME(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, |
| .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, |
| .id = MSM_FRONTEND_DAI_VOIP, |
| }, |
| { |
| .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 = "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, |
| .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 = SDX_DAILINK_NAME(Compress1), |
| .stream_name = "COMPR", |
| .cpu_dai_name = "MultiMedia4", |
| .platform_name = "msm-compress-dsp", |
| .dynamic = 1, |
| .async_ops = ASYNC_DPCM_SND_SOC_HW_PARAMS, |
| .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, |
| .ignore_pmdown_time = 1, |
| .id = MSM_FRONTEND_DAI_MULTIMEDIA4, |
| }, |
| { |
| .name = SDX_DAILINK_NAME(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 */ |
| .id = MSM_FRONTEND_DAI_MULTIMEDIA2, |
| }, |
| { |
| .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 = SDX_DAILINK_NAME(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, |
| .id = MSM_FRONTEND_DAI_MULTIMEDIA5, |
| }, |
| { |
| .name = "SDX 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, |
| .id = MSM_FRONTEND_DAI_VOICEMMODE1, |
| }, |
| { |
| .name = "SDX 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, |
| .id = MSM_FRONTEND_DAI_VOICEMMODE2, |
| }, |
| { |
| .name = "VoiceMMode1 HOST RX CAPTURE", |
| .stream_name = "VoiceMMode1 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 = "VoiceMMode1 HOST RX PLAYBACK", |
| .stream_name = "VoiceMMode1 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 = "VoiceMMode1 HOST TX CAPTURE", |
| .stream_name = "VoiceMMode1 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 = "VoiceMMode1 HOST TX PLAYBACK", |
| .stream_name = "VoiceMMode1 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 = "VoiceMMode2 HOST RX CAPTURE", |
| .stream_name = "VoiceMMode2 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 = "VoiceMMode2 HOST RX PLAYBACK", |
| .stream_name = "VOiceMMode2 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 = "VoiceMMode2 HOST TX CAPTURE", |
| .stream_name = "VoiceMMode2 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 = "VoiceMMode2 HOST TX PLAYBACK", |
| .stream_name = "VOiceMMode2 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 = "Secondary MI2S RX Hostless", |
| .stream_name = "Secondary MI2S_RX Hostless Playback", |
| .cpu_dai_name = "SEC_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 = "Secondary MI2S TX Hostless", |
| .stream_name = "Secondary MI2S_TX Hostless Playback", |
| .cpu_dai_name = "SEC_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 = "Primary AUXPCM RX Hostless", |
| .stream_name = "AUXPCM_HOSTLESS Playback", |
| .cpu_dai_name = "AUXPCM_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 = "Primary AUXPCM TX Hostless", |
| .stream_name = "AUXPCM_HOSTLESS Capture", |
| .cpu_dai_name = "AUXPCM_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 = "Secondary AUXPCM RX Hostless", |
| .stream_name = "SEC_AUXPCM_HOSTLESS Playback", |
| .cpu_dai_name = "SEC_AUXPCM_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 = "Secondary AUXPCM TX Hostless", |
| .stream_name = "SEC_AUXPCM_HOSTLESS Capture", |
| .cpu_dai_name = "SEC_AUXPCM_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", |
| }, |
| }; |
| |
| static struct snd_soc_dai_link sdx_common_misc_fe_dai_links[] = { |
| { |
| .name = SDX_DAILINK_NAME(ASM Loopback), |
| .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 */ |
| .id = MSM_FRONTEND_DAI_MULTIMEDIA6, |
| }, |
| }; |
| |
| static struct snd_soc_dai_link sdx_common_be_dai_links[] = { |
| /* Backend AFE DAI Links */ |
| { |
| .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, |
| .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, |
| .id = MSM_BACKEND_DAI_AFE_PCM_TX, |
| .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, |
| .id = MSM_BACKEND_DAI_INCALL_RECORD_TX, |
| .be_hw_params_fixup = sdx_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, |
| .id = MSM_BACKEND_DAI_INCALL_RECORD_RX, |
| .be_hw_params_fixup = sdx_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, |
| .id = MSM_BACKEND_DAI_VOICE_PLAYBACK_TX, |
| .be_hw_params_fixup = sdx_be_hw_params_fixup, |
| .ignore_suspend = 1, |
| }, |
| }; |
| |
| static struct snd_soc_dai_link sdx_mi2s_be_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 = "tavil_codec", |
| .codec_dai_name = "tavil_i2s_rx1", |
| .no_pcm = 1, |
| .dpcm_playback = 1, |
| .id = MSM_BACKEND_DAI_PRI_MI2S_RX, |
| .init = &sdx_mi2s_audrx_init, |
| .be_hw_params_fixup = &sdx_mi2s_rx_be_hw_params_fixup, |
| .ops = &sdx_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 = "tavil_codec", |
| .codec_dai_name = "tavil_i2s_tx1", |
| .no_pcm = 1, |
| .dpcm_capture = 1, |
| .id = MSM_BACKEND_DAI_PRI_MI2S_TX, |
| .be_hw_params_fixup = &sdx_mi2s_tx_be_hw_params_fixup, |
| .ops = &sdx_mi2s_be_ops, |
| .ignore_pmdown_time = 1, |
| .ignore_suspend = 1, |
| }, |
| { |
| .name = LPASS_BE_SEC_MI2S_RX, |
| .stream_name = "Secondary MI2S Playback", |
| .cpu_dai_name = "msm-dai-q6-mi2s.1", |
| .platform_name = "msm-pcm-routing", |
| .codec_name = "msm-stub-codec.1", |
| .codec_dai_name = "msm-stub-rx", |
| .no_pcm = 1, |
| .dpcm_playback = 1, |
| .id = MSM_BACKEND_DAI_SECONDARY_MI2S_RX, |
| .be_hw_params_fixup = &sdx_sec_mi2s_rx_be_hw_params_fixup, |
| .ops = &sdx_sec_mi2s_be_ops, |
| .ignore_pmdown_time = 1, |
| .ignore_suspend = 1, |
| }, |
| { |
| .name = LPASS_BE_SEC_MI2S_TX, |
| .stream_name = "Secondary MI2S Capture", |
| .cpu_dai_name = "msm-dai-q6-mi2s.1", |
| .platform_name = "msm-pcm-routing", |
| .codec_name = "msm-stub-codec.1", |
| .codec_dai_name = "msm-stub-tx", |
| .no_pcm = 1, |
| .dpcm_capture = 1, |
| .id = MSM_BACKEND_DAI_SECONDARY_MI2S_TX, |
| .be_hw_params_fixup = &sdx_sec_mi2s_tx_be_hw_params_fixup, |
| .ops = &sdx_sec_mi2s_be_ops, |
| .ignore_pmdown_time = 1, |
| .ignore_suspend = 1, |
| }, |
| }; |
| |
| static struct snd_soc_dai_link sdx_auxpcm_be_dai_links[] = { |
| /* Primary AUX PCM Backend DAI Links */ |
| { |
| .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, |
| .id = MSM_BACKEND_DAI_AUXPCM_RX, |
| .be_hw_params_fixup = sdx_auxpcm_be_params_fixup, |
| .ops = &sdx_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, |
| .id = MSM_BACKEND_DAI_AUXPCM_TX, |
| .be_hw_params_fixup = sdx_auxpcm_be_params_fixup, |
| .ops = &sdx_auxpcm_be_ops, |
| .ignore_suspend = 1, |
| }, |
| /* Secondary AUX PCM Backend DAI Links */ |
| { |
| .name = LPASS_BE_SEC_AUXPCM_RX, |
| .stream_name = "Sec AUX PCM Playback", |
| .cpu_dai_name = "msm-dai-q6-auxpcm.2", |
| .platform_name = "msm-pcm-routing", |
| .codec_name = "msm-stub-codec.1", |
| .codec_dai_name = "msm-stub-rx", |
| .no_pcm = 1, |
| .dpcm_playback = 1, |
| .id = MSM_BACKEND_DAI_SEC_AUXPCM_RX, |
| .be_hw_params_fixup = sdx_auxpcm_be_params_fixup, |
| .ops = &sdx_sec_auxpcm_be_ops, |
| .ignore_pmdown_time = 1, |
| .ignore_suspend = 1, |
| }, |
| { |
| .name = LPASS_BE_SEC_AUXPCM_TX, |
| .stream_name = "Sec AUX PCM Capture", |
| .cpu_dai_name = "msm-dai-q6-auxpcm.2", |
| .platform_name = "msm-pcm-routing", |
| .codec_name = "msm-stub-codec.1", |
| .codec_dai_name = "msm-stub-tx", |
| .no_pcm = 1, |
| .dpcm_capture = 1, |
| .id = MSM_BACKEND_DAI_SEC_AUXPCM_TX, |
| .be_hw_params_fixup = sdx_auxpcm_be_params_fixup, |
| .ops = &sdx_sec_auxpcm_be_ops, |
| .ignore_suspend = 1, |
| }, |
| }; |
| |
| static struct snd_soc_dai_link sdx_tavil_snd_card_dai_links[ |
| ARRAY_SIZE(sdx_common_dai_links) + |
| ARRAY_SIZE(sdx_common_misc_fe_dai_links) + |
| ARRAY_SIZE(sdx_common_be_dai_links) + |
| ARRAY_SIZE(sdx_mi2s_be_dai_links) + |
| ARRAY_SIZE(sdx_auxpcm_be_dai_links)]; |
| |
| static struct snd_soc_card snd_soc_card_tavil_sdx = { |
| .name = "sdx-tavil-i2s-snd-card", |
| }; |
| |
| static int sdx_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 struct snd_soc_card *populate_snd_card_dailinks(struct device *dev) |
| { |
| struct snd_soc_card *card = NULL; |
| int len_1, len_2, len_3, len_4; |
| int total_links; |
| |
| card = &snd_soc_card_tavil_sdx; |
| len_1 = ARRAY_SIZE(sdx_common_dai_links); |
| len_2 = len_1 + ARRAY_SIZE(sdx_common_misc_fe_dai_links); |
| len_3 = len_2 + ARRAY_SIZE(sdx_common_be_dai_links); |
| len_4 = len_3 + ARRAY_SIZE(sdx_mi2s_be_dai_links); |
| total_links = len_4 + ARRAY_SIZE(sdx_auxpcm_be_dai_links); |
| memcpy(sdx_tavil_snd_card_dai_links, |
| sdx_common_dai_links, |
| sizeof(sdx_common_dai_links)); |
| memcpy(sdx_tavil_snd_card_dai_links + len_1, |
| sdx_common_misc_fe_dai_links, |
| sizeof(sdx_common_misc_fe_dai_links)); |
| memcpy(sdx_tavil_snd_card_dai_links + len_2, |
| sdx_common_be_dai_links, |
| sizeof(sdx_common_be_dai_links)); |
| memcpy(sdx_tavil_snd_card_dai_links + len_3, |
| sdx_mi2s_be_dai_links, |
| sizeof(sdx_mi2s_be_dai_links)); |
| memcpy(sdx_tavil_snd_card_dai_links + len_4, |
| sdx_auxpcm_be_dai_links, |
| sizeof(sdx_auxpcm_be_dai_links)); |
| |
| if (card) { |
| card->dai_link = sdx_tavil_snd_card_dai_links; |
| card->num_links = total_links; |
| } |
| |
| return card; |
| } |
| |
| static int sdx_init_wsa_dev(struct platform_device *pdev, |
| struct snd_soc_card *card) |
| { |
| struct device_node *wsa_of_node; |
| u32 wsa_max_devs; |
| u32 wsa_dev_cnt; |
| char *dev_name_str = NULL; |
| struct sdx_wsa881x_dev_info *wsa881x_dev_info; |
| const char *wsa_auxdev_name_prefix[1]; |
| int found = 0; |
| int i; |
| int ret; |
| |
| /* Get maximum WSA device count for this platform */ |
| ret = of_property_read_u32(pdev->dev.of_node, |
| "qcom,wsa-max-devs", &wsa_max_devs); |
| if (ret) { |
| dev_dbg(&pdev->dev, |
| "%s: wsa-max-devs property missing in DT %s, ret = %d\n", |
| __func__, pdev->dev.of_node->full_name, ret); |
| return 0; |
| } |
| if (wsa_max_devs == 0) { |
| dev_warn(&pdev->dev, |
| "%s: Max WSA devices is 0 for this target?\n", |
| __func__); |
| return 0; |
| } |
| |
| /* Get count of WSA device phandles for this platform */ |
| wsa_dev_cnt = of_count_phandle_with_args(pdev->dev.of_node, |
| "qcom,wsa-devs", NULL); |
| if (wsa_dev_cnt == -ENOENT) { |
| dev_dbg(&pdev->dev, "%s: No wsa device defined in DT.\n", |
| __func__); |
| return 0; |
| } else if (wsa_dev_cnt <= 0) { |
| dev_err(&pdev->dev, |
| "%s: Error reading wsa device from DT. wsa_dev_cnt = %d\n", |
| __func__, wsa_dev_cnt); |
| return -EINVAL; |
| } |
| |
| /* |
| * Expect total phandles count to be NOT less than maximum possible |
| * WSA count. However, if it is less, then assign same value to |
| * max count as well. |
| */ |
| if (wsa_dev_cnt < wsa_max_devs) { |
| dev_dbg(&pdev->dev, |
| "%s: wsa_max_devs = %d cannot exceed wsa_dev_cnt = %d\n", |
| __func__, wsa_max_devs, wsa_dev_cnt); |
| wsa_max_devs = wsa_dev_cnt; |
| } |
| |
| /* Make sure prefix string passed for each WSA device */ |
| ret = of_property_count_strings(pdev->dev.of_node, |
| "qcom,wsa-aux-dev-prefix"); |
| if (ret != wsa_dev_cnt) { |
| dev_err(&pdev->dev, |
| "%s: expecting %d wsa prefix. Defined only %d in DT\n", |
| __func__, wsa_dev_cnt, ret); |
| return -EINVAL; |
| } |
| |
| /* |
| * Alloc mem to store phandle and index info of WSA device, if already |
| * registered with ALSA core |
| */ |
| wsa881x_dev_info = devm_kcalloc(&pdev->dev, wsa_max_devs, |
| sizeof(struct sdx_wsa881x_dev_info), |
| GFP_KERNEL); |
| if (!wsa881x_dev_info) |
| return -ENOMEM; |
| |
| /* |
| * search and check whether all WSA devices are already |
| * registered with ALSA core or not. If found a node, store |
| * the node and the index in a local array of struct for later |
| * use. |
| */ |
| for (i = 0; i < wsa_dev_cnt; i++) { |
| wsa_of_node = of_parse_phandle(pdev->dev.of_node, |
| "qcom,wsa-devs", i); |
| if (unlikely(!wsa_of_node)) { |
| /* we should not be here */ |
| dev_err(&pdev->dev, |
| "%s: wsa dev node is not present\n", |
| __func__); |
| return -EINVAL; |
| } |
| if (soc_find_component(wsa_of_node, NULL)) { |
| /* WSA device registered with ALSA core */ |
| wsa881x_dev_info[found].of_node = wsa_of_node; |
| wsa881x_dev_info[found].index = i; |
| found++; |
| if (found == wsa_max_devs) |
| break; |
| } |
| } |
| |
| if (found < wsa_max_devs) { |
| dev_dbg(&pdev->dev, |
| "%s: failed to find %d components. Found only %d\n", |
| __func__, wsa_max_devs, found); |
| return -EPROBE_DEFER; |
| } |
| dev_info(&pdev->dev, |
| "%s: found %d wsa881x devices registered with ALSA core\n", |
| __func__, found); |
| |
| card->num_aux_devs = wsa_max_devs; |
| card->num_configs = wsa_max_devs; |
| |
| /* Alloc array of AUX devs struct */ |
| sdx_aux_dev = devm_kcalloc(&pdev->dev, card->num_aux_devs, |
| sizeof(struct snd_soc_aux_dev), |
| GFP_KERNEL); |
| if (!sdx_aux_dev) |
| return -ENOMEM; |
| |
| /* Alloc array of codec conf struct */ |
| sdx_codec_conf = devm_kcalloc(&pdev->dev, card->num_aux_devs, |
| sizeof(struct snd_soc_codec_conf), |
| GFP_KERNEL); |
| if (!sdx_codec_conf) |
| return -ENOMEM; |
| |
| for (i = 0; i < card->num_aux_devs; i++) { |
| dev_name_str = devm_kzalloc(&pdev->dev, DEV_NAME_STR_LEN, |
| GFP_KERNEL); |
| if (!dev_name_str) |
| return -ENOMEM; |
| |
| ret = of_property_read_string_index(pdev->dev.of_node, |
| "qcom,wsa-aux-dev-prefix", |
| wsa881x_dev_info[i].index, |
| wsa_auxdev_name_prefix); |
| if (ret) { |
| dev_err(&pdev->dev, |
| "%s: failed to read wsa aux dev prefix, ret = %d\n", |
| __func__, ret); |
| return -EINVAL; |
| } |
| |
| snprintf(dev_name_str, strlen("wsa881x.%d"), "wsa881x.%d", i); |
| sdx_aux_dev[i].name = dev_name_str; |
| sdx_aux_dev[i].codec_name = NULL; |
| sdx_aux_dev[i].codec_of_node = wsa881x_dev_info[i].of_node; |
| sdx_aux_dev[i].init = sdx_wsa881x_init; |
| sdx_codec_conf[i].dev_name = NULL; |
| sdx_codec_conf[i].name_prefix = wsa_auxdev_name_prefix[0]; |
| sdx_codec_conf[i].of_node = wsa881x_dev_info[i].of_node; |
| } |
| card->codec_conf = sdx_codec_conf; |
| card->aux_dev = sdx_aux_dev; |
| |
| return 0; |
| } |
| |
| static int sdx_asoc_machine_probe(struct platform_device *pdev) |
| { |
| int ret; |
| struct sdx_machine_data *pdata; |
| struct snd_soc_card *card; |
| |
| 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 sdx_machine_data), |
| GFP_KERNEL); |
| if (!pdata) |
| return -ENOMEM; |
| |
| card = populate_snd_card_dailinks(&pdev->dev); |
| if (!card) { |
| dev_err(&pdev->dev, "%s: Card uninitialized\n", __func__); |
| ret = -EINVAL; |
| goto err; |
| } |
| |
| ret = of_property_read_u32(pdev->dev.of_node, |
| "qcom,tavil-mclk-clk-freq", |
| &pdata->mclk_freq); |
| if (ret) { |
| dev_err(&pdev->dev, |
| "%s Looking up %s property in node %s failed", |
| __func__, "qcom,tavil-mclk-clk-freq", |
| pdev->dev.of_node->full_name); |
| |
| goto err; |
| } |
| /* At present only 12.288MHz is supported on SDX. */ |
| if (q6afe_check_osr_clk_freq(pdata->mclk_freq)) { |
| dev_err(&pdev->dev, "%s Unsupported tavil mclk freq %u\n", |
| __func__, pdata->mclk_freq); |
| |
| ret = -EINVAL; |
| goto err; |
| } |
| |
| pdata->prim_master_p = of_parse_phandle(pdev->dev.of_node, |
| "qcom,prim_mi2s_aux_master", |
| 0); |
| pdata->prim_slave_p = of_parse_phandle(pdev->dev.of_node, |
| "qcom,prim_mi2s_aux_slave", 0); |
| pdata->sec_master_p = of_parse_phandle(pdev->dev.of_node, |
| "qcom,sec_mi2s_aux_master", 0); |
| pdata->sec_slave_p = of_parse_phandle(pdev->dev.of_node, |
| "qcom,sec_mi2s_aux_slave", 0); |
| mutex_init(&cdc_mclk_mutex); |
| atomic_set(&mi2s_ref_count, 0); |
| atomic_set(&sec_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 = sdx_populate_dai_link_component_of_node(card); |
| if (ret) { |
| ret = -EPROBE_DEFER; |
| goto err; |
| } |
| |
| ret = sdx_init_wsa_dev(pdev, card); |
| if (ret) |
| 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; |
| } |
| |
| pdata->lpaif_pri_muxsel_virt_addr = ioremap(LPAIF_PRI_MODE_MUXSEL, 4); |
| if (pdata->lpaif_pri_muxsel_virt_addr == NULL) { |
| pr_err("%s Pri muxsel virt addr is null\n", __func__); |
| |
| ret = -EINVAL; |
| goto err; |
| } |
| pdata->lpass_mux_spkr_ctl_virt_addr = |
| ioremap(LPASS_CSR_GP_IO_MUX_SPKR_CTL, 4); |
| if (pdata->lpass_mux_spkr_ctl_virt_addr == NULL) { |
| pr_err("%s lpass spkr ctl virt addr is null\n", __func__); |
| |
| ret = -EINVAL; |
| goto err1; |
| } |
| |
| pdata->lpaif_sec_muxsel_virt_addr = ioremap(LPAIF_SEC_MODE_MUXSEL, 4); |
| if (pdata->lpaif_sec_muxsel_virt_addr == NULL) { |
| pr_err("%s Sec muxsel virt addr is null\n", __func__); |
| ret = -EINVAL; |
| goto err2; |
| } |
| |
| pdata->lpass_mux_mic_ctl_virt_addr = |
| ioremap(LPASS_CSR_GP_IO_MUX_MIC_CTL, 4); |
| if (pdata->lpass_mux_mic_ctl_virt_addr == NULL) { |
| pr_err("%s lpass_mux_mic_ctl_virt_addr is null\n", |
| __func__); |
| ret = -EINVAL; |
| goto err3; |
| } |
| |
| return 0; |
| err3: |
| iounmap(pdata->lpaif_sec_muxsel_virt_addr); |
| err2: |
| iounmap(pdata->lpass_mux_spkr_ctl_virt_addr); |
| err1: |
| iounmap(pdata->lpaif_pri_muxsel_virt_addr); |
| err: |
| devm_kfree(&pdev->dev, pdata); |
| return ret; |
| } |
| |
| static int sdx_asoc_machine_remove(struct platform_device *pdev) |
| { |
| struct snd_soc_card *card = platform_get_drvdata(pdev); |
| struct sdx_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(pdata->lpaif_pri_muxsel_virt_addr); |
| iounmap(pdata->lpass_mux_spkr_ctl_virt_addr); |
| iounmap(pdata->lpaif_sec_muxsel_virt_addr); |
| iounmap(pdata->lpass_mux_mic_ctl_virt_addr); |
| snd_soc_unregister_card(card); |
| |
| return 0; |
| } |
| |
| static const struct of_device_id sdx_asoc_machine_of_match[] = { |
| { .compatible = "qcom,sdx-asoc-snd-tavil", }, |
| {}, |
| }; |
| |
| static struct platform_driver sdx_asoc_machine_driver = { |
| .driver = { |
| .name = DRV_NAME, |
| .owner = THIS_MODULE, |
| .pm = &snd_soc_pm_ops, |
| .of_match_table = sdx_asoc_machine_of_match, |
| }, |
| .probe = sdx_asoc_machine_probe, |
| .remove = sdx_asoc_machine_remove, |
| }; |
| |
| static int dummy_machine_probe(struct platform_device *pdev) |
| { |
| return 0; |
| } |
| |
| static int dummy_machine_remove(struct platform_device *pdev) |
| { |
| return 0; |
| } |
| |
| static struct platform_device dummy_machine_device = { |
| .name = "dummymachinedriver", |
| }; |
| |
| static struct platform_driver sdx_asoc_machine_dummy_driver = { |
| .driver = { |
| .name = "dummymachinedriver", |
| .owner = THIS_MODULE, |
| }, |
| .probe = dummy_machine_probe, |
| .remove = dummy_machine_remove, |
| }; |
| |
| static int sdx_adsp_state_callback(struct notifier_block *nb, |
| unsigned long value, void *priv) |
| { |
| if (!dummy_device_registered && SUBSYS_AFTER_POWERUP == value) { |
| platform_driver_register(&sdx_asoc_machine_dummy_driver); |
| platform_device_register(&dummy_machine_device); |
| dummy_device_registered = true; |
| } |
| |
| return NOTIFY_OK; |
| } |
| |
| static struct notifier_block adsp_state_notifier_block = { |
| .notifier_call = sdx_adsp_state_callback, |
| .priority = -INT_MAX, |
| }; |
| |
| static int __init sdx_soc_platform_init(void) |
| { |
| adsp_state_notifier = subsys_notif_register_notifier("modem", |
| &adsp_state_notifier_block); |
| return 0; |
| } |
| |
| module_init(sdx_soc_platform_init); |
| |
| module_platform_driver(sdx_asoc_machine_driver); |
| |
| MODULE_DESCRIPTION("ALSA SoC sdx"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_ALIAS("platform:" DRV_NAME); |
| MODULE_DEVICE_TABLE(of, sdx_asoc_machine_of_match); |