/* Copyright (c) 2012-2014 The Linux Foundation. All rights reserved. * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 and * only version 2 as published by the Free Software Foundation. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include "../codecs/wcd9320.h" #include /* Spk control */ #define MDM9625_SPK_ON 1 /* MDM9625 run Taiko at 12.288 Mhz. * At present MDM supports 12.288mhz * only. Taiko supports 9.6 MHz also. */ #define MDM_MCLK_CLK_12P288MHZ 12288000 #define MDM_MCLK_CLK_9P6HZ 9600000 #define MDM_IBIT_CLK_DIV_1P56MHZ 7 #define MDM_MI2S_AUXPCM_PRIM_INTF 0 #define MDM_MI2S_AUXPCM_SEC_INTF 1 #define LPAIF_OFFSET 0xFE000000 #define LPAIF_PRI_MODE_MUXSEL (LPAIF_OFFSET + 0x2B000) #define LPAIF_SEC_MODE_MUXSEL (LPAIF_OFFSET + 0x2C000) #define I2S_SEL 0 #define I2S_PCM_SEL 1 #define I2S_PCM_SEL_OFFSET 1 /* Machine driver Name*/ #define MDM9625_MACHINE_DRV_NAME "mdm9625-asoc-taiko" /* I2S GPIO */ struct msm_i2s_gpio { unsigned gpio_no; const char *gpio_name; }; struct msm_i2s_ctrl { struct msm_i2s_gpio *pin_data; struct clk *cdc_bit_clk; u32 cnt; }; struct mdm9625_machine_data { u32 mclk_freq; struct msm_i2s_gpio *mclk_pin; struct msm_i2s_ctrl *pri_ctrl; u32 prim_clk_usrs; }; 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, }; #define GPIO_NAME_INDEX 0 #define DT_PARSE_INDEX 1 static int mdm9625_auxpcm_rate = 8000; void *lpaif_pri_muxsel_virt_addr; static char *mdm_i2s_gpio_name[][2] = { {"PRIM_MI2S_WS", "prim-i2s-gpio-ws"}, {"PRIM_MI2S_DIN", "prim-i2s-gpio-din"}, {"PRIM_MI2S_DOUT", "prim-i2s-gpio-dout"}, {"PRIM_MI2S_SCLK", "prim-i2s-gpio-sclk"}, }; static char *mdm_mclk_gpio[][2] = { {"MI2S_MCLK", "prim-i2s-gpio-mclk"}, }; static struct mutex cdc_mclk_mutex; static int mdm9625_mi2s_rx_ch = 1; static int mdm9625_mi2s_tx_ch = 1; static int msm_spk_control; static atomic_t aux_ref_count; static atomic_t mi2s_ref_count; static int mdm9625_enable_codec_ext_clk(struct snd_soc_codec *codec, int enable, bool dapm); void *def_taiko_mbhc_cal(void); static struct wcd9xxx_mbhc_config mbhc_cfg = { .read_fw_bin = false, .calibration = NULL, .micbias = MBHC_MICBIAS2, .mclk_cb_fn = mdm9625_enable_codec_ext_clk, .mclk_rate = MDM_MCLK_CLK_12P288MHZ, .gpio = 0, .gpio_irq = 0, .gpio_level_insert = 1, .detect_extn_cable = true, .insert_detect = true, .swap_gnd_mic = NULL, }; #define WCD9XXX_MBHC_DEF_BUTTONS 8 #define WCD9XXX_MBHC_DEF_RLOADS 5 static int mdm9625_set_gpio(struct snd_pcm_substream *substream, u32 intf) { struct snd_soc_pcm_runtime *rtd = substream->private_data; struct snd_soc_card *card = rtd->card; struct mdm9625_machine_data *pdata = snd_soc_card_get_drvdata(card); struct msm_i2s_ctrl *i2s_ctrl = NULL; struct msm_i2s_gpio *pin_data = NULL; int rtn = 0; int i; int j; if (pdata == NULL) { pr_err("%s: pdata is NULL\n", __func__); rtn = -EINVAL; goto err; } if (intf == MDM_MI2S_AUXPCM_PRIM_INTF) { i2s_ctrl = pdata->pri_ctrl; } else { pr_err("%s: Wrong I2S Interface\n", __func__); rtn = -EINVAL; goto err; } if (i2s_ctrl == NULL || i2s_ctrl->pin_data == NULL) { pr_err("%s: Intf ptr NULL\n", __func__); rtn = -EINVAL; goto err; } pin_data = i2s_ctrl->pin_data; for (i = 0; i < i2s_ctrl->cnt; i++, pin_data++) { rtn = gpio_request(pin_data->gpio_no, pin_data->gpio_name); pr_debug("%s: gpio = %d, gpio name = %s\n" "rtn = %d\n", __func__, pin_data->gpio_no, pin_data->gpio_name, rtn); if (rtn) { pr_err("%s: Failed to request gpio %d\n", __func__, pin_data->gpio_no); /* Release all the GPIO on failure */ for (j = i; j >= 0; j--) gpio_free(pin_data->gpio_no); goto err; } } err: return rtn; } static int mdm9625_mi2s_free_gpios(struct snd_pcm_substream *substream, u32 intf) { int i; struct snd_soc_pcm_runtime *rtd = substream->private_data; struct snd_soc_card *card = rtd->card; struct mdm9625_machine_data *pdata = snd_soc_card_get_drvdata(card); struct msm_i2s_ctrl *i2s_ctrl = NULL; struct msm_i2s_gpio *pin_data = NULL; int rtn = 0; pr_debug("%s:", __func__); if (pdata == NULL) { pr_err("%s: pdata is NULL\n", __func__); rtn = -EINVAL; goto err; } if (intf == MDM_MI2S_AUXPCM_PRIM_INTF) { i2s_ctrl = pdata->pri_ctrl; } else { pr_debug("%s: Wrong Interface\n", __func__); rtn = -EINVAL; goto err; } if (i2s_ctrl == NULL || i2s_ctrl->pin_data == NULL) { pr_err("%s: Intf ptr NULL\n", __func__); rtn = -EINVAL; goto err; } pin_data = i2s_ctrl->pin_data; for (i = 0; i < i2s_ctrl->cnt; i++, pin_data++) { gpio_free(pin_data->gpio_no); pr_debug("%s: gpio = %d, gpio name = %s\n", __func__, pin_data->gpio_no, pin_data->gpio_name); } err: return rtn; } static int mdm9625_mi2s_clk_ctl(struct snd_soc_pcm_runtime *rtd, bool enable) { struct snd_soc_card *card = rtd->card; struct mdm9625_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__); return -ENOMEM; } lpass_clk = kzalloc(sizeof(struct afe_clk_cfg), GFP_KERNEL); if (lpass_clk == NULL) { pr_err("%s:Failed to allocate memory\n", __func__); return -ENOMEM; } memcpy(lpass_clk, &lpass_default, sizeof(struct afe_clk_cfg)); pr_debug("%s:enable = %x\n", __func__, enable); if (enable) { if (pdata->prim_clk_usrs == 0) { lpass_clk->clk_val2 = pdata->mclk_freq; lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_BOTH_VALID; } else 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 pdata->prim_clk_usrs++; } else { if (pdata->prim_clk_usrs > 0) pdata->prim_clk_usrs--; if (pdata->prim_clk_usrs == 0) { lpass_clk->clk_val2 = Q6AFE_LPASS_OSR_CLK_DISABLE; lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_BOTH_VALID; } 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); return ret; } static void mdm9625_mi2s_snd_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) { mdm9625_mi2s_free_gpios(substream, MDM_MI2S_AUXPCM_PRIM_INTF); ret = mdm9625_mi2s_clk_ctl(rtd, false); if (ret < 0) pr_err("%s:clock disable failed\n", __func__); } } static int mdm9625_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) iowrite32(I2S_SEL << I2S_PCM_SEL_OFFSET, lpaif_pri_muxsel_virt_addr); else pr_err("%s lpaif_pri_muxsel_virt_addr is NULL\n", __func__); ret = mdm9625_set_gpio(substream, MDM_MI2S_AUXPCM_PRIM_INTF); if (ret < 0) { pr_err("%s, GPIO setup failed\n", __func__); return ret; } ret = mdm9625_mi2s_clk_ctl(rtd, true); if (ret < 0) { pr_err("set format for codec dai failed\n"); return ret; } /* 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("set fmt cpu dai failed\n"); ret = snd_soc_dai_set_fmt(codec_dai, SND_SOC_DAIFMT_CBS_CFS); if (ret < 0) pr_err("set fmt for codec dai failed\n"); } return ret; } static int mdm9625_mi2s_rx_be_hw_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 = 48000; channels->min = channels->max = mdm9625_mi2s_rx_ch; return 0; } static int mdm9625_mi2s_tx_be_hw_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 = 48000; channels->min = channels->max = mdm9625_mi2s_tx_ch; return 0; } static int mdm9625_be_hw_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); rate->min = rate->max = 48000; return 0; } static int mdm9625_mi2s_rx_ch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: msm9615_i2s_rx_ch = %d\n", __func__, mdm9625_mi2s_rx_ch); ucontrol->value.integer.value[0] = mdm9625_mi2s_rx_ch - 1; return 0; } static int mdm9625_mi2s_rx_ch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { mdm9625_mi2s_rx_ch = ucontrol->value.integer.value[0] + 1; pr_debug("%s: msm9615_i2s_rx_ch = %d\n", __func__, mdm9625_mi2s_rx_ch); return 1; } static int mdm9625_mi2s_tx_ch_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: msm9615_i2s_tx_ch = %d\n", __func__, mdm9625_mi2s_tx_ch); ucontrol->value.integer.value[0] = mdm9625_mi2s_tx_ch - 1; return 0; } static int mdm9625_mi2s_tx_ch_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { mdm9625_mi2s_tx_ch = ucontrol->value.integer.value[0] + 1; pr_debug("%s: msm9615_i2s_tx_ch = %d\n", __func__, mdm9625_mi2s_tx_ch); return 1; } static int mdm9625_mi2s_get_spk(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { pr_debug("%s: msm_spk_control = %d", __func__, msm_spk_control); ucontrol->value.integer.value[0] = msm_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: msm_spk_control = %d", __func__, msm_spk_control); mutex_lock(&dapm->codec->mutex); if (msm_spk_control == MDM9625_SPK_ON) { snd_soc_dapm_enable_pin(dapm, "Ext Spk Bottom Pos"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Bottom Neg"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Top Pos"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Top Neg"); } else { snd_soc_dapm_disable_pin(dapm, "Ext Spk Bottom Pos"); snd_soc_dapm_disable_pin(dapm, "Ext Spk Bottom Neg"); snd_soc_dapm_disable_pin(dapm, "Ext Spk Top Pos"); snd_soc_dapm_disable_pin(dapm, "Ext Spk Top Neg"); } snd_soc_dapm_sync(dapm); mutex_unlock(&dapm->codec->mutex); } static int mdm9625_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 (msm_spk_control == ucontrol->value.integer.value[0]) return 0; msm_spk_control = ucontrol->value.integer.value[0]; mdm_ext_control(codec); return 1; } static int mdm9625_enable_codec_ext_clk(struct snd_soc_codec *codec, int enable, bool dapm) { int ret = 0; struct mdm9625_machine_data *pdata = snd_soc_card_get_drvdata(codec->card); struct afe_clk_cfg *lpass_clk = NULL; pr_debug("%s: enable = %d codec name %s enable %x\n", __func__, enable, codec->name, enable); lpass_clk = kzalloc(sizeof(struct afe_clk_cfg), GFP_KERNEL); if (lpass_clk == NULL) { pr_err("%s:Failed to allocate memory\n", __func__); return -ENOMEM; } mutex_lock(&cdc_mclk_mutex); memcpy(lpass_clk, &lpass_default, sizeof(struct afe_clk_cfg)); if (enable) { if (pdata->prim_clk_usrs == 0) { lpass_clk->clk_val2 = pdata->mclk_freq; lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_CLK2_VALID; ret = afe_set_lpass_clock(MI2S_RX, lpass_clk); if (ret < 0) { pr_err("%s:afe_set_lpass_clock failed\n", __func__); goto err; } } pdata->prim_clk_usrs++; taiko_mclk_enable(codec, 1, dapm); } else { if (pdata->prim_clk_usrs > 0) pdata->prim_clk_usrs--; if (pdata->prim_clk_usrs == 0) { lpass_clk->clk_set_mode = Q6AFE_LPASS_MODE_CLK2_VALID; lpass_clk->clk_val2 = Q6AFE_LPASS_OSR_CLK_DISABLE; ret = afe_set_lpass_clock(MI2S_RX, lpass_clk); if (ret < 0) { pr_err("%s:afe_set_lpass_clock failed\n", __func__); goto err; } } taiko_mclk_enable(codec, 0, dapm); } pr_debug("%s: clk2 = %x mode = %x\n", __func__, lpass_clk->clk_val2, lpass_clk->clk_set_mode); err: mutex_unlock(&cdc_mclk_mutex); kfree(lpass_clk); return ret; } static int mdm9625_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 mdm9625_enable_codec_ext_clk(w->codec, 1, true); case SND_SOC_DAPM_POST_PMD: return mdm9625_enable_codec_ext_clk(w->codec, 0, true); } return 0; } static int mdm9625_auxpcm_startup(struct snd_pcm_substream *substream) { struct snd_soc_pcm_runtime *rtd = substream->private_data; int ret = 0; if (atomic_inc_return(&aux_ref_count) == 1) { if (lpaif_pri_muxsel_virt_addr != NULL) iowrite32(I2S_PCM_SEL << I2S_PCM_SEL_OFFSET, lpaif_pri_muxsel_virt_addr); else pr_err("%s lpaif_pri_muxsel_virt_addr is NULL\n", __func__); ret = mdm9625_set_gpio(substream, MDM_MI2S_AUXPCM_PRIM_INTF); if (ret < 0) { pr_err("%s, GPIO setup failed\n", __func__); return ret; } ret = mdm9625_mi2s_clk_ctl(rtd, true); if (ret < 0) { pr_err("set format for codec dai failed\n"); return ret; } } return ret; } static void mdm9625_auxpcm_snd_shutdown(struct snd_pcm_substream *substream) { struct snd_soc_pcm_runtime *rtd = substream->private_data; int ret; if (atomic_dec_return(&aux_ref_count) == 0) { mdm9625_mi2s_free_gpios(substream, MDM_MI2S_AUXPCM_PRIM_INTF); ret = mdm9625_mi2s_clk_ctl(rtd, false); if (ret < 0) pr_err("%s:clock disable failed\n", __func__); } } static int mdm9625_auxpcm_rate_get(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { ucontrol->value.integer.value[0] = mdm9625_auxpcm_rate; return 0; } static int mdm9625_auxpcm_rate_put(struct snd_kcontrol *kcontrol, struct snd_ctl_elem_value *ucontrol) { switch (ucontrol->value.integer.value[0]) { case 0: mdm9625_auxpcm_rate = 8000; break; case 1: mdm9625_auxpcm_rate = 16000; break; default: mdm9625_auxpcm_rate = 8000; break; } return 0; } static int mdm9625_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 = mdm9625_auxpcm_rate; channels->min = channels->max = 1; return 0; } static const struct snd_soc_dapm_widget mdm9625_dapm_widgets[] = { SND_SOC_DAPM_SUPPLY("MCLK", SND_SOC_NOPM, 0, 0, mdm9625_mclk_event, SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD), SND_SOC_DAPM_SPK("Ext Spk Bottom Pos", NULL), SND_SOC_DAPM_SPK("Ext Spk Bottom Neg", NULL), SND_SOC_DAPM_SPK("Ext Spk Top Pos", NULL), SND_SOC_DAPM_SPK("Ext Spk Top Neg", 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("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 const char *const spk_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 struct soc_enum mdm9625_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), }; static const struct snd_kcontrol_new mdm_snd_controls[] = { SOC_ENUM_EXT("Speaker Function", mdm9625_enum[0], mdm9625_mi2s_get_spk, mdm9625_mi2s_set_spk), SOC_ENUM_EXT("MI2S_RX Channels", mdm9625_enum[1], mdm9625_mi2s_rx_ch_get, mdm9625_mi2s_rx_ch_put), SOC_ENUM_EXT("MI2S_TX Channels", mdm9625_enum[2], mdm9625_mi2s_tx_ch_get, mdm9625_mi2s_tx_ch_put), SOC_ENUM_EXT("AUX PCM SampleRate", mdm9625_enum[3], mdm9625_auxpcm_rate_get, mdm9625_auxpcm_rate_put), }; static int mdm9625_mi2s_audrx_init(struct snd_soc_pcm_runtime *rtd) { int err; struct snd_soc_codec *codec = rtd->codec; struct snd_soc_dapm_context *dapm = &codec->dapm; struct snd_soc_dai *cpu_dai = rtd->cpu_dai; pr_debug("%s(), dev_name%s\n", __func__, dev_name(cpu_dai->dev)); rtd->pmdown_time = 0; err = snd_soc_add_codec_controls(codec, mdm_snd_controls, ARRAY_SIZE(mdm_snd_controls)); if (err < 0) return err; snd_soc_dapm_new_controls(dapm, mdm9625_dapm_widgets, ARRAY_SIZE(mdm9625_dapm_widgets)); /* After DAPM Enable pins alawys * DAPM SYNC needs to be called. */ snd_soc_dapm_enable_pin(dapm, "Ext Spk Bottom Pos"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Bottom Neg"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Top Pos"); snd_soc_dapm_enable_pin(dapm, "Ext Spk Top Neg"); snd_soc_dapm_sync(dapm); mbhc_cfg.calibration = def_taiko_mbhc_cal(); if (mbhc_cfg.calibration) err = taiko_hs_detect(codec, &mbhc_cfg); else err = -ENOMEM; return err; } void *def_taiko_mbhc_cal(void) { void *taiko_cal; struct wcd9xxx_mbhc_btn_detect_cfg *btn_cfg; u16 *btn_low, *btn_high; u8 *n_ready, *n_cic, *gain; taiko_cal = kzalloc(WCD9XXX_MBHC_CAL_SIZE(WCD9XXX_MBHC_DEF_BUTTONS, WCD9XXX_MBHC_DEF_RLOADS), GFP_KERNEL); if (!taiko_cal) { pr_err("%s: out of memory\n", __func__); return NULL; } #define S(X, Y) ((WCD9XXX_MBHC_CAL_GENERAL_PTR(taiko_cal)->X) = (Y)) S(t_ldoh, 100); S(t_bg_fast_settle, 100); S(t_shutdown_plug_rem, 255); S(mbhc_nsa, 4); S(mbhc_navg, 4); #undef S #define S(X, Y) ((WCD9XXX_MBHC_CAL_PLUG_DET_PTR(taiko_cal)->X) = (Y)) S(mic_current, TAIKO_PID_MIC_5_UA); S(hph_current, TAIKO_PID_MIC_5_UA); S(t_mic_pid, 100); S(t_ins_complete, 250); S(t_ins_retry, 200); #undef S #define S(X, Y) ((WCD9XXX_MBHC_CAL_PLUG_TYPE_PTR(taiko_cal)->X) = (Y)) S(v_no_mic, 30); S(v_hs_max, 2400); #undef S #define S(X, Y) ((WCD9XXX_MBHC_CAL_BTN_DET_PTR(taiko_cal)->X) = (Y)) S(c[0], 62); S(c[1], 124); S(nc, 1); S(n_meas, 3); S(mbhc_nsc, 11); S(n_btn_meas, 1); S(n_btn_con, 2); S(num_btn, WCD9XXX_MBHC_DEF_BUTTONS); S(v_btn_press_delta_sta, 100); S(v_btn_press_delta_cic, 50); #undef S btn_cfg = WCD9XXX_MBHC_CAL_BTN_DET_PTR(taiko_cal); btn_low = wcd9xxx_mbhc_cal_btn_det_mp(btn_cfg, MBHC_BTN_DET_V_BTN_LOW); btn_high = wcd9xxx_mbhc_cal_btn_det_mp(btn_cfg, MBHC_BTN_DET_V_BTN_HIGH); btn_low[0] = -50; btn_high[0] = 10; btn_low[1] = 11; btn_high[1] = 52; btn_low[2] = 53; btn_high[2] = 94; btn_low[3] = 95; btn_high[3] = 133; btn_low[4] = 134; btn_high[4] = 171; btn_low[5] = 172; btn_high[5] = 208; btn_low[6] = 209; btn_high[6] = 244; btn_low[7] = 245; btn_high[7] = 330; n_ready = wcd9xxx_mbhc_cal_btn_det_mp(btn_cfg, MBHC_BTN_DET_N_READY); n_ready[0] = 80; n_ready[1] = 68; n_cic = wcd9xxx_mbhc_cal_btn_det_mp(btn_cfg, MBHC_BTN_DET_N_CIC); n_cic[0] = 60; n_cic[1] = 47; gain = wcd9xxx_mbhc_cal_btn_det_mp(btn_cfg, MBHC_BTN_DET_GAIN); gain[0] = 11; gain[1] = 9; return taiko_cal; } static struct snd_soc_ops mdm9625_mi2s_be_ops = { .startup = mdm9625_mi2s_startup, .shutdown = mdm9625_mi2s_snd_shutdown, }; static struct snd_soc_ops mdm9625_auxpcm_be_ops = { .startup = mdm9625_auxpcm_startup, .shutdown = mdm9625_auxpcm_snd_shutdown, }; /* Digital audio interface connects codec <---> CPU */ static struct snd_soc_dai_link mdm9625_dai[] = { /* FrontEnd DAI Links */ { .name = "MDM9625 Media1", .stream_name = "MultiMedia1", .cpu_dai_name = "MultiMedia1", .platform_name = "msm-pcm-dsp.0", .dynamic = 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, .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, .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 = "MI2S Hostless", .stream_name = "MI2S Hostless", .cpu_dai_name = "MI2S_TX_HOSTLESS", .platform_name = "msm-pcm-hostless", .dynamic = 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, /* This dainlink has MI2S support */ .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, .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, .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, .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", .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", .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", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .ignore_suspend = 1, }, { .name = "CS-VOICE HOST TX CAPTURE", .stream_name = "CS-VOICE HOST TX CAPTURE", .cpu_dai_name = "msm-dai-stub", .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", .platform_name = "msm-voice-host-pcm", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .ignore_suspend = 1, }, { .name = "MDM9625 Media2", .stream_name = "MultiMedia2", .cpu_dai_name = "MultiMedia2", .platform_name = "msm-pcm-dsp.0", .dynamic = 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_MULTIMEDIA2, }, { .name = "AUXPCM Hostless", .stream_name = "AUXPCM Hostless", .cpu_dai_name = "AUXPCM_HOSTLESS", .platform_name = "msm-pcm-hostless", .dynamic = 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", }, /* Backend DAI Links */ { .name = LPASS_BE_MI2S_RX, .stream_name = "MI2S Playback", .cpu_dai_name = "msm-dai-q6-mi2s.0", .platform_name = "msm-pcm-routing", .codec_name = "taiko_codec", .codec_dai_name = "taiko_i2s_rx1", .no_pcm = 1, .be_id = MSM_BACKEND_DAI_MI2S_RX, .init = &mdm9625_mi2s_audrx_init, .be_hw_params_fixup = &mdm9625_mi2s_rx_be_hw_params_fixup, .ops = &mdm9625_mi2s_be_ops, }, { .name = LPASS_BE_MI2S_TX, .stream_name = "MI2S Capture", .cpu_dai_name = "msm-dai-q6-mi2s.0", .platform_name = "msm-pcm-routing", .codec_name = "taiko_codec", .codec_dai_name = "taiko_i2s_tx1", .no_pcm = 1, .be_id = MSM_BACKEND_DAI_MI2S_TX, .be_hw_params_fixup = &mdm9625_mi2s_tx_be_hw_params_fixup, .ops = &mdm9625_mi2s_be_ops, }, { .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, .be_id = MSM_BACKEND_DAI_AFE_PCM_RX, }, { .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, .be_id = MSM_BACKEND_DAI_AFE_PCM_TX, }, { .name = LPASS_BE_AUXPCM_RX, .stream_name = "AUX PCM Playback", .cpu_dai_name = "msm-dai-q6.4106", .platform_name = "msm-pcm-routing", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-rx", .no_pcm = 1, .be_id = MSM_BACKEND_DAI_AUXPCM_RX, .be_hw_params_fixup = mdm9625_auxpcm_be_params_fixup, .ops = &mdm9625_auxpcm_be_ops, .ignore_pmdown_time = 1, /* this dainlink has playback support */ }, { .name = LPASS_BE_AUXPCM_TX, .stream_name = "AUX PCM Capture", .cpu_dai_name = "msm-dai-q6.4107", .platform_name = "msm-pcm-routing", .codec_name = "msm-stub-codec.1", .codec_dai_name = "msm-stub-tx", .no_pcm = 1, .be_id = MSM_BACKEND_DAI_AUXPCM_TX, .be_hw_params_fixup = mdm9625_auxpcm_be_params_fixup, .ops = &mdm9625_auxpcm_be_ops, }, /* 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, .be_id = MSM_BACKEND_DAI_INCALL_RECORD_TX, .be_hw_params_fixup = mdm9625_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, .be_id = MSM_BACKEND_DAI_INCALL_RECORD_RX, .be_hw_params_fixup = mdm9625_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, .be_id = MSM_BACKEND_DAI_VOICE_PLAYBACK_TX, .be_hw_params_fixup = mdm9625_be_hw_params_fixup, .ignore_suspend = 1, }, }; static struct snd_soc_card snd_soc_card_mdm9625 = { .name = "mdm9625-taiko-i2s-snd-card", .dai_link = mdm9625_dai, .num_links = ARRAY_SIZE(mdm9625_dai), }; static int mdm9625_dtparse(struct platform_device *pdev, struct mdm9625_machine_data **pdata) { int ret = 0, i = 0; struct msm_i2s_gpio *pin_data = NULL; struct msm_i2s_ctrl *ctrl; struct msm_i2s_gpio *mclk_pin = NULL; unsigned int gpio_no[4]; unsigned int dt_mclk = 0; enum of_gpio_flags flags = OF_GPIO_ACTIVE_LOW; int prim_cnt = 0; pin_data = devm_kzalloc(&pdev->dev, (4 * sizeof(struct msm_i2s_gpio)), GFP_KERNEL); mclk_pin = devm_kzalloc(&pdev->dev, sizeof(struct msm_i2s_gpio), GFP_KERNEL); if (!pin_data || !mclk_pin) { dev_err(&pdev->dev, "No memory for gpio\n"); ret = -ENOMEM; goto err; } for (i = 0; i < ARRAY_SIZE(gpio_no); i++) { gpio_no[i] = of_get_named_gpio_flags(pdev->dev.of_node, mdm_i2s_gpio_name[i][DT_PARSE_INDEX], 0, &flags); if (gpio_no[i] > 0) { pin_data[i].gpio_name = mdm_i2s_gpio_name[prim_cnt][GPIO_NAME_INDEX]; pin_data[i].gpio_no = gpio_no[i]; dev_dbg(&pdev->dev, "%s:GPIO gpio[%s] =\n" "0x%x\n", __func__, pin_data[i].gpio_name, pin_data[i].gpio_no); prim_cnt++; } else { dev_err(&pdev->dev, "%s:Invalid I2S GPIO[%s] = %x\n", __func__, mdm_i2s_gpio_name[i][GPIO_NAME_INDEX], gpio_no[i]); ret = -ENODEV; goto err; } } for (i = 0; i < ARRAY_SIZE(mdm_mclk_gpio); i++) { dt_mclk = of_get_named_gpio_flags(pdev->dev.of_node, mdm_mclk_gpio[i][DT_PARSE_INDEX], 0, &flags); if (dt_mclk > 0) { mclk_pin->gpio_name = mdm_mclk_gpio[i][GPIO_NAME_INDEX]; mclk_pin->gpio_no = dt_mclk; ret = gpio_request(mclk_pin->gpio_no, mclk_pin->gpio_name); dev_dbg(&pdev->dev, "%s:Request MCLK Gpio\n" "gpio[%s] = 0x%x\n", __func__, mclk_pin->gpio_name, dt_mclk); } else { dev_err(&pdev->dev, "%s:MCLK gpio is incorrect\n", __func__); ret = -ENODEV; goto err; } } ctrl = devm_kzalloc(&pdev->dev, sizeof(struct msm_i2s_ctrl), GFP_KERNEL); if (!ctrl) { dev_err(&pdev->dev, "No memory for gpio\n"); ret = -ENOMEM; goto err; } ctrl->pin_data = pin_data; ctrl->cnt = prim_cnt; (*pdata)->pri_ctrl = ctrl; (*pdata)->mclk_pin = mclk_pin; return ret; err: if (mclk_pin) devm_kfree(&pdev->dev, mclk_pin); if (pin_data) devm_kfree(&pdev->dev, pin_data); return ret; } static __devinit int mdm9625_asoc_machine_probe(struct platform_device *pdev) { int ret; struct snd_soc_card *card = &snd_soc_card_mdm9625; struct mdm9625_machine_data *pdata; enum apr_subsys_state q6_state; q6_state = apr_get_q6_state(); if (q6_state != APR_SUBSYS_LOADED) { dev_dbg(&pdev->dev, "defering %s, adsp_state %d\n", __func__, q6_state); return -EPROBE_DEFER; } mutex_init(&cdc_mclk_mutex); if (!pdev->dev.of_node) { dev_err(&pdev->dev, "No platform supplied from device tree\n"); return -EINVAL; } pdata = devm_kzalloc(&pdev->dev, sizeof(struct mdm9625_machine_data), GFP_KERNEL); if (!pdata) { dev_err(&pdev->dev, "Can't allocate mdm9625_asoc_mach_data\n"); ret = -ENOMEM; goto err; } ret = mdm9625_dtparse(pdev, &pdata); if (ret) { dev_err(&pdev->dev, "%s: mi2s-aux Pin data parse failed", __func__); goto err; } ret = of_property_read_u32(pdev->dev.of_node, "qcom,taiko-mclk-clk-freq", &pdata->mclk_freq); if (ret) { dev_err(&pdev->dev, "Looking up %s property in node %s failed", "qcom,taiko-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, "unsupported taiko mclk freq %u\n", pdata->mclk_freq); ret = -EINVAL; goto err; } 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 = snd_soc_register_card(card); 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; } return 0; err: devm_kfree(&pdev->dev, pdata); return ret; } static int __devexit mdm9625_asoc_machine_remove(struct platform_device *pdev) { struct snd_soc_card *card = platform_get_drvdata(pdev); struct mdm9625_machine_data *pdata = snd_soc_card_get_drvdata(card); pdata->mclk_freq = 0; snd_soc_unregister_card(card); return 0; } static const struct of_device_id msm9625_asoc_machine_of_match[] = { { .compatible = "qcom,mdm9625-audio-taiko", }, {}, }; static struct platform_driver msm9625_asoc_machine_driver = { .driver = { .name = MDM9625_MACHINE_DRV_NAME, .owner = THIS_MODULE, .pm = &snd_soc_pm_ops, .of_match_table = msm9625_asoc_machine_of_match, }, .probe = mdm9625_asoc_machine_probe, .remove = __devexit_p(mdm9625_asoc_machine_remove), }; module_platform_driver(msm9625_asoc_machine_driver); MODULE_DESCRIPTION("ALSA SoC msm"); MODULE_LICENSE("GPL v2"); MODULE_ALIAS("platform:" MDM9625_MACHINE_DRV_NAME); MODULE_DEVICE_TABLE(of, msm9625_asoc_machine_of_match);