blob: f1998b44c5804b9cef9d7aef481a022a105257b5 [file] [log] [blame]
/* 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);