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